/[gxemul]/trunk/src/cpus/cpu_arm.c
This is repository of my old source code which isn't updated any more. Go to git.rot13.org for current projects!
ViewVC logotype

Diff of /trunk/src/cpus/cpu_arm.c

Parent Directory Parent Directory | Revision Log Revision Log | View Patch Patch

revision 14 by dpavlin, Mon Oct 8 16:18:51 2007 UTC revision 26 by dpavlin, Mon Oct 8 16:20:10 2007 UTC
# Line 1  Line 1 
1  /*  /*
2   *  Copyright (C) 2005  Anders Gavare.  All rights reserved.   *  Copyright (C) 2005-2006  Anders Gavare.  All rights reserved.
3   *   *
4   *  Redistribution and use in source and binary forms, with or without   *  Redistribution and use in source and binary forms, with or without
5   *  modification, are permitted provided that the following conditions are met:   *  modification, are permitted provided that the following conditions are met:
# Line 25  Line 25 
25   *  SUCH DAMAGE.   *  SUCH DAMAGE.
26   *   *
27   *   *
28   *  $Id: cpu_arm.c,v 1.28 2005/10/07 10:26:03 debug Exp $   *  $Id: cpu_arm.c,v 1.60 2006/06/24 21:47:23 debug Exp $
29   *   *
30   *  ARM CPU emulation.   *  ARM CPU emulation.
31   *   *
32     *
33   *  A good source of quick info on ARM instruction encoding:   *  A good source of quick info on ARM instruction encoding:
34   *   *
35   *      http://www.pinknoise.demon.co.uk/ARMinstrs/ARMinstrs.html   *      http://www.pinknoise.demon.co.uk/ARMinstrs/ARMinstrs.html
  *  
  *  (Most "xxxx0101..." and similar strings in this file are from that URL,  
  *  or from the ARM manual.)  
36   */   */
37    
38  #include <stdio.h>  #include <stdio.h>
# Line 47  Line 45 
45  #include "machine.h"  #include "machine.h"
46  #include "memory.h"  #include "memory.h"
47  #include "misc.h"  #include "misc.h"
48    #include "of.h"
49  #include "symbol.h"  #include "symbol.h"
50    
51  #define DYNTRANS_32  #define DYNTRANS_32
# Line 62  static char *arm_dpiname[16] = ARM_DPI_N Line 61  static char *arm_dpiname[16] = ARM_DPI_N
61  static int arm_dpi_uses_d[16] = { 1,1,1,1,1,1,1,1,0,0,0,0,1,1,1,1 };  static int arm_dpi_uses_d[16] = { 1,1,1,1,1,1,1,1,0,0,0,0,1,1,1,1 };
62  static int arm_dpi_uses_n[16] = { 1,1,1,1,1,1,1,1,1,1,1,1,1,0,1,0 };  static int arm_dpi_uses_n[16] = { 1,1,1,1,1,1,1,1,1,1,1,1,1,0,1,0 };
63    
64  /*  Forward reference:  */  static int arm_exception_to_mode[N_ARM_EXCEPTIONS] = ARM_EXCEPTION_TO_MODE;
65    
66    /*  For quick_pc_to_pointers():  */
67  void arm_pc_to_pointers(struct cpu *cpu);  void arm_pc_to_pointers(struct cpu *cpu);
68    #include "quick_pc_to_pointers.h"
69    
70    
71  /*  /*
# Line 92  int arm_cpu_new(struct cpu *cpu, struct Line 94  int arm_cpu_new(struct cpu *cpu, struct
94    
95          cpu->memory_rw = arm_memory_rw;          cpu->memory_rw = arm_memory_rw;
96          cpu->update_translation_table = arm_update_translation_table;          cpu->update_translation_table = arm_update_translation_table;
97          cpu->invalidate_translation_caches_paddr =          cpu->invalidate_translation_caches =
98              arm_invalidate_translation_caches_paddr;              arm_invalidate_translation_caches;
99          cpu->invalidate_code_translation = arm_invalidate_code_translation;          cpu->invalidate_code_translation = arm_invalidate_code_translation;
100          cpu->translate_address = arm_translate_address;          cpu->translate_v2p = arm_translate_v2p;
101    
102          cpu->cd.arm.cpu_type    = cpu_type_defs[found];          cpu->cd.arm.cpu_type = cpu_type_defs[found];
103          cpu->name               = cpu->cd.arm.cpu_type.name;          cpu->name            = cpu->cd.arm.cpu_type.name;
104          cpu->is_32bit           = 1;          cpu->is_32bit        = 1;
105    
106          cpu->cd.arm.cpsr = ARM_FLAG_I | ARM_FLAG_F;          cpu->cd.arm.cpsr = ARM_FLAG_I | ARM_FLAG_F;
107          cpu->cd.arm.control = ARM_CONTROL_PROG32 | ARM_CONTROL_DATA32          cpu->cd.arm.control = ARM_CONTROL_PROG32 | ARM_CONTROL_DATA32
108              | ARM_CONTROL_CACHE | ARM_CONTROL_ICACHE | ARM_CONTROL_ALIGN;              | ARM_CONTROL_CACHE | ARM_CONTROL_ICACHE | ARM_CONTROL_ALIGN;
109            /*  TODO: default auxctrl contents  */
110    
111          if (cpu->machine->prom_emulation) {          if (cpu->machine->prom_emulation) {
112                  cpu->cd.arm.cpsr |= ARM_MODE_SVC32;                  cpu->cd.arm.cpsr |= ARM_MODE_SVC32;
113                  cpu->cd.arm.control |= ARM_CONTROL_S;                  cpu->cd.arm.control |= ARM_CONTROL_S;
114          } else {          } else {
115                  cpu->cd.arm.cpsr |= ARM_MODE_USR32;                  cpu->cd.arm.cpsr |= ARM_MODE_SVC32;
116                  cpu->cd.arm.control |= ARM_CONTROL_S | ARM_CONTROL_R;                  cpu->cd.arm.control |= ARM_CONTROL_R;
117          }          }
118    
119          /*  Only show name and caches etc for CPU nr 0:  */          /*  Only show name and caches etc for CPU nr 0:  */
# Line 128  int arm_cpu_new(struct cpu *cpu, struct Line 131  int arm_cpu_new(struct cpu *cpu, struct
131                  }                  }
132          }          }
133    
134            /*  TODO: Some of these values (iway and dway) aren't used yet:  */
135            cpu->cd.arm.cachetype =
136                  (5 << ARM_CACHETYPE_CLASS_SHIFT)
137                | (1 << ARM_CACHETYPE_HARVARD_SHIFT)
138                | ((cpu->cd.arm.cpu_type.dcache_shift - 9) <<
139                    ARM_CACHETYPE_DSIZE_SHIFT)
140                | (5 << ARM_CACHETYPE_DASSOC_SHIFT)         /*  32-way  */
141                | (2 << ARM_CACHETYPE_DLINE_SHIFT)          /*  8 words/line  */
142                | ((cpu->cd.arm.cpu_type.icache_shift - 9) <<
143                    ARM_CACHETYPE_ISIZE_SHIFT)
144                | (5 << ARM_CACHETYPE_IASSOC_SHIFT)         /*  32-way  */
145                | (2 << ARM_CACHETYPE_ILINE_SHIFT);         /*  8 words/line  */
146    
147          /*  Coprocessor 15 = the system control coprocessor.  */          /*  Coprocessor 15 = the system control coprocessor.  */
148          cpu->cd.arm.coproc[15] = arm_coproc_15;          cpu->cd.arm.coproc[15] = arm_coproc_15;
149    
150            /*  Coprocessor 14 for XScale:  */
151            if (cpu->cd.arm.cpu_type.flags & ARM_XSCALE)
152                    cpu->cd.arm.coproc[14] = arm_coproc_xscale_14;
153    
154          /*          /*
155           *  NOTE/TODO: Ugly hack for OpenFirmware emulation:           *  NOTE/TODO: Ugly hack for OpenFirmware emulation:
156           */           */
# Line 140  int arm_cpu_new(struct cpu *cpu, struct Line 160  int arm_cpu_new(struct cpu *cpu, struct
160                  store_32bit_word(cpu, cpu->cd.arm.of_emul_addr, 0xef8c64be);                  store_32bit_word(cpu, cpu->cd.arm.of_emul_addr, 0xef8c64be);
161          }          }
162    
163            cpu->cd.arm.flags = cpu->cd.arm.cpsr >> 28;
164    
165          return 1;          return 1;
166  }  }
167    
# Line 163  void arm_setup_initial_translation_table Line 185  void arm_setup_initial_translation_table
185          }          }
186    
187          cpu->cd.arm.control |= ARM_CONTROL_MMU;          cpu->cd.arm.control |= ARM_CONTROL_MMU;
188            cpu->translate_v2p = arm_translate_v2p_mmu;
189          cpu->cd.arm.dacr |= 0x00000003;          cpu->cd.arm.dacr |= 0x00000003;
190          cpu->cd.arm.ttb = ttb_addr;          cpu->cd.arm.ttb = ttb_addr;
191    
# Line 175  void arm_setup_initial_translation_table Line 198  void arm_setup_initial_translation_table
198                          uint32_t addr = cpu->cd.arm.ttb +                          uint32_t addr = cpu->cd.arm.ttb +
199                              (((j << 28) + (i << 20)) >> 18);                              (((j << 28) + (i << 20)) >> 18);
200                          uint32_t d = (1048576*i) | 0xc02;                          uint32_t d = (1048576*i) | 0xc02;
201    
202                            if (cpu->byte_order == EMUL_LITTLE_ENDIAN) {
203                                    descr[0] = d;       descr[1] = d >> 8;
204                                    descr[2] = d >> 16; descr[3] = d >> 24;
205                            } else {
206                                    descr[3] = d;       descr[2] = d >> 8;
207                                    descr[1] = d >> 16; descr[0] = d >> 24;
208                            }
209                            cpu->memory_rw(cpu, cpu->mem, addr, &descr[0],
210                                sizeof(descr), MEM_WRITE, PHYSICAL | NO_EXCEPTIONS);
211                    }
212    }
213    
214    
215  /*  /*
216  d = (1048576 * (i + (j==12? 10 : j)*256)) | 2;   *  arm_translation_table_set_l1():
217  */   */
218    void arm_translation_table_set_l1(struct cpu *cpu, uint32_t vaddr,
219            uint32_t paddr)
220    {
221            unsigned int i, j, vhigh = vaddr >> 28, phigh = paddr >> 28;
222    
223            for (i=0; i<256; i++)
224                    for (j=vhigh; j<=vhigh; j++) {
225                            unsigned char descr[4];
226                            uint32_t addr = cpu->cd.arm.ttb +
227                                (((j << 28) + (i << 20)) >> 18);
228                            uint32_t d = ((phigh << 28) + 1048576*i) | 0xc02;
229    
230                            if (cpu->byte_order == EMUL_LITTLE_ENDIAN) {
231                                    descr[0] = d;       descr[1] = d >> 8;
232                                    descr[2] = d >> 16; descr[3] = d >> 24;
233                            } else {
234                                    descr[3] = d;       descr[2] = d >> 8;
235                                    descr[1] = d >> 16; descr[0] = d >> 24;
236                            }
237                            cpu->memory_rw(cpu, cpu->mem, addr, &descr[0],
238                                sizeof(descr), MEM_WRITE, PHYSICAL | NO_EXCEPTIONS);
239                    }
240    }
241    
242    
243    /*
244     *  arm_translation_table_set_l1_b():
245     */
246    void arm_translation_table_set_l1_b(struct cpu *cpu, uint32_t vaddr,
247            uint32_t paddr)
248    {
249            unsigned int i, j, vhigh = vaddr >> 24, phigh = paddr >> 24;
250    
251            for (i=0; i<16; i++)
252                    for (j=vhigh; j<=vhigh; j++) {
253                            unsigned char descr[4];
254                            uint32_t addr = cpu->cd.arm.ttb +
255                                (((j << 24) + (i << 20)) >> 18);
256                            uint32_t d = ((phigh << 24) + 1048576*i) | 0xc02;
257    
258                          if (cpu->byte_order == EMUL_LITTLE_ENDIAN) {                          if (cpu->byte_order == EMUL_LITTLE_ENDIAN) {
259                                  descr[0] = d;       descr[1] = d >> 8;                                  descr[0] = d;       descr[1] = d >> 8;
260                                  descr[2] = d >> 16; descr[3] = d >> 24;                                  descr[2] = d >> 16; descr[3] = d >> 24;
# Line 244  void arm_cpu_register_match(struct machi Line 321  void arm_cpu_register_match(struct machi
321                                  m->cpus[cpunr]->cd.arm.r[i] = *valuep;                                  m->cpus[cpunr]->cd.arm.r[i] = *valuep;
322                                  if (i == ARM_PC)                                  if (i == ARM_PC)
323                                          m->cpus[cpunr]->pc = *valuep;                                          m->cpus[cpunr]->pc = *valuep;
324                          } else                          } else {
325                                  *valuep = m->cpus[cpunr]->cd.arm.r[i];                                  *valuep = m->cpus[cpunr]->cd.arm.r[i];
326                                    if (i == ARM_PC)
327                                            *valuep = m->cpus[cpunr]->pc;
328                            }
329                          *match_register = 1;                          *match_register = 1;
330                  }                  }
331          }          }
# Line 267  void arm_cpu_register_dump(struct cpu *c Line 347  void arm_cpu_register_dump(struct cpu *c
347          int mode = cpu->cd.arm.cpsr & ARM_FLAG_MODE;          int mode = cpu->cd.arm.cpsr & ARM_FLAG_MODE;
348          int i, x = cpu->cpu_id;          int i, x = cpu->cpu_id;
349    
350            cpu->cd.arm.cpsr &= 0x0fffffff;
351            cpu->cd.arm.cpsr |= (cpu->cd.arm.flags << 28);
352    
353          if (gprs) {          if (gprs) {
354                  symbol = get_symbol_name(&cpu->machine->symbol_context,                  symbol = get_symbol_name(&cpu->machine->symbol_context,
355                      cpu->cd.arm.r[ARM_PC], &offset);                      cpu->pc, &offset);
356                  debug("cpu%i:  cpsr = ", x);                  debug("cpu%i:  cpsr = ", x);
357                  debug("%s%s%s%s%s%s",                  debug("%s%s%s%s%s%s",
358                      (cpu->cd.arm.cpsr & ARM_FLAG_N)? "N" : "n",                      (cpu->cd.arm.cpsr & ARM_FLAG_N)? "N" : "n",
# Line 279  void arm_cpu_register_dump(struct cpu *c Line 362  void arm_cpu_register_dump(struct cpu *c
362                      (cpu->cd.arm.cpsr & ARM_FLAG_I)? "I" : "i",                      (cpu->cd.arm.cpsr & ARM_FLAG_I)? "I" : "i",
363                      (cpu->cd.arm.cpsr & ARM_FLAG_F)? "F" : "f");                      (cpu->cd.arm.cpsr & ARM_FLAG_F)? "F" : "f");
364                  if (mode < ARM_MODE_USR32)                  if (mode < ARM_MODE_USR32)
365                          debug("   pc =  0x%07x",                          debug("   pc =  0x%07x", (int)(cpu->pc & 0x03ffffff));
                             (int)(cpu->cd.arm.r[ARM_PC] & 0x03ffffff));  
366                  else                  else
367                          debug("   pc = 0x%08x", (int)cpu->cd.arm.r[ARM_PC]);                          debug("   pc = 0x%08x", (int)cpu->pc);
368    
369                  debug("  <%s>\n", symbol != NULL? symbol : " no symbol ");                  debug("  <%s>\n", symbol != NULL? symbol : " no symbol ");
370    
# Line 319  void arm_cpu_register_dump(struct cpu *c Line 401  void arm_cpu_register_dump(struct cpu *c
401                  }                  }
402    
403                  if (m != ARM_MODE_USR32 && m != ARM_MODE_SYS32) {                  if (m != ARM_MODE_USR32 && m != ARM_MODE_SYS32) {
404                          debug("cpu%i:  usr r8..r14 =", x);                          debug("cpu%i:  usr r8-14:", x);
405                          for (i=0; i<7; i++)                          for (i=0; i<7; i++)
406                                  debug(" %08x", cpu->cd.arm.default_r8_r14[i]);                                  debug(" %08x", cpu->cd.arm.default_r8_r14[i]);
407                          debug("\n");                          debug("\n");
408                  }                  }
409    
410                  if (m != ARM_MODE_FIQ32) {                  if (m != ARM_MODE_FIQ32) {
411                          debug("cpu%i:  fiq r8..r14 =", x);                          debug("cpu%i:  fiq r8-14:", x);
412                          for (i=0; i<7; i++)                          for (i=0; i<7; i++)
413                                  debug(" %08x", cpu->cd.arm.fiq_r8_r14[i]);                                  debug(" %08x", cpu->cd.arm.fiq_r8_r14[i]);
414                          debug("\n");                          debug("\n");
415                  }                  }
416    
417                  if (m != ARM_MODE_IRQ32) {                  if (m != ARM_MODE_IRQ32) {
418                          debug("cpu%i:  irq r13..r14 =", x);                          debug("cpu%i:  irq r13-14:", x);
419                          for (i=0; i<2; i++)                          for (i=0; i<2; i++)
420                                  debug(" %08x", cpu->cd.arm.irq_r13_r14[i]);                                  debug(" %08x", cpu->cd.arm.irq_r13_r14[i]);
421                          debug("\n");                          debug("\n");
422                  }                  }
423    
424                  if (m != ARM_MODE_SVC32) {                  if (m != ARM_MODE_SVC32) {
425                          debug("cpu%i:  svc r13..r14 =", x);                          debug("cpu%i:  svc r13-14:", x);
426                          for (i=0; i<2; i++)                          for (i=0; i<2; i++)
427                                  debug(" %08x", cpu->cd.arm.svc_r13_r14[i]);                                  debug(" %08x", cpu->cd.arm.svc_r13_r14[i]);
428                          debug("\n");                          debug("\n");
429                  }                  }
430    
431                  if (m != ARM_MODE_ABT32) {                  if (m != ARM_MODE_ABT32) {
432                          debug("cpu%i:  abt r13..r14 =", x);                          debug("cpu%i:  abt r13-14:", x);
433                          for (i=0; i<2; i++)                          for (i=0; i<2; i++)
434                                  debug(" %08x", cpu->cd.arm.abt_r13_r14[i]);                                  debug(" %08x", cpu->cd.arm.abt_r13_r14[i]);
435                          debug("\n");                          debug("\n");
436                  }                  }
437    
438                  if (m != ARM_MODE_UND32) {                  if (m != ARM_MODE_UND32) {
439                          debug("cpu%i:  und r13..r14 =", x);                          debug("cpu%i:  und r13-14:", x);
440                          for (i=0; i<2; i++)                          for (i=0; i<2; i++)
441                                  debug(" %08x", cpu->cd.arm.und_r13_r14[i]);                                  debug(" %08x", cpu->cd.arm.und_r13_r14[i]);
442                          debug("\n");                          debug("\n");
# Line 391  void arm_cpu_register_dump(struct cpu *c Line 473  void arm_cpu_register_dump(struct cpu *c
473                      cpu->cd.arm.control &                      cpu->cd.arm.control &
474                      ARM_CONTROL_V? "yes (0xffff0000)" : "no");                      ARM_CONTROL_V? "yes (0xffff0000)" : "no");
475    
476                    /*  TODO: auxctrl on which CPU types?  */
477                    if (cpu->cd.arm.cpu_type.flags & ARM_XSCALE) {
478                            debug("cpu%i:  auxctrl = 0x%08x\n", x,
479                                cpu->cd.arm.auxctrl);
480                            debug("cpu%i:      minidata cache attr = 0x%x\n", x,
481                                (cpu->cd.arm.auxctrl & ARM_AUXCTRL_MD)
482                                >> ARM_AUXCTRL_MD_SHIFT);
483                            debug("cpu%i:      page table memory attr: %i\n", x,
484                                (cpu->cd.arm.auxctrl & ARM_AUXCTRL_P)? 1 : 0);
485                            debug("cpu%i:      write buffer coalescing: %s\n", x,
486                                (cpu->cd.arm.auxctrl & ARM_AUXCTRL_K)?
487                                "disabled" : "enabled");
488                    }
489    
490                  debug("cpu%i:  ttb = 0x%08x  dacr = 0x%08x\n", x,                  debug("cpu%i:  ttb = 0x%08x  dacr = 0x%08x\n", x,
491                      cpu->cd.arm.ttb, cpu->cd.arm.dacr);                      cpu->cd.arm.ttb, cpu->cd.arm.dacr);
492                  debug("cpu%i:  fsr = 0x%08x  far = 0x%08x\n", x,                  debug("cpu%i:  fsr = 0x%08x  far = 0x%08x\n", x,
# Line 400  void arm_cpu_register_dump(struct cpu *c Line 496  void arm_cpu_register_dump(struct cpu *c
496    
497    
498  /*  /*
  *  arm_cpu_show_full_statistics():  
  *  
  *  Show detailed statistics on opcode usage on each cpu.  
  */  
 void arm_cpu_show_full_statistics(struct machine *m)  
 {  
         fatal("arm_cpu_show_full_statistics(): TODO\n");  
 }  
   
   
 /*  
  *  arm_cpu_tlbdump():  
  *  
  *  Called from the debugger to dump the TLB in a readable format.  
  *  x is the cpu number to dump, or -1 to dump all CPUs.  
  *  
  *  If rawflag is nonzero, then the TLB contents isn't formated nicely,  
  *  just dumped.  
  */  
 void arm_cpu_tlbdump(struct machine *m, int x, int rawflag)  
 {  
         fatal("arm_cpu_tlbdump(): TODO\n");  
 }  
   
   
 /*  
499   *  arm_save_register_bank():   *  arm_save_register_bank():
500   */   */
501  void arm_save_register_bank(struct cpu *cpu)  void arm_save_register_bank(struct cpu *cpu)
# Line 442  void arm_save_register_bank(struct cpu * Line 512  void arm_save_register_bank(struct cpu *
512                      &cpu->cd.arm.r[8], sizeof(uint32_t) * 7);                      &cpu->cd.arm.r[8], sizeof(uint32_t) * 7);
513                  break;                  break;
514          case ARM_MODE_IRQ32:          case ARM_MODE_IRQ32:
515                    memcpy(cpu->cd.arm.default_r8_r14,
516                        &cpu->cd.arm.r[8], sizeof(uint32_t) * 5);
517                  cpu->cd.arm.irq_r13_r14[0] = cpu->cd.arm.r[13];                  cpu->cd.arm.irq_r13_r14[0] = cpu->cd.arm.r[13];
518                  cpu->cd.arm.irq_r13_r14[1] = cpu->cd.arm.r[14];                  cpu->cd.arm.irq_r13_r14[1] = cpu->cd.arm.r[14];
519                  break;                  break;
520          case ARM_MODE_SVC32:          case ARM_MODE_SVC32:
521  if ((cpu->cd.arm.r[13] & 0xffff0000) == 0xffff0000) {                  memcpy(cpu->cd.arm.default_r8_r14,
522          fatal("NEJ! pc=0x%08x\n", (int)cpu->pc);                      &cpu->cd.arm.r[8], sizeof(uint32_t) * 5);
         exit(1);  
 }  
