Cyclone/OpAny.cpp

   1 \r
   2 #include "app.h"\r
   3 \r
   4 static unsigned char OpData[16]={0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};\r
   5 \r
   6 static unsigned short CPU_CALL OpRead16(unsigned int a)\r
   7 {\r
   8   return (unsigned short)( (OpData[a&15]<<8) | OpData[(a+1)&15] );\r
   9 }\r
  10 \r
  11 // For opcode 'op' use handler 'use'\r
  12 void OpUse(int op,int use)\r
  13 {\r
  14   char text[64]="";\r
  15   CyJump[op]=use;\r
  16 \r
  17   if (op!=use) return;\r
  18 \r
  19   // Disassemble opcode\r
  20   DisaPc=0;\r
  21   DisaText=text;\r
  22   DisaWord=OpRead16;\r
  23 \r
  24   DisaGet();\r
  25   ot(";@ ---------- [%.4x] %s uses Op%.4x ----------\n",op,text,use);\r
  26 }\r
  27 \r
  28 void OpFirst()\r
  29 {\r
  30   ot("  ldrh r8,[r4],#2 ;@ Fetch first opcode\n");\r
  31   ot("  ldr pc,[r6,r8,asl #2] ;@ Jump to opcode handler\n");\r
  32 }\r
  33 \r
  34 void OpStart(int op)\r
  35 {\r
  36   Cycles=0;\r
  37   OpUse(op,op); // This opcode obviously uses this handler\r
  38   ot("Op%.4x%s\n", op, ms?"":":");\r
  39 }\r
  40 \r
  41 void OpEnd()\r
  42 {\r
  43   ot("  ldrh r8,[r4],#2 ;@ Fetch next opcode\n");\r
  44   ot("  subs r5,r5,#%d ;@ Subtract cycles\n",Cycles);\r
  45   ot("  ldrge pc,[r6,r8,asl #2] ;@ Jump to opcode handler\n");\r
  46   ot("  b CycloneEnd\n");\r
  47   ltorg();\r
  48   ot("\n");\r
  49 }\r
  50 \r
  51 int OpBase(int op)\r
  52 {\r
  53   int ea=op&0x3f; // Get Effective Address\r
  54   if (ea<0x10) return op&~0xf; // Use 1 handler for d0-d7 and a0-a7\r
  55   if (ea>=0x18 && ea<0x28 && (ea&7)==7) return op; // Specific handler for (a7)+ and -(a7)\r
  56   if (ea<0x38) return op&~7;   // Use 1 handler for (a0)-(a7), etc...\r
  57   return op;\r
  58 }\r
  59 \r
  60 // Get flags, trashes r2\r
  61 int OpGetFlags(int subtract,int xbit)\r
  62 {\r
  63   ot("  mrs r9,cpsr ;@ r9=flags\n");\r
  64 \r
  65   if (subtract) ot("  eor r9,r9,#0x20000000 ;@ Invert carry\n");\r
  66 \r
  67   if (Accu&1) if (xbit)\r
  68   {\r
  69     ot("  mov r2,r9,lsr #28\n");\r
  70     ot("  strb r2,[r7,#0x45] ;@ Save X bit\n");\r
  71   }\r
  72   return 0;\r
  73 }\r
  74 \r
  75 // -----------------------------------------------------------------\r
  76 \r
  77 void OpAny(int op)\r
  78 {\r
  79   memset(OpData,0x33,sizeof(OpData));\r
  80   OpData[0]=(unsigned char)(op>>8);\r
  81   OpData[1]=(unsigned char)op;\r
  82 \r
  83   if ((op&0xf100)==0x0000) OpArith(op);\r
  84   if ((op&0xc000)==0x0000) OpMove(op);\r
  85   if ((op&0xf5bf)==0x003c) OpArithSr(op); // Ori/Andi/Eori $nnnn,sr\r
  86   if ((op&0xf100)==0x0100) OpBtstReg(op);\r
  87   if ((op&0xff00)==0x0800) OpBtstImm(op);\r
  88   if ((op&0xf900)==0x4000) OpNeg(op);\r
  89   if ((op&0xf1c0)==0x41c0) OpLea(op);\r
  90   if ((op&0xf9c0)==0x40c0) OpMoveSr(op);\r
  91   if ((op&0xfff8)==0x4840) OpSwap(op);\r
  92   if ((op&0xffc0)==0x4840) OpPea(op);\r
  93   if ((op&0xffb8)==0x4880) OpExt(op);\r
  94   if ((op&0xfb80)==0x4880) OpMovem(op);\r
  95   if ((op&0xff00)==0x4a00) OpTst(op);\r
  96   if ((op&0xfff0)==0x4e40) OpTrap(op);\r
  97   if ((op&0xfff8)==0x4e50) OpLink(op);\r
  98   if ((op&0xfff8)==0x4e58) OpUnlk(op);\r
  99   if ((op&0xfff0)==0x4e60) OpMoveUsp(op);\r
 100   if ((op&0xfff8)==0x4e70) Op4E70(op); // Reset/Rts etc\r
 101   if ((op&0xff80)==0x4e80) OpJsr(op);\r
 102   if ((op&0xf000)==0x5000) OpAddq(op);\r
 103   if ((op&0xf0c0)==0x50c0) OpSet(op);\r
 104   if ((op&0xf0f8)==0x50c8) OpDbra(op);\r
 105   if ((op&0xf000)==0x6000) OpBranch(op);\r
 106   if ((op&0xf100)==0x7000) OpMoveq(op);\r
 107   if ((op&0xa000)==0x8000) OpArithReg(op); // Or/Sub/And/Add\r
 108   if ((op&0xb1f0)==0x8100) OpAbcd(op);\r
 109   if ((op&0xb0c0)==0x80c0) OpMul(op);\r
 110   if ((op&0x90c0)==0x90c0) OpAritha(op);\r
 111   if ((op&0xb138)==0x9100) OpAddx(op);\r
 112   if ((op&0xf000)==0xb000) OpCmpEor(op);\r
 113   if ((op&0xf130)==0xc100) OpExg(op);\r
 114   if ((op&0xf000)==0xe000) OpAsr(op); // Asr/l/Ror/l etc\r
 115   if ((op&0xf8c0)==0xe0c0) OpAsrEa(op);\r
 116 \r
 117 }\r