some optimizations
[picodrive.git] / cpu / 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 OpStart(int op, int sea, int tea)\r
29 {\r
30   Cycles=0;\r
31   OpUse(op,op); // This opcode obviously uses this handler\r
32   ot("Op%.4x%s\n", op, ms?"":":");\r
33 #if (MEMHANDLERS_NEED_PREV_PC || MEMHANDLERS_NEED_CYCLES)\r
34   if ((sea >= 0x10 && sea != 0x3c) || (tea >= 0x10 && tea != 0x3c)) {\r
35 #if MEMHANDLERS_NEED_PREV_PC\r
36     ot("  str r4,[r7,#0x50] ;@ Save prev PC + 2\n");\r
37 #endif\r
38 #if MEMHANDLERS_NEED_CYCLES\r
39     ot("  str r5,[r7,#0x5c] ;@ Save Cycles\n");\r
40 #endif\r
41     ot("\n");\r
42   }\r
43 #endif\r
44   pc_dirty = 1;\r
45 }\r
46 \r
47 void OpEnd(int sea, int tea)\r
48 {\r
49 #if MEMHANDLERS_CHANGE_CYCLES\r
50   if ((sea >= 0x10 && sea != 0x3c) || (tea >= 0x10 && tea != 0x3c))\r
51     ot("  ldr r5,[r7,#0x5c] ;@ Load Cycles\n");\r
52 #endif\r
53   ot("  ldrh r8,[r4],#2 ;@ Fetch next opcode\n");\r
54   ot("  subs r5,r5,#%d ;@ Subtract cycles\n",Cycles);\r
55   ot("  ldrge pc,[r6,r8,asl #2] ;@ Jump to opcode handler\n");\r
56   ot("  b CycloneEnd\n");\r
57   ot("\n");\r
58 }\r
59 \r
60 int OpBase(int op,int sepa)\r
61 {\r
62   int ea=op&0x3f; // Get Effective Address\r
63   if (ea<0x10) return sepa?(op&~0x7):(op&~0xf); // Use 1 handler for d0-d7 and a0-a7\r
64   if (ea>=0x18 && ea<0x28 && (ea&7)==7) return op; // Specific handler for (a7)+ and -(a7)\r
65   if (ea<0x38) return op&~7;   // Use 1 handler for (a0)-(a7), etc...\r
66   return op;\r
67 }\r
68 \r
69 // Get flags, trashes r2\r
70 int OpGetFlags(int subtract,int xbit,int specialz)\r
71 {\r
72   if (specialz) ot("  orr r2,r9,#0xb0000000 ;@ for old Z\n");\r
73 \r
74   ot("  mrs r9,cpsr ;@ r9=flags\n");\r
75 \r
76   if (specialz) ot("  andeq r9,r9,r2 ;@ fix Z\n");\r
77 \r
78   if (subtract) ot("  eor r9,r9,#0x20000000 ;@ Invert carry\n");\r
79 \r
80   if (xbit)\r
81   {\r
82     ot("  mov r2,r9,lsr #28\n");\r
83     ot("  strb r2,[r7,#0x45] ;@ Save X bit\n");\r
84   }\r
85   return 0;\r
86 }\r
87 \r
88 // -----------------------------------------------------------------\r
89 \r
90 void OpAny(int op)\r
91 {\r
92   memset(OpData,0x33,sizeof(OpData));\r
93   OpData[0]=(unsigned char)(op>>8);\r
94   OpData[1]=(unsigned char)op;\r
95 \r
96   if ((op&0xf100)==0x0000) OpArith(op);\r
97   if ((op&0xc000)==0x0000) OpMove(op);\r
98   if ((op&0xf5bf)==0x003c) OpArithSr(op); // Ori/Andi/Eori $nnnn,sr\r
99   if ((op&0xf100)==0x0100) OpBtstReg(op);\r
100   if ((op&0xf138)==0x0108) OpMovep(op);\r
101   if ((op&0xff00)==0x0800) OpBtstImm(op);\r
102   if ((op&0xf900)==0x4000) OpNeg(op);\r
103   if ((op&0xf140)==0x4100) OpChk(op);\r
104   if ((op&0xf1c0)==0x41c0) OpLea(op);\r
105   if ((op&0xf9c0)==0x40c0) OpMoveSr(op);\r
106   if ((op&0xffc0)==0x4800) OpNbcd(op);\r
107   if ((op&0xfff8)==0x4840) OpSwap(op);\r
108   if ((op&0xffc0)==0x4840) OpPea(op);\r
109   if ((op&0xffb8)==0x4880) OpExt(op);\r
110   if ((op&0xfb80)==0x4880) OpMovem(op);\r
111   if ((op&0xff00)==0x4a00) OpTst(op);\r
112   if ((op&0xffc0)==0x4ac0) OpTas(op);\r
113   if ((op&0xfff0)==0x4e40) OpTrap(op);\r
114   if ((op&0xfff8)==0x4e50) OpLink(op);\r
115   if ((op&0xfff8)==0x4e58) OpUnlk(op);\r
116   if ((op&0xfff0)==0x4e60) OpMoveUsp(op);\r
117   if ((op&0xfff8)==0x4e70) Op4E70(op); // Reset/Rts etc\r
118   if ((op&0xfffd)==0x4e70) OpStopReset(op);\r
119   if ((op&0xff80)==0x4e80) OpJsr(op);\r
120   if ((op&0xf000)==0x5000) OpAddq(op);\r
121   if ((op&0xf0c0)==0x50c0) OpSet(op);\r
122   if ((op&0xf0f8)==0x50c8) OpDbra(op);\r
123   if ((op&0xf000)==0x6000) OpBranch(op);\r
124   if ((op&0xf100)==0x7000) OpMoveq(op);\r
125   if ((op&0xa000)==0x8000) OpArithReg(op); // Or/Sub/And/Add\r
126   if ((op&0xb1f0)==0x8100) OpAbcd(op);\r
127   if ((op&0xb0c0)==0x80c0) OpMul(op);\r
128   if ((op&0x90c0)==0x90c0) OpAritha(op);\r
129   if ((op&0xb130)==0x9100) OpAddx(op);\r
130   if ((op&0xf000)==0xb000) OpCmpEor(op);\r
131   if ((op&0xf138)==0xb108) OpCmpm(op);\r
132   if ((op&0xf130)==0xc100) OpExg(op);\r
133   if ((op&0xf000)==0xe000) OpAsr(op); // Asr/l/Ror/l etc\r
134   if ((op&0xf8c0)==0xe0c0) OpAsrEa(op);\r
135 }\r