cpu/Cyclone/Main.cpp

   1 \r
   2 #include "app.h"\r
   3 \r
   4 static FILE *AsmFile=NULL;\r
   5 \r
   6 static int CycloneVer=0x0086; // Version number of library\r
   7 int *CyJump=NULL; // Jump table\r
   8 int ms=USE_MS_SYNTAX; // If non-zero, output in Microsoft ARMASM format\r
   9 char *Narm[4]={ "b", "h","",""}; // Normal ARM Extensions for operand sizes 0,1,2\r
  10 char *Sarm[4]={"sb","sh","",""}; // Sign-extend ARM Extensions for operand sizes 0,1,2\r
  11 int Cycles; // Current cycles for opcode\r
  12 \r
  13 \r
  14 void ot(const char *format, ...)\r
  15 {\r
  16   va_list valist=NULL;\r
  17   int i, len;\r
  18 \r
  19   // notaz: stop me from leaving newlines in the middle of format string\r
  20   // and generating bad code\r
  21   for(i=0, len=strlen(format); i < len && format[i] != '\n'; i++);\r
  22   if(i < len-1 && format[len-1] != '\n') printf("\nWARNING: possible improper newline placement:\n%s\n", format);\r
  23 \r
  24   va_start(valist,format);\r
  25   if (AsmFile) vfprintf(AsmFile,format,valist);\r
  26   va_end(valist);\r
  27 }\r
  28 \r
  29 void ltorg()\r
  30 {\r
  31   if (ms) ot("  LTORG\n");\r
  32   else    ot("  .ltorg\n");\r
  33 }\r
  34 \r
  35 // trashes all temp regs\r
  36 static void PrintException(int ints)\r
  37 {\r
  38   if(!ints) {\r
  39     ot("  ;@ Cause an Exception - Vector address in r0\n");\r
  40     ot("  mov r11,r0\n");\r
  41   }\r
  42 \r
  43   ot(";@ swap OSP <-> A7?\n");\r
  44   ot("  ldr r0,[r7,#0x44] ;@ Get SR high\n");\r
  45   ot("  tst r0,#0x20\n");\r
  46   ot("  bne no_sp_swap%i\n",ints);\r
  47   ot(";@ swap OSP and A7:\n");\r
  48   ot("  ldr r0,[r7,#0x3C] ;@ Get A7\n");\r
  49   ot("  ldr r1,[r7,#0x48] ;@ Get OSP\n");\r
  50   ot("  str r0,[r7,#0x48]\n");\r
  51   ot("  str r1,[r7,#0x3C]\n");\r
  52   ot("no_sp_swap%i%s\n",ints,ms?"":":");\r
  53 \r
  54   ot("  ldr r10,[r7,#0x60] ;@ Get Memory base\n");\r
  55   ot("  mov r1,r4,lsl #8\n");\r
  56   ot("  sub r1,r1,r10,lsl #8 ;@ r1 = Old PC\n");\r
  57   ot("  mov r1,r1,asr #8 ;@ push sign extended\n");\r
  58   OpPush32();\r
  59   OpPushSr(1);\r
  60   ot("  mov r0,r11\n");\r
  61   ot(";@ Read IRQ Vector:\n");\r
  62   MemHandler(0,2);\r
  63   if(ints) {\r
  64     ot("  tst r0,r0 ;@ uninitialized int vector?\n");\r
  65     ot("  moveq r0,#0x3c\n");\r
  66     ot("  moveq lr,pc\n");\r
  67     ot("  ldreq pc,[r7,#0x70] ;@ Call read32(r0) handler\n");\r
  68   }\r
  69 #if USE_CHECKPC_CALLBACK\r
  70   ot("  add r0,r0,r10 ;@ r0 = Memory Base + New PC\n");\r
  71   ot("  mov lr,pc\n");\r
  72   ot("  ldr pc,[r7,#0x64] ;@ Call checkpc()\n");\r
  73   ot("  mov r4,r0\n");\r
  74 #endif\r
  75   ot("\n");\r
  76 \r
  77   if(!ints) {\r
  78     ot("  ldr r0,[r7,#0x44] ;@ Get SR high\n");\r
  79     ot("  bic r0,r0,#0xd8 ;@ clear trace and unused flags\n");\r
  80     ot("  orr r0,r0,#0x20 ;@ set supervisor mode\n");\r
  81     ot("  strb r0,[r7,#0x44]\n");\r
  82   }\r
  83 }\r
  84 \r
  85 // Trashes r0,r1\r
  86 void CheckInterrupt(int op)\r
  87 {\r
  88   ot(";@ CheckInterrupt:\n");\r
  89   ot("  ldr r0,[r7,#0x44]\n"); // same as  ldrb r0,[r7,#0x47]\r
  90   ot("  movs r0,r0,lsr #24 ;@ Get IRQ level (loading word is faster)\n");\r
  91   ot("  beq NoInts%x\n",op);\r
  92   ot("  cmp r0,#6 ;@ irq>6 ?\n");\r
  93   ot("  ldrleb r1,[r7,#0x44] ;@ Get SR high: T_S__III\n");\r
  94   ot("  andle r1,r1,#7 ;@ Get interrupt mask\n");\r
  95   ot("  cmple r0,r1 ;@ irq<=6: Is irq<=mask ?\n");\r
  96   ot("  blgt CycloneDoInterrupt\n");\r
  97   ot("NoInts%x%s\n", op,ms?"":":");\r
  98   ot("\n");\r
  99 }\r
 100 \r
 101 static void PrintFramework()\r
 102 {\r
 103   ot(";@ --------------------------- Framework --------------------------\n");\r
 104   if (ms) ot("CycloneRun\n");\r
 105   else    ot("CycloneRun:\n");\r
 106 \r
 107   ot("  stmdb sp!,{r4-r11,lr}\n");\r
 108 \r
 109   ot("  mov r7,r0          ;@ r7 = Pointer to Cpu Context\n");\r
 110   ot("                     ;@ r0-3 = Temporary registers\n");\r
 111   ot("  ldrb r9,[r7,#0x46] ;@ r9 = Flags (NZCV)\n");\r
 112   ot("  ldr r6,=CycloneJumpTab ;@ r6 = Opcode Jump table\n");\r
 113   ot("  ldr r5,[r7,#0x5c]  ;@ r5 = Cycles\n");\r
 114   ot("  ldr r4,[r7,#0x40]  ;@ r4 = Current PC + Memory Base\n");\r
 115   ot("                     ;@ r8 = Current Opcode\n");\r
 116   ot("  ldr r0,[r7,#0x44]\n");\r
 117   ot("  mov r9,r9,lsl #28  ;@ r9 = Flags 0xf0000000, cpsr format\n");\r
 118   ot("                     ;@ r10 = Source value / Memory Base\n");\r
 119   ot("\n");\r
 120   ot(";@ CheckInterrupt:\n");\r
 121   ot("  movs r0,r0,lsr #24 ;@ Get IRQ level\n"); // same as  ldrb r0,[r7,#0x47]\r
 122   ot("  beq NoInts0\n");\r
 123   ot("  cmp r0,#6 ;@ irq>6 ?\n");\r
 124   ot("  ldrleb r1,[r7,#0x44] ;@ Get SR high: T_S__III\n");\r
 125   ot("  andle r1,r1,#7 ;@ Get interrupt mask\n");\r
 126   ot("  cmple r0,r1 ;@ irq<=6: Is irq<=mask ?\n");\r
 127   ot("  blgt CycloneDoInterrupt\n");\r
 128   ot(";@ Check if interrupt used up all the cycles:\n");\r
 129   ot("  subs r5,r5,#0\n");\r
 130   ot("  blt CycloneEndNoBack\n");\r
 131   ot("NoInts0%s\n", ms?"":":");\r
 132   ot("\n");\r
 133   ot(";@ Check if our processor is in stopped state and jump to opcode handler if not\n");\r
 134   ot("  ldr r0,[r7,#0x58]\n");\r
 135   ot("  ldrh r8,[r4],#2 ;@ Fetch first opcode\n");\r
 136   ot("  tst r0,r0 ;@ stopped?\n");\r
 137   ot("  bne CycloneStopped\n");\r
 138   ot("  ldr pc,[r6,r8,asl #2] ;@ Jump to opcode handler\n");\r
 139   ot("\n");\r
 140   ot("\n");\r
 141 \r
 142   ot(";@ We come back here after execution\n");\r
 143   ot("CycloneEnd%s\n", ms?"":":");\r
 144   ot("  sub r4,r4,#2\n");\r
 145   ot("CycloneEndNoBack%s\n", ms?"":":");\r
 146 #ifdef CYCLONE_FOR_PICODRIVE\r
 147   ot("  ldr r1,[r7,#0x54]\n");\r
 148   ot("  mov r9,r9,lsr #28\n");\r
 149   ot("  tst r1,r1\n");\r
 150   ot("  bxne r1            ;@ jump to alternative CycloneEnd\n");\r
 151 #else\r
 152   ot("  mov r9,r9,lsr #28\n");\r
 153 #endif\r
 154   ot("  str r4,[r7,#0x40]  ;@ Save Current PC + Memory Base\n");\r
 155   ot("  str r5,[r7,#0x5c]  ;@ Save Cycles\n");\r
 156   ot("  strb r9,[r7,#0x46] ;@ Save Flags (NZCV)\n");\r
 157   ot("  ldmia sp!,{r4-r11,pc}\n");\r
 158   ot("\n");\r
 159   ot("CycloneStopped%s\n", ms?"":":");\r
 160   ot("  mov r5,#0\n");\r
 161   ot("  str r5,[r7,#0x5C]  ;@ eat all cycles\n");\r
 162   ot("  ldmia sp!,{r4-r11,pc} ;@ we are stopped, do nothing!\n");\r
 163   ot("\n");\r
 164 \r
 165   ltorg();\r
 166 \r
 167 #if COMPRESS_JUMPTABLE\r
 168     ot(";@ uncompress jump table\n");\r
 169     if (ms) ot("CycloneInit\n");\r
 170     else    ot("CycloneInit:\n");\r
 171     ot("  ldr r12,=CycloneJumpTab\n");\r
 172     ot("  add r0,r12,#0xe000*4 ;@ ctrl code pointer\n");\r
 173     ot("  ldr r1,[r0,#-4]\n");\r
 174     ot("  tst r1,r1\n");\r
 175     ot("  movne pc,lr ;@ already uncompressed\n");\r
 176         ot("  add r3,r12,#0xa000*4 ;@ handler table pointer, r12=dest\n");\r
 177     ot("unc_loop%s\n", ms?"":":");\r
 178     ot("  ldrh r1,[r0],#2\n");\r
 179     ot("  and r2,r1,#0xf\n");\r
 180     ot("  bic r1,r1,#0xf\n");\r
 181     ot("  ldr r1,[r3,r1,lsr #2] ;@ r1=handler\n");\r
 182     ot("  cmp r2,#0xf\n");\r
 183     ot("  addeq r2,r2,#1 ;@ 0xf is really 0x10\n");\r
 184     ot("  tst r2,r2\n");\r
 185     ot("  ldreqh r2,[r0],#2 ;@ counter is in next word\n");\r
 186     ot("  tst r2,r2\n");\r
 187     ot("  beq unc_finish ;@ done decompressing\n");\r
 188     ot("  tst r1,r1\n");\r
 189     ot("  addeq r12,r12,r2,lsl #2 ;@ 0 handler means we should skip those bytes\n");\r
 190     ot("  beq unc_loop\n");\r
 191     ot("unc_loop_in%s\n", ms?"":":");\r
 192     ot("  subs r2,r2,#1\n");\r
 193     ot("  str r1,[r12],#4\n");\r
 194     ot("  bgt unc_loop_in\n");\r
 195     ot("  b unc_loop\n");\r
 196     ot("unc_finish%s\n", ms?"":":");\r
 197     ot("  ldr r12,=CycloneJumpTab\n");\r
 198     ot("  ;@ set a-line and f-line handlers\n");\r
 199     ot("  add r0,r12,#0xa000*4\n");\r
 200     ot("  ldr r1,[r0,#4] ;@ a-line handler\n");\r
 201     ot("  ldr r3,[r0,#8] ;@ f-line handler\n");\r
 202     ot("  mov r2,#0x1000\n");\r
 203     ot("unc_fill3%s\n", ms?"":":");\r
 204     ot("  subs r2,r2,#1\n");\r
 205     ot("  str r1,[r0],#4\n");\r
 206     ot("  bgt unc_fill3\n");\r
 207     ot("  add r0,r12,#0xf000*4\n");\r
 208     ot("  mov r2,#0x1000\n");\r
 209     ot("unc_fill4%s\n", ms?"":":");\r
 210     ot("  subs r2,r2,#1\n");\r
 211     ot("  str r3,[r0],#4\n");\r
 212     ot("  bgt unc_fill4\n");\r
 213     ot("  bx lr\n");\r
 214     ltorg();\r
 215     ot("\n");\r
 216 #else\r
 217     ot(";@ do nothing\n");\r
 218     if (ms) ot("CycloneInit\n");\r
 219     else    ot("CycloneInit:\n");\r
 220     ot("  bx lr\n");\r
 221     ot("\n");\r
 222 #endif\r
 223   if (ms) ot("CycloneSetSr\n");\r
 224   else    ot("CycloneSetSr:\n");\r
 225   ot("  mov r2,r1,lsr #8\n");\r
 226   ot("  ldrb r3,[r0,#0x44] ;@ get SR high\n");\r
 227   ot("  eor r3,r3,r2\n");\r
 228   ot("  tst r3,#0x20\n");\r
 229   ot("  and r2,r2,#0xa7 ;@ only nonzero bits\n");\r
 230   ot("  strb r2,[r0,#0x44] ;@ set SR high\n");\r
 231   ot("  bne setsr_noswap\n");\r
 232   ot("  ldr r2,[r0,#0x3C] ;@ Get A7\n");\r
 233   ot("  ldr r3,[r0,#0x48] ;@ Get OSP\n");\r
 234   ot("  str r3,[r0,#0x3C]\n");\r
 235   ot("  str r2,[r0,#0x48]\n");\r
 236   ot("setsr_noswap%s\n",ms?"":":");\r
 237   ot("  mov r2,r1,lsr #3\n");\r
 238   ot("  strb r2,[r0,#0x45] ;@ the X flag\n");\r
 239   ot("  bic r2,r1,#0xf3\n");\r
 240   ot("  tst r1,#1\n");\r
 241   ot("  orrne r2,r2,#2\n");\r
 242   ot("  tst r1,#2\n");\r
 243   ot("  orrne r2,r2,#1\n");\r
 244   ot("  strb r2,[r0,#0x46] ;@ flags\n");\r
 245   ot("  bx lr\n");\r
 246   ot("\n");\r
 247 \r
 248   if (ms) ot("CycloneGetSr\n");\r
 249   else    ot("CycloneGetSr:\n");\r
 250   ot("  ldrb r1,[r0,#0x46] ;@ flags\n");\r
 251   ot("  bic r2,r1,#0xf3\n");\r
 252   ot("  tst r1,#1\n");\r
 253   ot("  orrne r2,r2,#2\n");\r
 254   ot("  tst r1,#2\n");\r
 255   ot("  orrne r2,r2,#1\n");\r
 256   ot("  ldrb r1,[r0,#0x45] ;@ the X flag\n");\r
 257   ot("  tst r1,#2\n");\r
 258   ot("  orrne r2,r2,#0x10\n");\r
 259   ot("  ldrb r1,[r0,#0x44] ;@ the SR high\n");\r
 260   ot("  orr r0,r2,r1,lsl #8\n");\r
 261   ot("  bx lr\n");\r
 262   ot("\n");\r
 263 \r
 264   ot(";@ DoInterrupt - r0=IRQ number\n");\r
 265   ot("CycloneDoInterrupt%s\n", ms?"":":");\r
 266   ot("  stmdb sp!,{lr} ;@ Push ARM return address\n");\r
 267 \r
 268   ot(";@ Get IRQ Vector address:\n");\r
 269   ot("  mov r0,r0,asl #2\n");\r
 270   ot("  add r11,r0,#0x60\n");\r
 271   PrintException(1);\r
 272   \r
 273   ot("  ldrb r0,[r7,#0x47] ;@ IRQ\n");\r
 274   ot("  mov r2,#0\n");\r
 275   ot("  orr r1,r0,#0x20 ;@ Supervisor mode + IRQ number\n");\r
 276   ot("  strb r1,[r7,#0x44] ;@ Put SR high\n");\r
 277 \r
 278   ot(";@ Clear stopped states:\n");\r
 279   ot("  str r2,[r7,#0x58]\n");\r
 280   ot("  sub r5,r5,#%d ;@ Subtract cycles\n",44);\r
 281   ot("\n");\r
 282 #if USE_INT_ACK_CALLBACK\r
 283 #if INT_ACK_NEEDS_STUFF\r
 284   ot("  str r4,[r7,#0x40] ;@ Save PC\n");\r
 285   ot("  mov r1,r9,lsr #28\n");\r
 286   ot("  strb r1,[r7,#0x46] ;@ Save Flags (NZCV)\n");\r
 287   ot("  str r5,[r7,#0x5c] ;@ Save Cycles\n");\r
 288 #endif\r
 289   ot("  ldr r11,[r7,#0x8c] ;@ IrqCallback\n");\r
 290   ot("  tst r11,r11\n");\r
 291   ot("  movne lr,pc\n");\r
 292   ot("  movne pc,r11 ;@ call IrqCallback if it is defined\n");\r
 293 #if INT_ACK_CHANGES_STUFF\r
 294   ot("  ldr r5,[r7,#0x5c] ;@ Load Cycles\n");\r
 295   ot("  ldrb r9,[r7,#0x46] ;@ r9 = Load Flags (NZCV)\n");\r
 296   ot("  mov r9,r9,lsl #28\n");\r
 297   ot("  ldr r4,[r7,#0x40] ;@ Load PC\n");\r
 298 #endif\r
 299 #else // not USE_INT_ACK_CALLBACK\r
 300   ot(";@ Clear irq:\n");\r
 301   ot("  strb r1,[r7,#0x47]\n");\r
 302 #endif\r
 303   ot("  ldmia sp!,{pc} ;@ Return\n");\r
 304   ot("\n");\r
 305   \r
 306   ot("Exception%s\n", ms?"":":");\r
 307   ot("\n");\r
 308   ot("  stmdb sp!,{lr} ;@ Preserve ARM return address\n");\r
 309   PrintException(0);\r
 310   ot("  ldmia sp!,{pc} ;@ Return\n");\r
 311   ot("\n");\r
 312 }\r
 313 \r
 314 // ---------------------------------------------------------------------------\r
 315 // Call Read(r0), Write(r0,r1) or Fetch(r0)\r
 316 // Trashes r0-r3,r12,lr\r
 317 int MemHandler(int type,int size)\r
 318 {\r
 319   int func=0;\r
 320   func=0x68+type*0xc+(size<<2); // Find correct offset\r
 321 \r
 322 #if MEMHANDLERS_NEED_PC\r
 323   ot("  str r4,[r7,#0x40] ;@ Save PC\n");\r
 324 #endif\r
 325 #if MEMHANDLERS_NEED_FLAGS\r
 326   ot("  mov r3,r9,lsr #28\n");\r
 327   ot("  strb r3,[r7,#0x46] ;@ Save Flags (NZCV)\n");\r
 328 #endif\r
 329 #if MEMHANDLERS_NEED_CYCLES\r
 330   ot("  str r5,[r7,#0x5c] ;@ Save Cycles\n");\r
 331 #endif\r
 332 \r
 333   ot("  mov lr,pc\n");\r
 334   ot("  ldr pc,[r7,#0x%x] ;@ Call ",func);\r
 335 \r
 336   // Document what we are calling:\r
 337   if (type==0) ot("read");\r
 338   if (type==1) ot("write");\r
 339   if (type==2) ot("fetch");\r
 340 \r
 341   if (type==1) ot("%d(r0,r1)",8<<size);\r
 342   else         ot("%d(r0)",   8<<size);\r
 343   ot(" handler\n");\r
 344 \r
 345 #if MEMHANDLERS_CHANGE_CYCLES\r
 346   ot("  ldr r5,[r7,#0x5c] ;@ Load Cycles\n");\r
 347 #endif\r
 348 #if MEMHANDLERS_CHANGE_FLAGS\r
 349   ot("  ldrb r9,[r7,#0x46] ;@ r9 = Load Flags (NZCV)\n");\r
 350   ot("  mov r9,r9,lsl #28\n");\r
 351 #endif\r
 352 #if MEMHANDLERS_CHANGE_PC\r
 353   ot("  ldr r4,[r7,#0x40] ;@ Load PC\n");\r
 354 #endif\r
 355 \r
 356   return 0;\r
 357 }\r
 358 \r
 359 static void PrintOpcodes()\r
 360 {\r
 361   int op=0;\r
 362  \r
 363   printf("Creating Opcodes: [");\r
 364 \r
 365   ot(";@ ---------------------------- Opcodes ---------------------------\n");\r
 366 \r
 367   // Emit null opcode:\r
 368   ot("Op____%s ;@ Called if an opcode is not recognised\n", ms?"":":");\r
 369   ot("  sub r4,r4,#2\n");\r
 370 #if USE_UNRECOGNIZED_CALLBACK\r
 371   ot("  str r4,[r7,#0x40] ;@ Save PC\n");\r
 372   ot("  mov r1,r9,lsr #28\n");\r
 373   ot("  strb r1,[r7,#0x46] ;@ Save Flags (NZCV)\n");\r
 374   ot("  str r5,[r7,#0x5c] ;@ Save Cycles\n");\r
 375   ot("  ldr r11,[r7,#0x94] ;@ UnrecognizedCallback\n");\r
 376   ot("  tst r11,r11\n");\r
 377   ot("  movne lr,pc\n");\r
 378   ot("  movne pc,r11 ;@ call UnrecognizedCallback if it is defined\n");\r
 379   ot("  ldrb r9,[r7,#0x46] ;@ r9 = Load Flags (NZCV)\n");\r
 380   ot("  ldr r5,[r7,#0x5c] ;@ Load Cycles\n");\r
 381   ot("  ldr r4,[r7,#0x40] ;@ Load PC\n");\r
 382   ot("  mov r9,r9,lsl #28\n");\r
 383   ot("  tst r0,r0\n");\r
 384   ot("  moveq r0,#0x10\n");\r
 385   ot("  bleq Exception\n");\r
 386 #else\r
 387   ot("  mov r0,#0x10\n");\r
 388   ot("  bl Exception\n");\r
 389 #endif\r
 390   Cycles=34;\r
 391   OpEnd();\r
 392 \r
 393   // Unrecognised a-line and f-line opcodes throw an exception:\r
 394   ot("Op__al%s ;@ Unrecognised a-line opcode\n", ms?"":":");\r
 395   ot("  sub r4,r4,#2\n");\r
 396 #if USE_AFLINE_CALLBACK\r
 397   ot("  str r4,[r7,#0x40] ;@ Save PC\n");\r
 398   ot("  mov r1,r9,lsr #28\n");\r
 399   ot("  strb r1,[r7,#0x46] ;@ Save Flags (NZCV)\n");\r
 400   ot("  str r5,[r7,#0x5c] ;@ Save Cycles\n");\r
 401   ot("  ldr r11,[r7,#0x94] ;@ UnrecognizedCallback\n");\r
 402   ot("  tst r11,r11\n");\r
 403   ot("  movne lr,pc\n");\r
 404   ot("  movne pc,r11 ;@ call UnrecognizedCallback if it is defined\n");\r
 405   ot("  ldrb r9,[r7,#0x46] ;@ r9 = Load Flags (NZCV)\n");\r
 406   ot("  ldr r5,[r7,#0x5c] ;@ Load Cycles\n");\r
 407   ot("  ldr r4,[r7,#0x40] ;@ Load PC\n");\r
 408   ot("  mov r9,r9,lsl #28\n");\r
 409   ot("  tst r0,r0\n");\r
 410   ot("  moveq r0,#0x28\n");\r
 411   ot("  bleq Exception\n");\r
 412 #else\r
 413   ot("  mov r0,#0x28\n");\r
 414   ot("  bl Exception\n");\r
 415 #endif\r
 416   Cycles=4;\r
 417   OpEnd();\r
 418 \r
 419   ot("Op__fl%s ;@ Unrecognised f-line opcode\n", ms?"":":");\r
 420   ot("  sub r4,r4,#2\n");\r
 421 #if USE_AFLINE_CALLBACK\r
 422   ot("  str r4,[r7,#0x40] ;@ Save PC\n");\r
 423   ot("  mov r1,r9,lsr #28\n");\r
 424   ot("  strb r1,[r7,#0x46] ;@ Save Flags (NZCV)\n");\r
 425   ot("  str r5,[r7,#0x5c] ;@ Save Cycles\n");\r
 426   ot("  ldr r11,[r7,#0x94] ;@ UnrecognizedCallback\n");\r
 427   ot("  tst r11,r11\n");\r
 428   ot("  movne lr,pc\n");\r
 429   ot("  movne pc,r11 ;@ call UnrecognizedCallback if it is defined\n");\r
 430   ot("  ldrb r9,[r7,#0x46] ;@ r9 = Load Flags (NZCV)\n");\r
 431   ot("  ldr r5,[r7,#0x5c] ;@ Load Cycles\n");\r
 432   ot("  ldr r4,[r7,#0x40] ;@ Load PC\n");\r
 433   ot("  mov r9,r9,lsl #28\n");\r
 434   ot("  tst r0,r0\n");\r
 435   ot("  moveq r0,#0x2c\n");\r
 436   ot("  bleq Exception\n");\r
 437 #else\r
 438   ot("  mov r0,#0x2c\n");\r
 439   ot("  bl Exception\n");\r
 440 #endif\r
 441   Cycles=4;\r
 442   OpEnd();\r
 443 \r
 444 \r
 445   for (op=0;op<0x10000;op++)\r
 446   {\r
 447     if ((op&0xfff)==0) { printf("%x",op>>12); fflush(stdout); } // Update progress\r
 448 \r
 449     OpAny(op);\r
 450   }\r
 451 \r
 452   ot("\n");\r
 453 \r
 454   printf("]\n");\r
 455 }\r
 456 \r
 457 // helper\r
 458 static void ott(const char *str, int par, const char *nl, int nlp, int counter, int size)\r
 459 {\r
 460   switch(size) {\r
 461     case 0: if((counter&7)==0) ot(ms?"  dcb ":"  .byte ");  break;\r
 462     case 1: if((counter&7)==0) ot(ms?"  dcw ":"  .hword "); break;\r
 463     case 2: if((counter&7)==0) ot(ms?"  dcd ":"  .long ");  break;\r
 464   }\r
 465   ot(str, par);\r
 466   if((counter&7)==7) ot(nl,nlp); else ot(",");\r
 467 }\r
 468 \r
 469 static void PrintJumpTable()\r
 470 {\r
 471   int i=0,op=0,len=0;\r
 472 \r
 473   ot(";@ -------------------------- Jump Table --------------------------\n");\r
 474 \r
 475 #if COMPRESS_JUMPTABLE\r
 476     int handlers=0,reps=0,*indexes,ip,u,out;\r
 477     // use some weird compression on the jump table\r
 478         indexes=(int *)malloc(0x10000*4);\r
 479         if(!indexes) { printf("ERROR: out of memory\n"); exit(1); }\r
 480         len=0x10000;\r
 481 \r
 482         // space for decompressed table\r
 483         ot(ms?"  area |.data|, data\n":"  .data\n  .align 4\n\n");\r
 484 \r
 485         ot("CycloneJumpTab%s\n", ms?"":":");\r
 486         if(ms) {\r
 487           for(i = 0; i < 0xa000/8; i++)\r
 488             ot("  dcd 0,0,0,0,0,0,0,0\n");\r
 489         } else\r
 490           ot("  .rept 0x%x\n  .long 0,0,0,0,0,0,0,0\n  .endr\n", 0xa000/8);\r
 491 \r
 492     // hanlers live in "a-line" part of the table\r
 493         // first output nop,a-line,f-line handlers\r
 494         ot(ms?"  dcd Op____,Op__al,Op__fl,":"  .long Op____,Op__al,Op__fl,");\r
 495         handlers=3;\r
 496 \r
 497         for(i=0;i<len;i++)\r
 498     {\r
 499       op=CyJump[i];\r
 500 \r
 501           for(u=i-1; u>=0; u--) if(op == CyJump[u]) break; // already done with this op?\r
 502           if(u==-1 && op >= 0) {\r
 503                 ott("Op%.4x",op," ;@ %.4x\n",i,handlers,2);\r
 504                 indexes[op] = handlers;\r
 505             handlers++;\r
 506       }\r
 507         }\r
 508         if(handlers&7) {\r
 509           fseek(AsmFile, -1, SEEK_CUR); // remove last comma\r
 510           for(i = 8-(handlers&7); i > 0; i--)\r
 511             ot(",000000");\r
 512           ot("\n");\r
 513         }\r
 514         if(ms) {\r
 515           for(i = (0x4000-handlers)/8; i > 0; i--)\r
 516             ot("  dcd 0,0,0,0,0,0,0,0\n");\r
 517         } else {\r
 518           ot(ms?"":"  .rept 0x%x\n  .long 0,0,0,0,0,0,0,0\n  .endr\n", (0x4000-handlers)/8);\r
 519         }\r
 520     printf("total distinct hanlers: %i\n",handlers);\r
 521         // output data\r
 522         for(i=0,ip=0; i < 0xf000; i++, ip++) {\r
 523       op=CyJump[i];\r
 524           if(op == -2) {\r
 525             // it must skip a-line area, because we keep our data there\r
 526             ott("0x%.4x", handlers<<4, "\n",0,ip++,1);\r
 527             ott("0x%.4x", 0x1000, "\n",0,ip,1);\r
 528                 i+=0xfff;\r
 529             continue;\r
 530           }\r
 531           for(reps=1; i < 0xf000; i++, reps++) if(op != CyJump[i+1]) break;\r
 532           if(op>=0) out=indexes[op]<<4; else out=0; // unrecognised\r
 533           if(reps <= 0xe || reps==0x10) {\r
 534             if(reps!=0x10) out|=reps; else out|=0xf; // 0xf means 0x10 (0xf appeared to be unused anyway)\r
 535             ott("0x%.4x", out, "\n",0,ip,1);\r
 536       } else {\r
 537             ott("0x%.4x", out, "\n",0,ip++,1);\r
 538             ott("0x%.4x", reps,"\n",0,ip,1);\r
 539           }\r
 540     }\r
 541         if(ip&1) ott("0x%.4x", 0, "\n",0,ip++,1);\r
 542         if(ip&7) fseek(AsmFile, -1, SEEK_CUR); // remove last comma\r
 543         ot("\n");\r
 544         if(ip&7) {\r
 545           for(i = 8-(ip&7); i > 0; i--)\r
 546             ot(",0x0000");\r
 547           ot("\n");\r
 548         }\r
 549         if(ms) {\r
 550           for(i = (0x2000-ip/2)/8+1; i > 0; i--)\r
 551             ot("  dcd 0,0,0,0,0,0,0,0\n");\r
 552         } else {\r
 553           ot("  .rept 0x%x\n  .long 0,0,0,0,0,0,0,0\n  .endr\n", (0x2000-ip/2)/8+1);\r
 554         }\r
 555         ot("\n");\r
 556         free(indexes);\r
 557 #else\r
 558         ot("CycloneJumpTab%s\n", ms?"":":");\r
 559     len=0xfffe; // Hmmm, armasm 2.50.8684 messes up with a 0x10000 long jump table\r
 560                 // notaz: same thing with GNU as 2.9-psion-98r2 (reloc overflow)\r
 561                 // this is due to COFF objects using only 2 bytes for reloc count\r
 562 \r
 563     for (i=0;i<len;i++)\r
 564     {\r
 565       op=CyJump[i];\r
 566     \r
 567            if(op>=0)  ott("Op%.4x",op," ;@ %.4x\n",i-7,i,2);\r
 568       else if(op==-2) ott("Op__al",0, " ;@ %.4x\n",i-7,i,2);\r
 569       else if(op==-3) ott("Op__fl",0, " ;@ %.4x\n",i-7,i,2);\r
 570       else            ott("Op____",0, " ;@ %.4x\n",i-7,i,2);\r
 571     }\r
 572         if(i&7) fseek(AsmFile, -1, SEEK_CUR); // remove last comma\r
 573 \r
 574     ot("\n");\r
 575     ot(";@ notaz: we don't want to crash if we run into those 2 missing opcodes\n");\r
 576     ot(";@ so we leave this pattern to patch it later\n");\r
 577     ot("%s 0x78563412\n", ms?"  dcd":"  .long");\r
 578     ot("%s 0x56341290\n", ms?"  dcd":"  .long");\r
 579 #endif\r
 580 }\r
 581 \r
 582 static int CycloneMake()\r
 583 {\r
 584   int i;\r
 585   char *name="Cyclone.s";\r
 586   \r
 587   // Open the assembly file\r
 588   if (ms) name="Cyclone.asm";\r
 589   AsmFile=fopen(name,"wt"); if (AsmFile==NULL) return 1;\r
 590   \r
 591   printf("Making %s...\n",name);\r
 592 \r
 593   ot("\n;@ Dave's Cyclone 68000 Emulator v%x.%.3x - Assembler Output\n\n",CycloneVer>>12,CycloneVer&0xfff);\r
 594 \r
 595   ot(";@ (c) Copyright 2003 Dave, All rights reserved.\n");\r
 596   ot(";@ some code (c) Copyright 2005-2006 notaz, All rights reserved.\n");\r
 597   ot(";@ Cyclone 68000 is free for non-commercial use.\n\n");\r
 598   ot(";@ For commercial use, separate licencing terms must be obtained.\n\n");\r
 599 \r
 600   CyJump=(int *)malloc(0x40000); if (CyJump==NULL) return 1;\r
 601   memset(CyJump,0xff,0x40000); // Init to -1\r
 602   for(i=0xa000; i<0xb000;  i++) CyJump[i] = -2; // a-line emulation\r
 603   for(i=0xf000; i<0x10000; i++) CyJump[i] = -3; // f-line emulation\r
 604 \r
 605   if (ms)\r
 606   {\r
 607     ot("  area |.text|, code\n");\r
 608     ot("  export CycloneInit\n");\r
 609     ot("  export CycloneRun\n");\r
 610     ot("  export CycloneSetSr\n");\r
 611     ot("  export CycloneGetSr\n");\r
 612     ot("  export CycloneVer\n");\r
 613     ot("\n");\r
 614     ot("CycloneVer dcd 0x%.4x\n",CycloneVer);\r
 615   }\r
 616   else\r
 617   {\r
 618     ot("  .global CycloneInit\n");\r
 619     ot("  .global CycloneRun\n");\r
 620     ot("  .global CycloneSetSr\n");\r
 621     ot("  .global CycloneGetSr\n");\r
 622     ot("  .global CycloneVer\n");\r
 623 #ifdef CYCLONE_FOR_PICODRIVE\r
 624     ot("  .global CycloneDoInterrupt\n");\r
 625     ot("  .global CycloneJumpTab\n");\r
 626 #endif\r
 627     ot("CycloneVer: .long 0x%.4x\n",CycloneVer);\r
 628   }\r
 629   ot("\n");\r
 630 \r
 631   PrintFramework();\r
 632   PrintOpcodes();\r
 633   PrintJumpTable();\r
 634 \r
 635   if (ms) ot("  END\n");\r
 636 \r
 637   ot("\n\n;@ vim:filetype=armasm\n");\r
 638 \r
 639   fclose(AsmFile); AsmFile=NULL;\r
 640 \r
 641 #if 0\r
 642   printf("Assembling...\n");\r
 643   // Assemble the file\r
 644   if (ms) system("armasm Cyclone.asm");\r
 645   else    system("as -o Cyclone.o Cyclone.s");\r
 646   printf("Done!\n\n");\r
 647 #endif\r
 648 \r
 649   free(CyJump);\r
 650   return 0;\r
 651 }\r
 652 \r
 653 int main()\r
 654 {\r
 655   printf("\n  Dave's Cyclone 68000 Emulator v%x.%.3x - Core Creator\n\n",CycloneVer>>12,CycloneVer&0xfff);\r
 656 \r
 657   // Make GAS or ARMASM version\r
 658   CycloneMake();\r
 659   return 0;\r
 660 }\r
 661 \r