523                  cpu->cd.arm.svc_r13_r14[0] = cpu->cd.arm.r[13];                  cpu->cd.arm.svc_r13_r14[0] = cpu->cd.arm.r[13];
524                  cpu->cd.arm.svc_r13_r14[1] = cpu->cd.arm.r[14];                  cpu->cd.arm.svc_r13_r14[1] = cpu->cd.arm.r[14];
525                  break;                  break;
526          case ARM_MODE_ABT32:          case ARM_MODE_ABT32:
527                    memcpy(cpu->cd.arm.default_r8_r14,
528                        &cpu->cd.arm.r[8], sizeof(uint32_t) * 5);
529                  cpu->cd.arm.abt_r13_r14[0] = cpu->cd.arm.r[13];                  cpu->cd.arm.abt_r13_r14[0] = cpu->cd.arm.r[13];
530                  cpu->cd.arm.abt_r13_r14[1] = cpu->cd.arm.r[14];                  cpu->cd.arm.abt_r13_r14[1] = cpu->cd.arm.r[14];
531                  break;                  break;
532          case ARM_MODE_UND32:          case ARM_MODE_UND32:
533                    memcpy(cpu->cd.arm.default_r8_r14,
534                        &cpu->cd.arm.r[8], sizeof(uint32_t) * 5);
535                  cpu->cd.arm.und_r13_r14[0] = cpu->cd.arm.r[13];                  cpu->cd.arm.und_r13_r14[0] = cpu->cd.arm.r[13];
536                  cpu->cd.arm.und_r13_r14[1] = cpu->cd.arm.r[14];                  cpu->cd.arm.und_r13_r14[1] = cpu->cd.arm.r[14];
537                  break;                  break;
# Line 485  void arm_load_register_bank(struct cpu * Line 559  void arm_load_register_bank(struct cpu *
559                      sizeof(uint32_t) * 7);                      sizeof(uint32_t) * 7);
560                  break;                  break;
561          case ARM_MODE_IRQ32:          case ARM_MODE_IRQ32:
562                    memcpy(&cpu->cd.arm.r[8],
563                        cpu->cd.arm.default_r8_r14, sizeof(uint32_t) * 5);
564                  cpu->cd.arm.r[13] = cpu->cd.arm.irq_r13_r14[0];                  cpu->cd.arm.r[13] = cpu->cd.arm.irq_r13_r14[0];
565                  cpu->cd.arm.r[14] = cpu->cd.arm.irq_r13_r14[1];                  cpu->cd.arm.r[14] = cpu->cd.arm.irq_r13_r14[1];
566                  break;                  break;
567          case ARM_MODE_SVC32:          case ARM_MODE_SVC32:
568                    memcpy(&cpu->cd.arm.r[8],
569                        cpu->cd.arm.default_r8_r14, sizeof(uint32_t) * 5);
570                  cpu->cd.arm.r[13] = cpu->cd.arm.svc_r13_r14[0];                  cpu->cd.arm.r[13] = cpu->cd.arm.svc_r13_r14[0];
571                  cpu->cd.arm.r[14] = cpu->cd.arm.svc_r13_r14[1];                  cpu->cd.arm.r[14] = cpu->cd.arm.svc_r13_r14[1];
572                  break;                  break;
573          case ARM_MODE_ABT32:          case ARM_MODE_ABT32:
574                    memcpy(&cpu->cd.arm.r[8],
575                        cpu->cd.arm.default_r8_r14, sizeof(uint32_t) * 5);
576                  cpu->cd.arm.r[13] = cpu->cd.arm.abt_r13_r14[0];                  cpu->cd.arm.r[13] = cpu->cd.arm.abt_r13_r14[0];
577                  cpu->cd.arm.r[14] = cpu->cd.arm.abt_r13_r14[1];                  cpu->cd.arm.r[14] = cpu->cd.arm.abt_r13_r14[1];
578                  break;                  break;
579          case ARM_MODE_UND32:          case ARM_MODE_UND32:
580                    memcpy(&cpu->cd.arm.r[8],
581                        cpu->cd.arm.default_r8_r14, sizeof(uint32_t) * 5);
582                  cpu->cd.arm.r[13] = cpu->cd.arm.und_r13_r14[0];                  cpu->cd.arm.r[13] = cpu->cd.arm.und_r13_r14[0];
583                  cpu->cd.arm.r[14] = cpu->cd.arm.und_r13_r14[1];                  cpu->cd.arm.r[14] = cpu->cd.arm.und_r13_r14[1];
584                  break;                  break;
# Line 512  void arm_load_register_bank(struct cpu * Line 594  void arm_load_register_bank(struct cpu *
594   */   */
595  void arm_exception(struct cpu *cpu, int exception_nr)  void arm_exception(struct cpu *cpu, int exception_nr)
596  {  {
         int arm_exception_to_mode[N_ARM_EXCEPTIONS] = ARM_EXCEPTION_TO_MODE;  
597          int oldmode, newmode;          int oldmode, newmode;
598          uint32_t retaddr;          uint32_t retaddr;
599    
# Line 523  void arm_exception(struct cpu *cpu, int Line 604  void arm_exception(struct cpu *cpu, int
604    
605          retaddr = cpu->pc;          retaddr = cpu->pc;
606    
607          debug("[ arm_exception(): ");          if (!quiet_mode) {
608                    debug("[ arm_exception(): ");
609                    switch (exception_nr) {
610                    case ARM_EXCEPTION_RESET:
611                            fatal("RESET: TODO");
612                            break;
613                    case ARM_EXCEPTION_UND:
614                            debug("UNDEFINED");
615                            break;
616                    case ARM_EXCEPTION_SWI:
617                            debug("SWI");
618                            break;
619                    case ARM_EXCEPTION_PREF_ABT:
620                            debug("PREFETCH ABORT");
621                            break;
622                    case ARM_EXCEPTION_IRQ:
623                            debug("IRQ");
624                            break;
625                    case ARM_EXCEPTION_FIQ:
626                            debug("FIQ");
627                            break;
628                    case ARM_EXCEPTION_DATA_ABT:
629                            debug("DATA ABORT, far=0x%08x fsr=0x%02x",
630                                cpu->cd.arm.far, cpu->cd.arm.fsr);
631                            break;
632                    }
633                    debug(" ]\n");
634            }
635    
636          switch (exception_nr) {          switch (exception_nr) {
637          case ARM_EXCEPTION_RESET:          case ARM_EXCEPTION_RESET:
638                  cpu->running = 0;                  cpu->running = 0;
639                  fatal("RESET: TODO");                  fatal("ARM RESET: TODO");
640                  exit(1);                  exit(1);
         case ARM_EXCEPTION_UND:  
                 debug("UNDEFINED");  
                 retaddr += 4;  
                 break;  
         case ARM_EXCEPTION_SWI:  
                 debug("SWI");  
                 retaddr += 4;  
                 break;  
         case ARM_EXCEPTION_PREF_ABT:  
                 debug("PREFETCH ABORT");  
                 retaddr += 4;  
                 break;  
         case ARM_EXCEPTION_IRQ:  
                 debug("IRQ");  
                 retaddr += 4;  
                 break;  
         case ARM_EXCEPTION_FIQ:  
                 debug("FIQ");  
                 retaddr += 4;  
                 break;  
641          case ARM_EXCEPTION_DATA_ABT:          case ARM_EXCEPTION_DATA_ABT:
642                  debug("DATA ABORT, far=0x%08x fsr=0x%02x",                  retaddr += 4;
                     cpu->cd.arm.far, cpu->cd.arm.fsr);  
                 retaddr += 8;  
643                  break;                  break;
644          }          }
645    
646          debug(" ]\n");          retaddr += 4;
647    
648          arm_save_register_bank(cpu);          arm_save_register_bank(cpu);
649    
650            cpu->cd.arm.cpsr &= 0x0fffffff;
651            cpu->cd.arm.cpsr |= (cpu->cd.arm.flags << 28);
652    
653          switch (arm_exception_to_mode[exception_nr]) {          switch (arm_exception_to_mode[exception_nr]) {
654          case ARM_MODE_SVC32:          case ARM_MODE_SVC32:
655                  cpu->cd.arm.spsr_svc = cpu->cd.arm.cpsr; break;                  cpu->cd.arm.spsr_svc = cpu->cd.arm.cpsr; break;
# Line 587  void arm_exception(struct cpu *cpu, int Line 676  void arm_exception(struct cpu *cpu, int
676          cpu->cd.arm.cpsr &= ~ARM_FLAG_MODE;          cpu->cd.arm.cpsr &= ~ARM_FLAG_MODE;
677          cpu->cd.arm.cpsr |= arm_exception_to_mode[exception_nr];          cpu->cd.arm.cpsr |= arm_exception_to_mode[exception_nr];
678    
679            /*
680             *  Usually, an exception should change modes (so that saved status
681             *  bits don't get lost). However, Linux on ARM seems to use floating
682             *  point instructions in the kernel (!), and it emulates those using
683             *  its own fp emulation code. This leads to a situation where we
684             *  sometimes change from SVC32 to SVC32.
685             */
686          newmode = cpu->cd.arm.cpsr & ARM_FLAG_MODE;          newmode = cpu->cd.arm.cpsr & ARM_FLAG_MODE;
687          if (oldmode == newmode) {          if (oldmode == newmode && oldmode != ARM_MODE_SVC32) {
688                  fatal("Exception caused no mode change? TODO\n");                  fatal("[ WARNING! Exception caused no mode change? "
689                  exit(1);                      "mode 0x%02x (pc=0x%x) ]\n", newmode, (int)cpu->pc);
690                    /*  exit(1);  */
691          }          }
692    
693          cpu->cd.arm.cpsr |= ARM_FLAG_I;          cpu->cd.arm.cpsr |= ARM_FLAG_I;
# Line 601  void arm_exception(struct cpu *cpu, int Line 698  void arm_exception(struct cpu *cpu, int
698          /*  Load the new register bank, if we switched:  */          /*  Load the new register bank, if we switched:  */
699          arm_load_register_bank(cpu);          arm_load_register_bank(cpu);
700    
701          /*  Set the return address and new PC:  */          /*
702             *  Set the return address and new PC.
703             *
704             *  NOTE: r[ARM_PC] is also set; see cpu_arm_instr_loadstore.c for
705             *  details. (If an exception occurs during a load into the pc
706             *  register, the code in that file assumes that the r[ARM_PC]
707             *  was changed to the address of the exception handler.)
708             */
709          cpu->cd.arm.r[ARM_LR] = retaddr;          cpu->cd.arm.r[ARM_LR] = retaddr;
   
710          cpu->pc = cpu->cd.arm.r[ARM_PC] = exception_nr * 4 +          cpu->pc = cpu->cd.arm.r[ARM_PC] = exception_nr * 4 +
711              ((cpu->cd.arm.control & ARM_CONTROL_V)? 0xffff0000 : 0);              ((cpu->cd.arm.control & ARM_CONTROL_V)? 0xffff0000 : 0);
712          arm_pc_to_pointers(cpu);          quick_pc_to_pointers(cpu);
713    }
714    
715    
716    /*
717     *  arm_cpu_tlbdump():
718     *
719     *  Called from the debugger to dump the TLB in a readable format.
720     *  x is the cpu number to dump, or -1 to dump all CPUs.
721     *
722     *  If rawflag is nonzero, then the TLB contents isn't formated nicely,
723     *  just dumped.
724     */
725    void arm_cpu_tlbdump(struct machine *m, int x, int rawflag)
726    {
727    }
728    
729    
730    static void add_response_word(struct cpu *cpu, char *r, uint32_t value,
731            size_t maxlen)
732    {
733            if (cpu->byte_order == EMUL_LITTLE_ENDIAN) {
734                    value = ((value & 0xff) << 24) +
735                            ((value & 0xff00) << 8) +
736                            ((value & 0xff0000) >> 8) +
737                            ((value & 0xff000000) >> 24);
738            }
739            snprintf(r + strlen(r), maxlen - strlen(r), "%08"PRIx32, value);
740    }
741    
742    
743    /*
744     *  arm_cpu_gdb_stub():
745     *
746     *  Execute a "remote GDB" command. Returns a newly allocated response string
747     *  on success, NULL on failure.
748     */
749    char *arm_cpu_gdb_stub(struct cpu *cpu, char *cmd)
750    {
751            if (strcmp(cmd, "g") == 0) {
752                    /*  15 gprs, pc, 8 fprs, fps, cpsr.  */
753                    int i;
754                    char *r;
755                    size_t len = 1 + 18 * sizeof(uint32_t);
756                    r = malloc(len);
757                    if (r == NULL) {
758                            fprintf(stderr, "out of memory\n");
759                            exit(1);
760                    }
761                    r[0] = '\0';
762                    for (i=0; i<15; i++)
763                            add_response_word(cpu, r, cpu->cd.arm.r[i], len);
764                    add_response_word(cpu, r, cpu->pc, len);
765                    /*  TODO: fprs:  */
766                    for (i=0; i<8; i++)
767                            add_response_word(cpu, r, 0, len);
768                    /*  TODO: fps  */
769                    add_response_word(cpu, r, 0, len);
770                    add_response_word(cpu, r, cpu->cd.arm.cpsr, len);
771                    return r;
772            }
773    
774            if (cmd[0] == 'p') {
775                    int regnr = strtol(cmd + 1, NULL, 16);
776                    size_t len = 2 * sizeof(uint32_t) + 1;
777                    char *r = malloc(len);
778                    r[0] = '\0';
779                    if (regnr == ARM_PC) {
780                            add_response_word(cpu, r, cpu->pc, len);
781                    } else if (regnr >= 0 && regnr < ARM_PC) {
782                            add_response_word(cpu, r, cpu->cd.arm.r[regnr], len);
783                    } else if (regnr >= 0x10 && regnr <= 0x17) {
784                            /*  TODO: fprs  */
785                            add_response_word(cpu, r, 0, len);
786                            add_response_word(cpu, r, 0, len);
787                            add_response_word(cpu, r, 0, len);
788                    } else if (regnr == 0x18) {
789                            /*  TODO: fps  */
790                            add_response_word(cpu, r, 0, len);
791                    } else if (regnr == 0x19) {
792                            add_response_word(cpu, r, cpu->cd.arm.cpsr, len);
793                    }
794                    return r;
795            }
796    
797            fatal("arm_cpu_gdb_stub(): TODO\n");
798            return NULL;
799  }  }
800    
801    
# Line 620  void arm_exception(struct cpu *cpu, int Line 809  void arm_exception(struct cpu *cpu, int
809   */   */
810  int arm_cpu_interrupt(struct cpu *cpu, uint64_t irq_nr)  int arm_cpu_interrupt(struct cpu *cpu, uint64_t irq_nr)
811  {  {
812          /*  fatal("arm_cpu_interrupt(): 0x%llx\n", (int)irq_nr);  */          /*  fatal("arm_cpu_interrupt(): 0x%x\n", (int)irq_nr);  */
813          if (irq_nr <= 64) {          if (irq_nr <= 64) {
814                  if (cpu->machine->md_interrupt != NULL)                  if (cpu->machine->md_interrupt != NULL)
815                          cpu->machine->md_interrupt(cpu->machine,                          cpu->machine->md_interrupt(cpu->machine,
816                              cpu, irq_nr, 1);                              cpu, irq_nr, 1);
817                  else                  else
818                          fatal("arm_cpu_interrupt(): md_interrupt == NULL\n");                          fatal("arm_cpu_interrupt(): irq_nr=%i md_interrupt =="
819                                " NULL\n", (int)irq_nr);
820          } else {          } else {
821                  /*  Assert ARM IRQs:  */                  /*  Assert ARM IRQs:  */
822                  cpu->cd.arm.irq_asserted = 1;                  cpu->cd.arm.irq_asserted = 1;
# Line 667  int arm_cpu_interrupt_ack(struct cpu *cp Line 857  int arm_cpu_interrupt_ack(struct cpu *cp
857   *  cpu->pc for relative addresses.   *  cpu->pc for relative addresses.
858   */                       */                    
859  int arm_cpu_disassemble_instr(struct cpu *cpu, unsigned char *ib,  int arm_cpu_disassemble_instr(struct cpu *cpu, unsigned char *ib,
860          int running, uint64_t dumpaddr, int bintrans)          int running, uint64_t dumpaddr)
861  {  {
862          uint32_t iw, tmp;          uint32_t iw, tmp;
863          int main_opcode, secondary_opcode, s_bit, r16, r12, r8;          int main_opcode, secondary_opcode, s_bit, r16, r12, r8;
# Line 740  int arm_cpu_disassemble_instr(struct cpu Line 930  int arm_cpu_disassemble_instr(struct cpu
930                          int a_bit = (iw >> 21) & 1;                          int a_bit = (iw >> 21) & 1;
931                          debug("%s%sl%s%s\t", u_bit? "s" : "u",                          debug("%s%sl%s%s\t", u_bit? "s" : "u",
932                              a_bit? "mla" : "mul", condition, s_bit? "s" : "");                              a_bit? "mla" : "mul", condition, s_bit? "s" : "");
933                          debug("%s,", arm_regname[r12]);                          debug("%s,%s,", arm_regname[r12], arm_regname[r16]);
934                          debug("%s,", arm_regname[r16]);                          debug("%s,%s\n", arm_regname[iw&15], arm_regname[r8]);
935                          debug("%s,", arm_regname[iw & 15]);                          break;
936                          debug("%s\n", arm_regname[r8]);                  }
937    
938                    /*
939                     *  xxxx0001 0000nnnn dddd0000 0101mmmm  qadd Rd,Rm,Rn
940                     *  xxxx0001 0010nnnn dddd0000 0101mmmm  qsub Rd,Rm,Rn
941                     *  xxxx0001 0100nnnn dddd0000 0101mmmm  qdadd Rd,Rm,Rn
942                     *  xxxx0001 0110nnnn dddd0000 0101mmmm  qdsub Rd,Rm,Rn
943                     */
944                    if ((iw & 0x0f900ff0) == 0x01000050) {
945                            debug("q%s%s%s\t", iw & 0x400000? "d" : "",
946                                iw & 0x200000? "sub" : "add", condition);
947                            debug("%s,%s,%s\n", arm_regname[r12],
948                                arm_regname[iw&15], arm_regname[r16]);
949                          break;                          break;
950                  }                  }
951    
# Line 801  int arm_cpu_disassemble_instr(struct cpu Line 1003  int arm_cpu_disassemble_instr(struct cpu
1003                  }                  }
1004    
1005                  /*                  /*
1006                     *  xxxx0001 01101111 dddd1111 0001mmmm    CLZ Rd,Rm
1007                     */
1008                    if ((iw & 0x0fff0ff0) == 0x016f0f10) {
1009                            debug("clz%s\t", condition);
1010                            debug("%s,%s\n", arm_regname[r12], arm_regname[iw&15]);
1011                            break;
1012                    }
1013    
1014                    /*
1015                     *  xxxx0001 0000dddd nnnnssss 1yx0mmmm  SMLAxy Rd,Rm,Rs,Rn
1016                     *  xxxx0001 0100dddd DDDDssss 1yx0mmmm  SMLALxy RdL,RdH,Rm,Rs
1017                     *  xxxx0001 0010dddd nnnnssss 1y00mmmm  SMLAWy Rd,Rm,Rs,Rn
1018                     *  xxxx0001 0110dddd 0000ssss 1yx0mmmm  SMULxy Rd,Rm,Rs
1019                     *  xxxx0001 0010dddd 0000ssss 1y10mmmm  SMULWy Rd,Rm,Rs
1020                     */
1021                    if ((iw & 0x0ff00090) == 0x01000080) {
1022                            debug("smla%s%s%s\t",
1023                                iw & 0x20? "t" : "b", iw & 0x40? "t" : "b",
1024                                condition);
1025                            debug("%s,%s,%s,%s\n", arm_regname[r16],
1026                                arm_regname[iw&15], arm_regname[r8],
1027                                arm_regname[r12]);
1028                            break;
1029                    }
1030                    if ((iw & 0x0ff00090) == 0x01400080) {
1031                            debug("smlal%s%s%s\t",
1032                                iw & 0x20? "t" : "b", iw & 0x40? "t" : "b",
1033                                condition);
1034                            debug("%s,%s,%s,%s\n", arm_regname[r12],
1035                                arm_regname[r16], arm_regname[iw&15],
1036                                arm_regname[r8]);
1037                            break;
1038                    }
1039                    if ((iw & 0x0ff000b0) == 0x01200080) {
1040                            debug("smlaw%s%s\t", iw & 0x40? "t" : "b",
1041                                condition);
1042                            debug("%s,%s,%s,%s\n", arm_regname[r16],
1043                                arm_regname[iw&15], arm_regname[r8],
1044                                arm_regname[r12]);
1045                            break;
1046                    }
1047                    if ((iw & 0x0ff0f090) == 0x01600080) {
1048                            debug("smul%s%s%s\t",
1049                                iw & 0x20? "t" : "b", iw & 0x40? "t" : "b",
1050                                condition);
1051                            debug("%s,%s,%s\n", arm_regname[r16],
1052                                arm_regname[iw&15], arm_regname[r8]);
1053                            break;
1054                    }
1055                    if ((iw & 0x0ff0f0b0) == 0x012000a0) {
1056                            debug("smulw%s%s\t", iw & 0x40? "t" : "b",
1057                                condition);
1058                            debug("%s,%s,%s\n", arm_regname[r16],
1059                                arm_regname[iw&15], arm_regname[r8]);
1060                            break;
1061                    }
1062    
1063                    /*
1064                   *  xxxx000P U1WLnnnn ddddHHHH 1SH1LLLL load/store rd,imm(rn)                   *  xxxx000P U1WLnnnn ddddHHHH 1SH1LLLL load/store rd,imm(rn)
1065                   */                   */
1066                  if ((iw & 0x0e000090) == 0x00000090) {                  if ((iw & 0x0e000090) == 0x00000090) {
1067                            char *op = "st";
1068                          int imm = ((iw >> 4) & 0xf0) | (iw & 0xf);                          int imm = ((iw >> 4) & 0xf0) | (iw & 0xf);
1069                          int regform = !(iw & 0x00400000);                          int regform = !(iw & 0x00400000);
1070                          p_bit = main_opcode & 1;                          p_bit = main_opcode & 1;
# Line 816  int arm_cpu_disassemble_instr(struct cpu Line 1077  int arm_cpu_disassemble_instr(struct cpu
1077                                  break;                                  break;
1078                          }                          }
1079                          /*  Semi-generic case:  */                          /*  Semi-generic case:  */
1080                          debug("%sr%s", iw & 0x00100000? "ld" : "st",                          if (iw & 0x00100000)
1081                              condition);                                  op = "ld";
1082                            if (!l_bit && (iw & 0xd0) == 0xd0)
1083                                    op = iw & 0x20? "st" : "ld";
1084                            debug("%sr%s", op, condition);
1085                          if (!l_bit && (iw & 0xd0) == 0xd0) {                          if (!l_bit && (iw & 0xd0) == 0xd0) {
1086                                  debug("d");             /*  Double-register  */                                  debug("d");             /*  Double-register  */
1087                          } else {                          } else {
# Line 1017  int arm_cpu_disassemble_instr(struct cpu Line 1281  int arm_cpu_disassemble_instr(struct cpu
1281                                  } else {                                  } else {
1282                                          tmpw[0] = addr = cpu->cd.arm.r[r12];                                          tmpw[0] = addr = cpu->cd.arm.r[r12];
1283                                          if (r12 == ARM_PC)                                          if (r12 == ARM_PC)
1284                                                  addr += 8;                                                  addr = cpu->pc + 8;
1285                                  }                                  }
1286                                  debug(": ");                                  debug(": ");
1287                                  if (b_bit)                                  if (b_bit)
# Line 1081  int arm_cpu_disassemble_instr(struct cpu Line 1345  int arm_cpu_disassemble_instr(struct cpu
1345                  break;                  break;
1346          case 0xc:                               /*  Coprocessor  */          case 0xc:                               /*  Coprocessor  */
1347          case 0xd:                               /*  LDC/STC  */          case 0xd:                               /*  LDC/STC  */
1348                    /*
1349                     *  xxxx1100 0100nnnn ddddcccc oooommmm    MCRR c,op,Rd,Rn,CRm
1350                     *  xxxx1100 0101nnnn ddddcccc oooommmm    MRRC c,op,Rd,Rn,CRm
1351                     */
1352                    if ((iw & 0x0fe00fff) == 0x0c400000) {
1353                            debug("%s%s\t", iw & 0x100000? "mra" : "mar",
1354                                condition);
1355                            if (iw & 0x100000)
1356                                    debug("%s,%s,acc0\n",
1357                                        arm_regname[r12], arm_regname[r16]);
1358                            else
1359                                    debug("acc0,%s,%s\n",
1360                                        arm_regname[r12], arm_regname[r16]);
1361                            break;
1362                    }
1363                    if ((iw & 0x0fe00000) == 0x0c400000) {
1364                            debug("%s%s\t", iw & 0x100000? "mrrc" : "mcrr",
1365                                condition);
1366                            debug("%i,%i,%s,%s,cr%i\n", r8, (iw >> 4) & 15,
1367                                arm_regname[r12], arm_regname[r16], iw & 15);
1368                            break;
1369                    }
1370    
1371                  /*  xxxx110P UNWLnnnn DDDDpppp oooooooo LDC/STC  */                  /*  xxxx110P UNWLnnnn DDDDpppp oooooooo LDC/STC  */
1372                  debug("TODO: coprocessor LDC/STC\n");                  debug("TODO: coprocessor LDC/STC\n");
1373                  break;                  break;
# Line 1089  int arm_cpu_disassemble_instr(struct cpu Line 1376  int arm_cpu_disassemble_instr(struct cpu
1376                   *  xxxx1110 oooonnnn ddddpppp qqq0mmmm         CDP                   *  xxxx1110 oooonnnn ddddpppp qqq0mmmm         CDP
1377                   *  xxxx1110 oooLNNNN ddddpppp qqq1MMMM         MRC/MCR                   *  xxxx1110 oooLNNNN ddddpppp qqq1MMMM         MRC/MCR
1378                   */                   */
1379                    if ((iw & 0x0ff00ff0) == 0x0e200010) {
1380                            /*  Special case: mia* DSP instructions  */
1381                            switch ((iw >> 16) & 0xf) {
1382                            case  0: debug("mia"); break;
1383                            case  8: debug("miaph"); break;
1384                            case 12: debug("miaBB"); break;
1385                            case 13: debug("miaTB"); break;
1386                            case 14: debug("miaBT"); break;
1387                            case 15: debug("miaTT"); break;
1388                            default: debug("UNKNOWN mia vector instruction?");
1389                            }
1390                            debug("%s\t", condition);
1391                            debug("acc%i,%s,%s\n", ((iw >> 5) & 7),
1392                                arm_regname[iw & 15], arm_regname[r12]);
1393                            break;
1394                    }
1395                  if (iw & 0x10) {                  if (iw & 0x10) {
1396                          debug("%s%s\t",                          debug("%s%s\t",
1397                              (iw & 0x00100000)? "mrc" : "mcr", condition);                              (iw & 0x00100000)? "mrc" : "mcr", condition);
# Line 1145  void arm_mcr_mrc(struct cpu *cpu, uint32 Line 1448  void arm_mcr_mrc(struct cpu *cpu, uint32
1448                  cpu->cd.arm.coproc[cp_num](cpu, opcode1, opcode2, l_bit,                  cpu->cd.arm.coproc[cp_num](cpu, opcode1, opcode2, l_bit,
1449                      crn, crm, rd);                      crn, crm, rd);
1450          else {          else {
1451                  fatal("arm_mcr_mrc: pc=0x%08x, iword=0x%08x: "                  fatal("[ arm_mcr_mrc: pc=0x%08x, iword=0x%08x: "
1452                      "cp_num=%i\n", (int)cpu->pc, iword, cp_num);                      "cp_num=%i ]\n", (int)cpu->pc, iword, cp_num);
1453                  exit(1);                  arm_exception(cpu, ARM_EXCEPTION_UND);
1454                    /*  exit(1);  */
1455          }          }
1456  }  }
1457    
# Line 1162  void arm_mcr_mrc(struct cpu *cpu, uint32 Line 1466  void arm_mcr_mrc(struct cpu *cpu, uint32
1466   */   */
1467  void arm_cdp(struct cpu *cpu, uint32_t iword)  void arm_cdp(struct cpu *cpu, uint32_t iword)
1468  {  {
1469          fatal("arm_cdp: pc=0x%08x, iword=0x%08x\n", (int)cpu->pc, iword);          fatal("[ arm_cdp: pc=0x%08x, iword=0x%08x ]\n", (int)cpu->pc, iword);
1470          exit(1);          arm_exception(cpu, ARM_EXCEPTION_UND);
1471            /*  exit(1);  */
1472  }  }
1473    
1474    
Legend:
Removed from v.14  
changed lines
  Added in v.26
  ViewVC Help
Powered by ViewVC 1.1.26