Pico/Disa.c

   1 \r
   2 // Disa 68000 Disassembler\r
   3 #ifndef __GNUC__\r
   4 #pragma warning(disable:4115)\r
   5 #endif\r
   6 \r
   7 #define _CRT_SECURE_NO_WARNINGS\r
   8 #include <stdio.h>\r
   9 #include <string.h>\r
  10 #include "Disa.h"\r
  11 \r
  12 unsigned int DisaPc=0;\r
  13 char *DisaText=NULL; // Text buffer to write in\r
  14 static char Tasm[]="bwl?";\r
  15 static char Comment[64]="";\r
  16 unsigned short (CPU_CALL *DisaWord)(unsigned int a)=NULL;\r
  17 \r
  18 static unsigned int DisaLong(unsigned int a)\r
  19 {\r
  20   unsigned int d=0;\r
  21   if (DisaWord==NULL) return d;\r
  22 \r
  23   d= DisaWord(a)<<16;\r
  24   d|=DisaWord(a+2)&0xffff;\r
  25   return d;\r
  26 }\r
  27 \r
  28 // Get text version of the effective address\r
  29 int DisaGetEa(char *t,int ea,int size)\r
  30 {\r
  31   ea&=0x3f; t[0]=0;\r
  32   if ((ea&0x38)==0x00) { sprintf(t,"d%d",ea  ); return 0; }    // 000rrr\r
  33   if ((ea&0x38)==0x08) { sprintf(t,"a%d",ea&7); return 0; }    // 001rrr\r
  34   if ((ea&0x38)==0x10) { sprintf(t,"(a%d)",ea&7); return 0; }  // 010rrr\r
  35   if ((ea&0x38)==0x18) { sprintf(t,"(a%d)+",ea&7); return 0; } // 011rrr\r
  36   if ((ea&0x38)==0x20) { sprintf(t,"-(a%d)",ea&7); return 0; } // 100rrr\r
  37   if ((ea&0x38)==0x28) { sprintf(t,"($%x,a%d)",DisaWord(DisaPc)&0xffff,ea&7); DisaPc+=2; return 0; } // 101rrr\r
  38 \r
  39   if ((ea&0x38)==0x30)\r
  40   {\r
  41     // 110nnn - An + Disp + D/An\r
  42     int areg=0,ext=0,off=0,da=0,reg=0,wol=0,scale=0;\r
  43     ext=DisaWord(DisaPc)&0xffff;\r
  44     \r
  45     areg=ea&7;\r
  46     off=ext&0xff;    da =ext&0x8000?'a':'d';\r
  47     reg=(ext>>12)&7; wol=ext&0x0800?'l':'w';\r
  48     scale=1<<((ext>>9)&3);\r
  49 \r
  50     if (scale<2) sprintf(t,"($%x,a%d,%c%d.%c)",   off,areg,da,reg,wol);\r
  51     else         sprintf(t,"($%x,a%d,%c%d.%c*%d)",off,areg,da,reg,wol,scale); // 68020\r
  52 \r
  53     DisaPc+=2;\r
  54     return 0;\r
  55   }\r
  56 \r
  57   if (ea==0x38) { sprintf(t,"$%x.w",DisaWord(DisaPc)&0xffff); DisaPc+=2; return 0; } // 111000 - Absolute short\r
  58   if (ea==0x39) { sprintf(t,"$%x.l",DisaLong(DisaPc));        DisaPc+=4; return 0; } // 111001 - Absolute long\r
  59 \r
  60   if (ea==0x3a)\r
  61   {\r
  62     // 111010 - PC Relative\r
  63     int ext=DisaWord(DisaPc)&0xffff;\r
  64     sprintf(t,"($%x,pc)",ext);\r
  65     sprintf(Comment,"; =%x",DisaPc+(short)ext); // Comment where pc+ext is\r
  66     DisaPc+=2;\r
  67     return 0;\r
  68   }\r
  69 \r
  70   if (ea==0x3b)\r
  71   {\r
  72     // 111011 - PC Relative + D/An\r
  73     int ext=0,off=0,da=0,reg=0,wol=0,scale=0;\r
  74     ext=DisaWord(DisaPc)&0xffff;\r
  75     \r
  76     off=ext&0xff;    da =ext&0x8000?'a':'d';\r
  77     reg=(ext>>12)&7; wol=ext&0x0800?'l':'w';\r
  78     scale=1<<((ext>>9)&3);\r
  79 \r
  80     if (scale<2) sprintf(t,"($%x,pc,%c%d.%c)",   off,da,reg,wol);\r
  81     else         sprintf(t,"($%x,pc,%c%d.%c*%d)",off,da,reg,wol,scale); // 68020\r
  82 \r
  83     sprintf(Comment,"; =%x",DisaPc+(char)off); // Comment where pc+ext is\r
  84     DisaPc+=2;\r
  85     return 0;\r
  86   }\r
  87 \r
  88   if (ea==0x3c)\r
  89   {\r
  90     // 111100 - Immediate\r
  91     switch (size)\r
  92     {\r
  93       case 0: sprintf(t,"#$%x",DisaWord(DisaPc)&0x00ff); DisaPc+=2; return 0;\r
  94       case 1: sprintf(t,"#$%x",DisaWord(DisaPc)&0xffff); DisaPc+=2; return 0;\r
  95       case 2: sprintf(t,"#$%x",DisaLong(DisaPc)       ); DisaPc+=4; return 0;\r
  96     }\r
  97     return 1;\r
  98   }\r
  99 \r
 100 // Unknown effective address\r
 101   sprintf(t,"ea=(%d%d%d %d%d%d)",\r
 102     (ea>>5)&1,(ea>>4)&1,(ea>>3)&1,\r
 103     (ea>>2)&1,(ea>>1)&1, ea    &1);\r
 104   return 1;\r
 105 }\r
 106 \r
 107 static void GetOffset(char *text)\r
 108 {\r
 109   int off=(short)DisaWord(DisaPc); DisaPc+=2;\r
 110 \r
 111   if (off<0) sprintf(text,"-$%x",-off);\r
 112   else       sprintf(text,"$%x",  off);\r
 113 }\r
 114 \r
 115 // ================ Opcodes 0x0000+ ================\r
 116 static int DisaArithImm(int op)\r
 117 {\r
 118   // Or/And/Sub/Add/Eor/Cmp Immediate 0000ttt0 xxDDDddd (tt=type, xx=size extension, DDDddd=Dest ea)\r
 119   int dea=0;\r
 120   char seat[64]="",deat[64]="";\r
 121   int type=0,size=0;\r
 122   char *arith[8]={"or","and","sub","add","?","eor","cmp","?"};\r
 123 \r
 124   type=(op>>9)&7; if (type==4 || type>=7) return 1;\r
 125   size=(op>>6)&3; if (size>=3) return 1;\r
 126   dea=op&0x3f; if (dea==0x3c) return 1;\r
 127 \r
 128   DisaGetEa(seat,0x3c,size);\r
 129   DisaGetEa(deat,dea, size);\r
 130 \r
 131   sprintf(DisaText,"%si.%c %s, %s",arith[type],Tasm[size],seat,deat);\r
 132   return 0;\r
 133 }\r
 134 \r
 135 // ================ Opcodes 0x0108+ ================\r
 136 static int DisaMovep(int op)\r
 137 {\r
 138   // movep.x (Aa),Dn - 0000nnn1 dx001aaa  nn\r
 139   int dn=0,dir=0,size=0,an=0;\r
 140   char offset[32]="";\r
 141 \r
 142   dn  =(op>>9)&7;\r
 143   dir =(op>>7)&1;\r
 144   size=(op>>6)&1; size++;\r
 145   an  = op    &7;\r
 146 \r
 147   GetOffset(offset);\r
 148   if (dir) sprintf(DisaText,"movep.%c d%d, (%s,a%d)",Tasm[size],dn,offset,an);\r
 149   else     sprintf(DisaText,"movep.%c (%s,a%d), d%d",Tasm[size],offset,an,dn);\r
 150 \r
 151   return 0;\r
 152 }\r
 153 \r
 154 // ================ Opcodes 0x007c+ ================\r
 155 static int DisaArithSr(int op)\r
 156 {\r
 157   // Ori/Andi/Eori $nnnn,sr 0000t0tx 0s111100\r
 158   char *opcode[6]={"ori","andi","","","","eori"};\r
 159   char seat[64]="";\r
 160   int type=0,size=0;\r
 161 \r
 162   type=(op>>9)&5;\r
 163   size=(op>>6)&1;\r
 164 \r
 165   DisaGetEa(seat,0x3c,size);\r
 166   sprintf(DisaText,"%s.%c %s, %s", opcode[type], Tasm[size], seat, size?"sr":"ccr");\r
 167 \r
 168   return 0;\r
 169 }\r
 170 \r
 171 // ================ Opcodes 0x0100+ ================\r
 172 static int DisaBtstReg(int op)\r
 173 {\r
 174   // Btst/Bchg/Bclr/Bset 0000nnn1 tteeeeee (nn=reg number, eeeeee=Dest ea)\r
 175   int type=0;\r
 176   int sea=0,dea=0;\r
 177   char seat[64]="",deat[64]="";\r
 178   char *opcode[4]={"btst","bchg","bclr","bset"};\r
 179 \r
 180   sea =(op>>9)&7;\r
 181   type=(op>>6)&3;\r
 182   dea=  op&0x3f;\r
 183 \r
 184   if ((dea&0x38)==0x08) return 1; // movep\r
 185   DisaGetEa(seat,sea,0);\r
 186   DisaGetEa(deat,dea,0);\r
 187 \r
 188   sprintf(DisaText,"%s %s, %s",opcode[type],seat,deat);\r
 189   return 0;\r
 190 }\r
 191 \r
 192 // ================ Opcodes 0x0800+ ================\r
 193 static int DisaBtstImm(int op)\r
 194 {\r
 195   // Btst/Bchg/Bclr/Bset 00001000 tteeeeee 00 nn (eeeeee=ea, nn=bit number)\r
 196   int type=0;\r
 197   char seat[64]="",deat[64]="";\r
 198   char *opcode[4]={"btst","bchg","bclr","bset"};\r
 199 \r
 200   type=(op>>6)&3;\r
 201   DisaGetEa(seat,   0x3c,0);\r
 202   DisaGetEa(deat,op&0x3f,0);\r
 203 \r
 204   sprintf(DisaText,"%s %s, %s",opcode[type],seat,deat);\r
 205   return 0;\r
 206 }\r
 207 \r
 208 // ================ Opcodes 0x1000+ ================\r
 209 static int DisaMove(int op)\r
 210 {\r
 211   // Move 00xxdddD DDssssss (xx=size extension, ssssss=Source EA, DDDddd=Dest ea)\r
 212   int sea=0,dea=0;\r
 213   char inst[64]="",seat[64]="",deat[64]="";\r
 214   char *movea="";\r
 215   int size=0;\r
 216 \r
 217   if ((op&0x01c0)==0x0040) movea="a"; // See if it's a movea opcode\r
 218 \r
 219   // Find size extension\r
 220   switch (op&0x3000)\r
 221   {\r
 222     case 0x1000: size=0; break;\r
 223     case 0x3000: size=1; break;\r
 224     case 0x2000: size=2; break;\r
 225     default: return 1;\r
 226   }\r
 227 \r
 228   sea = op&0x003f;\r
 229   DisaGetEa(seat,sea,size);\r
 230   \r
 231   dea =(op&0x01c0)>>3;\r
 232   dea|=(op&0x0e00)>>9;\r
 233   DisaGetEa(deat,dea,size);\r
 234 \r
 235   sprintf(inst,"move%s.%c",movea,Tasm[size]);\r
 236   sprintf(DisaText,"%s %s, %s",inst,seat,deat);\r
 237   return 0;\r
 238 }\r
 239 \r
 240 // ================ Opcodes 0x4000+ ================\r
 241 static int DisaNeg(int op)\r
 242 {\r
 243   // 01000tt0 xxeeeeee (tt=negx/clr/neg/not, xx=size, eeeeee=EA)\r
 244   char eat[64]="";\r
 245   int type=0,size=0;\r
 246   char *opcode[4]={"negx","clr","neg","not"};\r
 247 \r
 248   type=(op>>9)&3;\r
 249   size=(op>>6)&3; if (size>=3) return 1;\r
 250   DisaGetEa(eat,op&0x3f,size);\r
 251 \r
 252   sprintf(DisaText,"%s.%c %s",opcode[type],Tasm[size],eat);\r
 253   return 0;\r
 254 }\r
 255 \r
 256 // ================ Opcodes 0x40c0+ ================\r
 257 static int DisaMoveSr(int op)\r
 258 {\r
 259   // 01000tt0 11eeeeee (tt=type, xx=size, eeeeee=EA)\r
 260   int type=0,ea=0;\r
 261   char eat[64]="";\r
 262 \r
 263   type=(op>>9)&3;\r
 264   ea=op&0x3f;\r
 265   DisaGetEa(eat,ea,1);\r
 266 \r
 267   switch (type)\r
 268   {\r
 269     default: sprintf(DisaText,"move sr, %s", eat); break;\r
 270     case 1:  sprintf(DisaText,"move ccr, %s",eat); break;\r
 271     case 2:  sprintf(DisaText,"move %s, ccr",eat); break;\r
 272     case 3:  sprintf(DisaText,"move %s, sr", eat); break;\r
 273   }\r
 274   return 0;\r
 275 }\r
 276 \r
 277 // ================ Opcodes 0x41c0+ ================\r
 278 static int DisaLea(int op)\r
 279 {\r
 280   // Lea 0100nnn1 11eeeeee (eeeeee=ea)\r
 281   int sea=0,dea=0;\r
 282   char seat[64]="",deat[64]="";\r
 283 \r
 284   sea=op&0x003f;\r
 285   DisaGetEa(seat,sea,0);\r
 286 \r
 287   dea=(op>>9)&7; dea|=8;\r
 288   DisaGetEa(deat,dea,2);\r
 289 \r
 290   sprintf(DisaText,"lea %s, %s",seat,deat);\r
 291   return 0;\r
 292 }\r
 293 \r
 294 static int MakeRegList(char *list,int mask,int ea)\r
 295 {\r
 296   int reverse=0,i=0,low=0,len=0;\r
 297 \r
 298   if ((ea&0x38)==0x20) reverse=1; // -(An), bitfield is reversed\r
 299 \r
 300   mask&=0xffff; list[0]=0;\r
 301 \r
 302   for (i=0;i<17;i++)\r
 303   {\r
 304     int bit=0;\r
 305     \r
 306     // Mask off bit i:\r
 307     if (reverse) bit=0x8000>>i; else bit=1<<i;\r
 308     bit&=mask;\r
 309 \r
 310     if (bit==0 || i==8)\r
 311     {\r
 312       // low to i-1 are a continuous section, add it:\r
 313       char add[16]="";\r
 314       int ad=low&8?'a':'d';\r
 315       if (low==i-1) sprintf(add,"%c%d/",     ad,low&7);\r
 316       if (low< i-1) sprintf(add,"%c%d-%c%d/",ad,low&7, ad,(i-1)&7);\r
 317       strcat(list,add);\r
 318 \r
 319       low=i; // Next section\r
 320     }\r
 321 \r
 322     if (bit==0) low=i+1;\r
 323   }\r
 324 \r
 325   // Knock off trailing '/'\r
 326   len=strlen(list);\r
 327   if (len>0) if (list[len-1]=='/') list[len-1]=0; \r
 328   return 0;\r
 329 }\r
 330 \r
 331 // ================ Opcodes 0x4840+ ================\r
 332 static int DisaSwap(int op)\r
 333 {\r
 334   // Swap, 01001000 01000nnn swap Dn\r
 335   sprintf(DisaText,"swap d%d",op&7);\r
 336   return 0;\r
 337 }\r
 338 \r
 339 // ================ Opcodes 0x4850+ ================\r
 340 static int DisaPea(int op)\r
 341 {\r
 342   // Pea 01001000 01eeeeee  (eeeeee=ea)  pea \r
 343   int ea=0;\r
 344   char eat[64]="";\r
 345 \r
 346   ea=op&0x003f; if (ea<0x10) return 1; // swap opcode\r
 347   DisaGetEa(eat,ea,2);\r
 348 \r
 349   sprintf(DisaText,"pea %s",eat);\r
 350   return 0;\r
 351 }\r
 352 \r
 353 // ================ Opcodes 0x4880+ ================\r
 354 static int DisaExt(int op)\r
 355 {\r
 356   // Ext 01001000 1x000nnn (x=size, eeeeee=EA)\r
 357   char eat[64]="";\r
 358   int size=0;\r
 359 \r
 360   size=(op>>6)&1; size++;\r
 361   DisaGetEa(eat,op&0x3f,size);\r
 362 \r
 363   sprintf(DisaText,"ext.%c %s",Tasm[size],eat);\r
 364   return 0;\r
 365 }\r
 366 \r
 367 // ================ Opcodes 0x4890+ ================\r
 368 static int DisaMovem(int op)\r
 369 {\r
 370   // Movem 01001d00 1xeeeeee regmask  d=direction, x=size, eeeeee=EA\r
 371   int dir=0,size=0;\r
 372   int ea=0,mask=0;\r
 373   char list[64]="",eat[64]="";\r
 374 \r
 375   dir=(op>>10)&1;\r
 376   size=((op>>6)&1)+1;\r
 377   ea=op&0x3f; if (ea<0x10) return 1; // ext opcode\r
 378 \r
 379   mask=DisaWord(DisaPc)&0xffff; DisaPc+=2;\r
 380 \r
 381   MakeRegList(list,mask,ea); // Turn register mask into text\r
 382   DisaGetEa(eat,ea,size);\r
 383 \r
 384   if (dir) sprintf(DisaText,"movem.%c %s, %s",Tasm[size],eat,list);\r
 385   else     sprintf(DisaText,"movem.%c %s, %s",Tasm[size],list,eat);\r
 386   return 0;\r
 387 }\r
 388 \r
 389 // ================ Opcodes 0x4e40+ ================\r
 390 static int DisaTrap(int op)\r
 391 {\r
 392   sprintf(DisaText,"trap #%d",op&0xf);\r
 393   return 0;\r
 394 }\r
 395 \r
 396 // ================ Opcodes 0x4e50+ ================\r
 397 static int DisaLink(int op)\r
 398 {\r
 399   // Link opcode, 01001110 01010nnn dd   link An,#offset\r
 400   char eat[64]="";\r
 401   char offset[32]="";\r
 402 \r
 403   DisaGetEa(eat,(op&7)|8,0);\r
 404   GetOffset(offset);\r
 405 \r
 406   sprintf(DisaText,"link %s,#%s",eat,offset);\r
 407 \r
 408   return 0;\r
 409 }\r
 410 \r
 411 // ================ Opcodes 0x4e58+ ================\r
 412 static int DisaUnlk(int op)\r
 413 {\r
 414   // Link opcode, 01001110 01011nnn dd   unlk An\r
 415   char eat[64]="";\r
 416 \r
 417   DisaGetEa(eat,(op&7)|8,0);\r
 418   sprintf(DisaText,"unlk %s",eat);\r
 419 \r
 420   return 0;\r
 421 }\r
 422 \r
 423 // ================ Opcodes 0x4e60+ ================\r
 424 static int DisaMoveUsp(int op)\r
 425 {\r
 426   // Move USP opcode, 01001110 0110dnnn move An to/from USP (d=direction)\r
 427   int ea=0,dir=0;\r
 428   char eat[64]="";\r
 429 \r
 430   dir=(op>>3)&1;\r
 431   ea=(op&7)|8;\r
 432   DisaGetEa(eat,ea,0);\r
 433 \r
 434   if (dir) sprintf(DisaText,"move usp, %s",eat);\r
 435   else     sprintf(DisaText,"move %s, usp",eat);\r
 436   return 0;\r
 437 }\r
 438 \r
 439 // ================ Opcodes 0x4e70+ ================\r
 440 static int Disa4E70(int op)\r
 441 {\r
 442   char *inst[8]={"reset","nop","stop","rte","rtd","rts","trapv","rtr"};\r
 443   int n=0;\r
 444 \r
 445   n=op&7;\r
 446 \r
 447   sprintf(DisaText,"%s",inst[n]);\r
 448 \r
 449   //todo - 'stop' with 16 bit data\r
 450   \r
 451   return 0;\r
 452 }\r
 453 \r
 454 // ================ Opcodes 0x4a00+ ================\r
 455 static int DisaTst(int op)\r
 456 {\r
 457   // Tst 01001010 xxeeeeee  (eeeeee=ea)\r
 458   int ea=0;\r
 459   char eat[64]="";\r
 460   int size=0;\r
 461 \r
 462   ea=op&0x003f;\r
 463   DisaGetEa(eat,ea,0);\r
 464   size=(op>>6)&3; if (size>=3) return 1;\r
 465 \r
 466   sprintf(DisaText,"tst.%c %s",Tasm[size],eat);\r
 467   return 0;\r
 468 }\r
 469 \r
 470 // ================ Opcodes 0x4e80+ ================\r
 471 static int DisaJsr(int op)\r
 472 {\r
 473   // Jsr/Jmp 0100 1110 1mEE Eeee (eeeeee=ea m=1=jmp)\r
 474   int sea=0;\r
 475   char seat[64]="";\r
 476 \r
 477   sea=op&0x003f;\r
 478   DisaGetEa(seat,sea,0);\r
 479 \r
 480   sprintf(DisaText,"j%s %s", op&0x40?"mp":"sr", seat);\r
 481   return 0;\r
 482 }\r
 483 \r
 484 // ================ Opcodes 0x5000+ ================\r
 485 static int DisaAddq(int op)\r
 486 {\r
 487   // 0101nnnt xxeeeeee (nnn=#8,1-7 t=addq/subq xx=size, eeeeee=EA)\r
 488   int num=0,type=0,size=0,ea=0;\r
 489   char eat[64]="";\r
 490 \r
 491   num =(op>>9)&7; if (num==0) num=8;\r
 492   type=(op>>8)&1;\r
 493   size=(op>>6)&3; if (size>=3) return 1;\r
 494   ea  = op&0x3f;\r
 495 \r
 496   DisaGetEa(eat,ea,size);\r
 497 \r
 498   sprintf(DisaText,"%s.%c #%d, %s",type?"subq":"addq",Tasm[size],num,eat);\r
 499   return 0;\r
 500 }\r
 501 \r
 502 // ================ Opcodes 0x50c0+ ================\r
 503 static int DisaSet(int op)\r
 504 {\r
 505   // 0101cccc 11eeeeee (sxx ea)\r
 506   static char *cond[16]=\r
 507   {"t" ,"f", "hi","ls","cc","cs","ne","eq",\r
 508    "vc","vs","pl","mi","ge","lt","gt","le"};\r
 509   char *cc="";\r
 510   int ea=0;\r
 511   char eat[64]="";\r
 512 \r
 513   cc=cond[(op>>8)&0xf]; // Get condition code\r
 514   ea=op&0x3f;\r
 515   if ((ea&0x38)==0x08) return 1; // dbra, not scc\r
 516 \r
 517   DisaGetEa(eat,ea,0);\r
 518   sprintf(DisaText,"s%s %s",cc,eat);\r
 519   return 0;\r
 520 }\r
 521 \r
 522 // ================ Opcodes 0x50c8+ ================\r
 523 static int DisaDbra(int op)\r
 524 {\r
 525   // 0101cccc 11001nnn offset  (dbra/dbxx Rn,offset)\r
 526   int dea=0; char deat[64]="";\r
 527   int pc=0,Offset=0;\r
 528 \r
 529   static char *BraCode[16]=\r
 530   {"bt" ,"bra","bhi","bls","bcc","bcs","bne","beq",\r
 531    "bvc","bvs","bpl","bmi","bge","blt","bgt","ble"};\r
 532   char *Bra="";\r
 533 \r
 534   dea=op&7;\r
 535   DisaGetEa(deat,dea,2);\r
 536 \r
 537   // Get condition code\r
 538   Bra=BraCode[(op>>8)&0xf];\r
 539 \r
 540   // Get offset\r
 541   pc=DisaPc;\r
 542   Offset=(short)DisaWord(DisaPc); DisaPc+=2;\r
 543 \r
 544   sprintf(DisaText,"d%s %s, %x",Bra,deat,pc+Offset);\r
 545   return 0;\r
 546 }\r
 547 \r
 548 // ================ Opcodes 0x6000+ ================\r
 549 static int DisaBranch(int op)\r
 550 {\r
 551   // Branch 0110cccc nn  (cccc=condition)\r
 552   int pc=0,Offset=0;\r
 553 \r
 554   static char *BraCode[16]=\r
 555   {"bra","bsr","bhi","bls","bcc","bcs","bne","beq",\r
 556    "bvc","bvs","bpl","bmi","bge","blt","bgt","ble"};\r
 557   char *Bra="";\r
 558 \r
 559   // Get condition code\r
 560   Bra=BraCode[(op>>8)&0x0f];\r
 561 \r
 562   // Get offset\r
 563   pc=DisaPc;\r
 564   Offset=(char)(op&0xff);\r
 565        if (Offset== 0) { Offset=(short)DisaWord(DisaPc); DisaPc+=2; }\r
 566   else if (Offset==-1) { Offset=       DisaLong(DisaPc); DisaPc+=4; }\r
 567 \r
 568   sprintf(DisaText,"%s %x",Bra,pc+Offset);\r
 569   return 0;\r
 570 }\r
 571 \r
 572 // ================ Opcodes 0x7000+ ================\r
 573 static int DisaMoveq(int op)\r
 574 {\r
 575   // Moveq 0111rrr0 nn (rrr=Dest register, nn=data)\r
 576 \r
 577   int dea=0; char deat[64]="";\r
 578   char *inst="moveq";\r
 579   int val=0;\r
 580 \r
 581   dea=(op>>9)&7;\r
 582   DisaGetEa(deat,dea,2);\r
 583 \r
 584   val=(char)(op&0xff);\r
 585   sprintf(DisaText,"%s #$%x, %s",inst,val,deat);\r
 586   return 0;\r
 587 }\r
 588 \r
 589 // ================ Opcodes 0x8000+ ================\r
 590 static int DisaArithReg(int op)\r
 591 {\r
 592   // 1t0tnnnd xxeeeeee (tt=type:or/sub/and/add xx=size, eeeeee=EA)\r
 593   int type=0,size=0,dir=0,rea=0,ea=0;\r
 594   char reat[64]="",eat[64]="";\r
 595   char *opcode[]={"or","sub","","","and","add"};\r
 596 \r
 597   type=(op>>12)&5;\r
 598   rea =(op>> 9)&7;\r
 599   dir =(op>> 8)&1;\r
 600   size=(op>> 6)&3; if (size>=3) return 1;\r
 601   ea  = op&0x3f;\r
 602 \r
 603   if (dir && ea<0x10) return 1; // addx opcode\r
 604 \r
 605   DisaGetEa(reat,rea,size);\r
 606   DisaGetEa( eat, ea,size);\r
 607 \r
 608   if (dir) sprintf(DisaText,"%s.%c %s, %s",opcode[type],Tasm[size],reat,eat);\r
 609   else     sprintf(DisaText,"%s.%c %s, %s",opcode[type],Tasm[size],eat,reat);\r
 610   return 0;\r
 611 }\r
 612 \r
 613 // ================ Opcodes 0x8100+ ================\r
 614 static int DisaAbcd(int op)\r
 615 {\r
 616   // 1t00ddd1 0000asss - sbcd/abcd Ds,Dd or -(As),-(Ad)\r
 617   int type=0;\r
 618   int dn=0,addr=0,sn=0;\r
 619   char *opcode[]={"sbcd","abcd"};\r
 620 \r
 621   type=(op>>14)&1;\r
 622   dn  =(op>> 9)&7;\r
 623   addr=(op>> 3)&1;\r
 624   sn  = op     &7;\r
 625 \r
 626   if (addr) sprintf(DisaText,"%s -(a%d), -(a%d)",opcode[type],sn,dn);\r
 627   else      sprintf(DisaText,"%s d%d, d%d",       opcode[type],sn,dn);\r
 628 \r
 629   return 0;\r
 630 }\r
 631 \r
 632 // ================ Opcodes 0x80c0+ ================\r
 633 static int DisaMul(int op)\r
 634 {\r
 635   // Div/Mul: 1m00nnns 11eeeeee (m=Mul, nnn=Register Dn, s=signed, eeeeee=EA)\r
 636   int type=0,rea=0,sign=0,ea=0,size=1;\r
 637   char reat[64]="",eat[64]="";\r
 638   char *opcode[2]={"div","mul"};\r
 639 \r
 640   type=(op>>14)&1; // div/mul\r
 641   rea =(op>> 9)&7;\r
 642   sign=(op>> 8)&1;\r
 643   ea  = op&0x3f;\r
 644 \r
 645   DisaGetEa(reat,rea,size);\r
 646   DisaGetEa( eat, ea,size);\r
 647 \r
 648   sprintf(DisaText,"%s%c.%c %s, %s",opcode[type],sign?'s':'u',Tasm[size],eat,reat);\r
 649   return 0;\r
 650 }\r
 651 \r
 652 // ================ Opcodes 0x90c0+ ================\r
 653 static int DisaAritha(int op)\r
 654 {\r
 655   // Suba/Cmpa/Adda 1tt1nnnx 11eeeeee (tt=type, x=size, eeeeee=Source EA)\r
 656   int type=0,size=0,sea=0,dea=0;\r
 657   char seat[64]="",deat[64]="";\r
 658   char *aritha[4]={"suba","cmpa","adda",""};\r
 659 \r
 660   type=(op>>13)&3; if (type>=3) return 1;\r
 661   size=(op>>8)&1; size++;\r
 662   dea =(op>>9)&7; dea|=8; // Dest=An\r
 663   sea = op&0x003f; // Source\r
 664 \r
 665   DisaGetEa(seat,sea,size);\r
 666   DisaGetEa(deat,dea,size);\r
 667 \r
 668   sprintf(DisaText,"%s.%c %s, %s",aritha[type],Tasm[size],seat,deat);\r
 669   return 0;\r
 670 }\r
 671 \r
 672 // ================ Opcodes 0xb000+ ================\r
 673 static int DisaCmpEor(int op)\r
 674 {\r
 675   // Cmp/Eor 1011rrrt xxeeeeee (rrr=Dn, t=cmp/eor, xx=size extension, eeeeee=ea)\r
 676   char reat[64]="",eat[64]="";\r
 677   int type=0,size=0;\r
 678 \r
 679   type=(op>>8)&1;\r
 680   size=(op>>6)&3; if (size>=3) return 1; // cmpa opcode\r
 681   if ((op&0xf138)==0xb108) return 1; // cmpm opcode\r
 682 \r
 683   DisaGetEa(reat,(op>>9)&7,size);\r
 684   DisaGetEa(eat,  op&0x3f, size);\r
 685 \r
 686   if (type) sprintf(DisaText,"eor.%c %s, %s",Tasm[size],reat,eat);\r
 687   else      sprintf(DisaText,"cmp.%c %s, %s",Tasm[size],eat,reat);\r
 688   return 0;\r
 689 }\r
 690 \r
 691 // ================ Opcodes 0xb108+ ================\r
 692 static int DisaCmpm(int op)\r
 693 {\r
 694   // Cmpm  1011ddd1 xx001sss\r
 695   int type=0,size=0,dea=0,sea=0;\r
 696   char deat[64]="",seat[64]="";\r
 697 \r
 698   type=(op>>12)&5;\r
 699   dea =(op>> 9)&7; dea|=8;\r
 700   size=(op>> 6)&3; if (size>=3) return 1;\r
 701   sea  = op&0x3f;\r
 702 \r
 703   DisaGetEa(deat,dea,size);\r
 704   DisaGetEa(seat,sea,size);\r
 705 \r
 706   sprintf(DisaText,"cmpm.%c (%s)+, (%s)+",Tasm[size],seat,deat);\r
 707 \r
 708   return 0;\r
 709 }\r
 710 \r
 711 // ================ Opcodes 0xc140+ ================\r
 712 // 1100ttt1 01000sss  exg ds,dt\r
 713 // 1100ttt1 01001sss  exg as,at\r
 714 // 1100ttt1 10001sss  exg as,dt\r
 715 static int DisaExg(int op)\r
 716 {\r
 717   int tr=0,type=0,sr=0;\r
 718 \r
 719   tr  =(op>>9)&7;\r
 720   type= op&0xf8;\r
 721   sr  = op&7;\r
 722 \r
 723        if (type==0x40) sprintf(DisaText,"exg d%d, d%d",sr,tr);\r
 724   else if (type==0x48) sprintf(DisaText,"exg a%d, a%d",sr,tr);\r
 725   else if (type==0x88) sprintf(DisaText,"exg a%d, d%d",sr,tr);\r
 726   else return 1;\r
 727 \r
 728   return 0;\r
 729 }\r
 730 \r
 731 // ================ Opcodes 0xd100+ ================\r
 732 static int DisaAddx(int op)\r
 733 {\r
 734   // 1t01ddd1 xx000sss addx\r
 735   int type=0,size=0,dea=0,sea=0;\r
 736   char deat[64]="",seat[64]="";\r
 737   char *opcode[6]={"","subx","","","","addx"};\r
 738 \r
 739   type=(op>>12)&5;\r
 740   dea =(op>> 9)&7;\r
 741   size=(op>> 6)&3; if (size>=3) return 1;\r
 742   sea  = op&0x3f;\r
 743 \r
 744   DisaGetEa(deat,dea,size);\r
 745   DisaGetEa(seat,sea,size);\r
 746 \r
 747   sprintf(DisaText,"%s.%c %s, %s",opcode[type],Tasm[size],seat,deat);\r
 748   return 0;\r
 749 }\r
 750 \r
 751 // ================ Opcodes 0xe000+ ================\r
 752 static char *AsrName[4]={"as","ls","rox","ro"};\r
 753 static int DisaAsr(int op)\r
 754 {\r
 755   // Asr/l/Ror/l etc - 1110cccd xxuttnnn\r
 756   // (ccc=count, d=direction xx=size extension, u=use reg for count, tt=type, nnn=register Dn)\r
 757   int count=0,dir=0,size=0,usereg=0,type=0,num=0;\r
 758 \r
 759   count =(op>>9)&7;\r
 760   dir   =(op>>8)&1;\r
 761   size  =(op>>6)&3; if (size>=3) return 1; // todo Asr EA\r
 762   usereg=(op>>5)&1;\r
 763   type  =(op>>3)&3;\r
 764   num   = op    &7; // Register number\r
 765 \r
 766   if (usereg==0) count=((count-1)&7)+1; // because ccc=000 means 8\r
 767 \r
 768   sprintf(DisaText,"%s%c.%c %c%d, d%d",\r
 769     AsrName[type], dir?'l':'r', Tasm[size],\r
 770     usereg?'d':'#', count, num);\r
 771   return 0;\r
 772 }\r
 773 \r
 774 static int DisaAsrEa(int op)\r
 775 {\r
 776   // Asr/l/Ror/l etc EA - 11100ttd 11eeeeee \r
 777   int type=0,dir=0,size=1;\r
 778   char eat[64]="";\r
 779 \r
 780   type=(op>>9)&3;\r
 781   dir =(op>>8)&1;\r
 782   DisaGetEa(eat,op&0x3f,size);\r
 783 \r
 784   sprintf(DisaText,"%s%c.w %s", AsrName[type], dir?'l':'r', eat);\r
 785   return 0;\r
 786 }\r
 787 \r
 788 // =================================================================\r
 789 \r
 790 static int TryOp(int op)\r
 791 {\r
 792   if ((op&0xf100)==0x0000) DisaArithImm(op); // Ori/And/Sub/Add/Eor/Cmp Immediate\r
 793   if ((op&0xf5bf)==0x003c) DisaArithSr(op); // Ori/Andi/Eori $nnnn,sr\r
 794   if ((op&0xf100)==0x0100) DisaBtstReg(op);\r
 795   if ((op&0xf138)==0x0108) DisaMovep(op);\r
 796   if ((op&0xff00)==0x0800) DisaBtstImm(op); // Btst/Bchg/Bclr/Bset\r
 797   if ((op&0xc000)==0x0000) DisaMove(op);\r
 798   if ((op&0xf900)==0x4000) DisaNeg(op); // Negx/Clr/Neg/Not\r
 799   if ((op&0xf1c0)==0x41c0) DisaLea(op);\r
 800   if ((op&0xf9c0)==0x40c0) DisaMoveSr(op);\r
 801   if ((op&0xfff8)==0x4840) DisaSwap(op);\r
 802   if ((op&0xffc0)==0x4840) DisaPea(op);\r
 803   if ((op&0xffb8)==0x4880) DisaExt(op);\r
 804   if ((op&0xfb80)==0x4880) DisaMovem(op);\r
 805   if ((op&0xff00)==0x4a00) DisaTst(op);\r
 806   if ((op&0xfff0)==0x4e40) DisaTrap(op);\r
 807   if ((op&0xfff8)==0x4e50) DisaLink(op);\r
 808   if ((op&0xfff8)==0x4e58) DisaUnlk(op);\r
 809   if ((op&0xfff0)==0x4e60) DisaMoveUsp(op);\r
 810   if ((op&0xfff8)==0x4e70) Disa4E70(op);\r
 811   if ((op&0xff80)==0x4e80) DisaJsr(op);\r
 812   if ((op&0xf000)==0x5000) DisaAddq(op);\r
 813   if ((op&0xf0c0)==0x50c0) DisaSet(op);\r
 814   if ((op&0xf0f8)==0x50c8) DisaDbra(op);\r
 815   if ((op&0xf000)==0x6000) DisaBranch(op);\r
 816   if ((op&0xa000)==0x8000) DisaArithReg(op); // Or/Sub/And/Add\r
 817   if ((op&0xb1f0)==0x8100) DisaAbcd(op);\r
 818   if ((op&0xb130)==0x9100) DisaAddx(op);\r
 819   if ((op&0xb0c0)==0x80c0) DisaMul(op);\r
 820   if ((op&0xf100)==0x7000) DisaMoveq(op);\r
 821   if ((op&0x90c0)==0x90c0) DisaAritha(op);\r
 822   if ((op&0xf000)==0xb000) DisaCmpEor(op);\r
 823   if ((op&0xf138)==0xb108) DisaCmpm(op);\r
 824   if ((op&0xf130)==0xc100) DisaExg(op);\r
 825   if ((op&0xf000)==0xe000) DisaAsr(op);\r
 826   if ((op&0xf8c0)==0xe0c0) DisaAsrEa(op);\r
 827 \r
 828   // Unknown opcoode\r
 829   return 0;\r
 830 }\r
 831 \r
 832 int DisaGet()\r
 833 {\r
 834   int op=0;\r
 835   if (DisaWord==NULL) return 1;\r
 836 \r
 837   Comment[0]=0;\r
 838   DisaText[0]=0; // Assume opcode unknown\r
 839 \r
 840   op=DisaWord(DisaPc)&0xffff; DisaPc+=2;\r
 841   TryOp(op);\r
 842   strcat(DisaText,Comment);\r
 843 \r
 844   // Unknown opcoode\r
 845   return 0;\r
 846 }\r