6003a768 |
1 | \r |
619b1824 |
2 | // This file is part of the Cyclone 68000 Emulator\r |
3 | \r |
d9d77995 |
4 | // Copyright (c) 2004,2011 FinalDave (emudave (at) gmail.com)\r |
5 | // Copyright (c) 2005-2011 GraÅžvydas "notaz" Ignotas (notasas (at) gmail.com)\r |
c41b9b97 |
6 | \r |
619b1824 |
7 | // This code is licensed under the GNU General Public License version 2.0 and the MAME License.\r |
8 | // You can choose the license that has the most advantages for you.\r |
9 | \r |
10 | // SVN repository can be found at http://code.google.com/p/cyclone68000/\r |
11 | \r |
d9d77995 |
12 | \r |
6003a768 |
13 | #include "app.h"\r |
14 | \r |
15 | // --------------------- Opcodes 0x0000+ ---------------------\r |
d9d77995 |
16 | // Emit an Ori/And/Sub/Add/Eor/Cmp Immediate opcode, 0000ttt0 ssaaaaaa\r |
6003a768 |
17 | int OpArith(int op)\r |
18 | {\r |
19 | int type=0,size=0;\r |
20 | int sea=0,tea=0;\r |
21 | int use=0;\r |
d9d77995 |
22 | const char *shiftstr="";\r |
6003a768 |
23 | \r |
24 | // Get source and target EA\r |
25 | type=(op>>9)&7; if (type==4 || type>=7) return 1;\r |
26 | size=(op>>6)&3; if (size>=3) return 1;\r |
27 | sea= 0x003c;\r |
28 | tea=op&0x003f;\r |
29 | \r |
30 | // See if we can do this opcode:\r |
31 | if (EaCanRead(tea,size)==0) return 1;\r |
d9d77995 |
32 | if (EaCanWrite(tea)==0 || EaAn(tea)) return 1;\r |
6003a768 |
33 | \r |
d9d77995 |
34 | use=OpBase(op,size);\r |
6003a768 |
35 | if (op!=use) { OpUse(op,use); return 0; } // Use existing handler\r |
36 | \r |
d9d77995 |
37 | OpStart(op, sea, tea); Cycles=4;\r |
6003a768 |
38 | \r |
d9d77995 |
39 | // imm must be read first\r |
65044ba9 |
40 | EaCalcRead(-1,10,sea,size,0,earwt_msb_dont_care);\r |
41 | EaCalcRead((type!=6)?11:-1,0,tea,size,0x003f,earwt_msb_dont_care);\r |
6003a768 |
42 | \r |
d9d77995 |
43 | if (size<2) shiftstr=(char *)(size?",asl #16":",asl #24");\r |
44 | if (size<2) ot(" mov r10,r10,asl #%i\n",size?16:24);\r |
6003a768 |
45 | \r |
46 | ot(";@ Do arithmetic:\n");\r |
47 | \r |
3504ce94 |
48 | if (type==0) ot(" orrs r1,r10,r0%s\n",shiftstr);\r |
49 | if (type==1) ot(" ands r1,r10,r0%s\n",shiftstr);\r |
d9d77995 |
50 | if (type==2||type==6)\r |
51 | ot(" rsbs r1,r10,r0%s ;@ Defines NZCV\n",shiftstr);\r |
52 | if (type==3) ot(" adds r1,r10,r0%s ;@ Defines NZCV\n",shiftstr);\r |
3504ce94 |
53 | if (type==5) ot(" eors r1,r10,r0%s\n",shiftstr);\r |
6003a768 |
54 | \r |
3504ce94 |
55 | if (type< 2) OpGetFlagsNZ(1); // Ori/And\r |
6003a768 |
56 | if (type==2) OpGetFlags(1,1); // Sub: Subtract/X-bit\r |
57 | if (type==3) OpGetFlags(0,1); // Add: X-bit\r |
3504ce94 |
58 | if (type==5) OpGetFlagsNZ(1); // Eor\r |
6003a768 |
59 | if (type==6) OpGetFlags(1,0); // Cmp: Subtract\r |
60 | ot("\n");\r |
61 | \r |
62 | if (type!=6)\r |
63 | {\r |
65044ba9 |
64 | EaWrite(11, 1, tea,size,0x003f,earwt_shifted_up);\r |
6003a768 |
65 | }\r |
66 | \r |
67 | // Correct cycles:\r |
68 | if (type==6)\r |
69 | {\r |
70 | if (size>=2 && tea<0x10) Cycles+=2;\r |
71 | }\r |
72 | else\r |
73 | {\r |
74 | if (size>=2) Cycles+=4;\r |
d9d77995 |
75 | if (tea>=8) Cycles+=4;\r |
76 | if (type==1 && size>=2 && tea<8) Cycles-=2;\r |
6003a768 |
77 | }\r |
78 | \r |
d9d77995 |
79 | OpEnd(sea,tea);\r |
6003a768 |
80 | \r |
81 | return 0;\r |
82 | }\r |
83 | \r |
84 | // --------------------- Opcodes 0x5000+ ---------------------\r |
85 | int OpAddq(int op)\r |
86 | {\r |
87 | // 0101nnnt xxeeeeee (nnn=#8,1-7 t=addq/subq xx=size, eeeeee=EA)\r |
88 | int num=0,type=0,size=0,ea=0;\r |
89 | int use=0;\r |
90 | char count[16]="";\r |
91 | int shift=0;\r |
92 | \r |
93 | num =(op>>9)&7; if (num==0) num=8;\r |
94 | type=(op>>8)&1;\r |
95 | size=(op>>6)&3; if (size>=3) return 1;\r |
96 | ea = op&0x3f;\r |
97 | \r |
98 | // See if we can do this opcode:\r |
99 | if (EaCanRead (ea,size)==0) return 1;\r |
d9d77995 |
100 | if (EaCanWrite(ea) ==0) return 1;\r |
101 | if (size == 0 && EaAn(ea) ) return 1;\r |
6003a768 |
102 | \r |
d9d77995 |
103 | use=OpBase(op,size,1);\r |
6003a768 |
104 | \r |
105 | if (num!=8) use|=0x0e00; // If num is not 8, use same handler\r |
106 | if (op!=use) { OpUse(op,use); return 0; } // Use existing handler\r |
107 | \r |
d9d77995 |
108 | OpStart(op,ea);\r |
6003a768 |
109 | Cycles=ea<8?4:8;\r |
d9d77995 |
110 | if(type==0&&size==1) Cycles=ea<0x10?4:8;\r |
111 | if(size>=2) Cycles=ea<0x10?8:12;\r |
112 | \r |
113 | if (size>0 && (ea&0x38)==0x08) size=2; // addq.w #n,An is also 32-bit\r |
6003a768 |
114 | \r |
65044ba9 |
115 | EaCalcRead(11,0,ea,size,0x003f,earwt_msb_dont_care);\r |
6003a768 |
116 | \r |
117 | shift=32-(8<<size);\r |
118 | \r |
119 | if (num!=8)\r |
120 | {\r |
121 | int lsr=9-shift;\r |
122 | \r |
d9d77995 |
123 | ot(" and r2,r8,#0x0e00 ;@ Get quick value\n");\r |
124 | \r |
125 | if (lsr>=0) sprintf(count,"r2,lsr #%d", lsr);\r |
126 | else sprintf(count,"r2,lsl #%d", -lsr);\r |
6003a768 |
127 | \r |
6003a768 |
128 | ot("\n");\r |
d9d77995 |
129 | }\r |
130 | else\r |
131 | {\r |
132 | sprintf(count,"#0x%.4x",8<<shift);\r |
6003a768 |
133 | }\r |
134 | \r |
d9d77995 |
135 | if (size<2) ot(" mov r0,r0,asl #%d\n\n",size?16:24);\r |
6003a768 |
136 | \r |
137 | if (type==0) ot(" adds r1,r0,%s\n",count);\r |
138 | if (type==1) ot(" subs r1,r0,%s\n",count);\r |
139 | \r |
140 | if ((ea&0x38)!=0x08) OpGetFlags(type,1);\r |
141 | ot("\n");\r |
142 | \r |
65044ba9 |
143 | EaWrite(11, 1, ea,size,0x003f,earwt_shifted_up);\r |
6003a768 |
144 | \r |
d9d77995 |
145 | OpEnd(ea);\r |
6003a768 |
146 | \r |
147 | return 0;\r |
148 | }\r |
149 | \r |
150 | // --------------------- Opcodes 0x8000+ ---------------------\r |
151 | // 1t0tnnnd xxeeeeee (tt=type:or/sub/and/add xx=size, eeeeee=EA)\r |
152 | int OpArithReg(int op)\r |
153 | {\r |
154 | int use=0;\r |
155 | int type=0,size=0,dir=0,rea=0,ea=0;\r |
d9d77995 |
156 | const char *asl="";\r |
157 | const char *strop=0;\r |
6003a768 |
158 | \r |
159 | type=(op>>12)&5;\r |
160 | rea =(op>> 9)&7;\r |
d9d77995 |
161 | dir =(op>> 8)&1; // er,re\r |
6003a768 |
162 | size=(op>> 6)&3; if (size>=3) return 1;\r |
163 | ea = op&0x3f;\r |
164 | \r |
165 | if (dir && ea<0x10) return 1; // addx/subx opcode\r |
166 | \r |
167 | // See if we can do this opcode:\r |
d9d77995 |
168 | if (dir==0 && EaCanRead (ea,size)==0) return 1;\r |
169 | if (dir && EaCanWrite(ea)==0) return 1;\r |
170 | if ((size==0||!(type&1))&&EaAn(ea)) return 1;\r |
6003a768 |
171 | \r |
d9d77995 |
172 | use=OpBase(op,size);\r |
6003a768 |
173 | use&=~0x0e00; // Use same opcode for Dn\r |
174 | if (op!=use) { OpUse(op,use); return 0; } // Use existing handler\r |
175 | \r |
d9d77995 |
176 | OpStart(op,ea); Cycles=4;\r |
6003a768 |
177 | \r |
65044ba9 |
178 | EaCalcRead(dir?11:-1,0,ea,size,0x003f,earwt_msb_dont_care);\r |
d9d77995 |
179 | \r |
65044ba9 |
180 | EaCalcRead(dir?-1:11,1,rea,size,0x0e00,earwt_msb_dont_care);\r |
6003a768 |
181 | \r |
182 | ot(";@ Do arithmetic:\n");\r |
3504ce94 |
183 | if (type==0) strop = "orrs";\r |
d9d77995 |
184 | if (type==1) strop = (char *) (dir ? "subs" : "rsbs");\r |
3504ce94 |
185 | if (type==4) strop = "ands";\r |
d9d77995 |
186 | if (type==5) strop = "adds";\r |
187 | \r |
188 | if (size==0) asl=",asl #24";\r |
189 | if (size==1) asl=",asl #16";\r |
190 | \r |
191 | if (size<2) ot(" mov r0,r0%s\n",asl);\r |
192 | ot(" %s r1,r0,r1%s\n",strop,asl);\r |
6003a768 |
193 | \r |
3504ce94 |
194 | if (type&1) OpGetFlags(type==1,type&1); // add/subtract\r |
195 | else OpGetFlagsNZ(1);\r |
6003a768 |
196 | ot("\n");\r |
197 | \r |
198 | ot(";@ Save result:\n");\r |
d9d77995 |
199 | if (size<2) ot(" mov r1,r1,asr #%d\n",size?16:24);\r |
65044ba9 |
200 | if (dir) EaWrite(11, 1, ea,size,0x003f,earwt_msb_dont_care);\r |
201 | else EaWrite(11, 1,rea,size,0x0e00,earwt_msb_dont_care);\r |
d9d77995 |
202 | \r |
203 | if(rea==ea) {\r |
204 | if(ea<8) Cycles=(size>=2)?8:4; else Cycles+=(size>=2)?26:14;\r |
205 | } else if(dir) {\r |
206 | Cycles+=4;\r |
207 | if(size>=2) Cycles+=4;\r |
208 | } else {\r |
209 | if(size>=2) {\r |
210 | Cycles+=2;\r |
211 | if(ea<0x10||ea==0x3c) Cycles+=2;\r |
212 | }\r |
213 | }\r |
6003a768 |
214 | \r |
d9d77995 |
215 | OpEnd(ea);\r |
6003a768 |
216 | \r |
217 | return 0;\r |
218 | }\r |
219 | \r |
220 | // --------------------- Opcodes 0x80c0+ ---------------------\r |
221 | int OpMul(int op)\r |
222 | {\r |
223 | // Div/Mul: 1m00nnns 11eeeeee (m=Mul, nnn=Register Dn, s=signed, eeeeee=EA)\r |
224 | int type=0,rea=0,sign=0,ea=0;\r |
225 | int use=0;\r |
226 | \r |
227 | type=(op>>14)&1; // div/mul\r |
228 | rea =(op>> 9)&7;\r |
229 | sign=(op>> 8)&1;\r |
230 | ea = op&0x3f;\r |
231 | \r |
232 | // See if we can do this opcode:\r |
d9d77995 |
233 | if (EaCanRead(ea,1)==0||EaAn(ea)) return 1;\r |
6003a768 |
234 | \r |
d9d77995 |
235 | use=OpBase(op,1);\r |
6003a768 |
236 | use&=~0x0e00; // Use same for all registers\r |
237 | if (op!=use) { OpUse(op,use); return 0; } // Use existing handler\r |
238 | \r |
d9d77995 |
239 | OpStart(op,ea);\r |
240 | if(type) Cycles=54;\r |
241 | else Cycles=sign?158:140;\r |
6003a768 |
242 | \r |
65044ba9 |
243 | EaCalcRead(-1,0,ea,1,0x003f,earwt_msb_dont_care);\r |
6003a768 |
244 | \r |
d9d77995 |
245 | EaCalc(11,0x0e00,rea, 2);\r |
246 | EaRead(11, 2,rea, 2,0x0e00);\r |
6003a768 |
247 | \r |
d9d77995 |
248 | ot(" movs r1,r0,asl #16\n");\r |
249 | \r |
250 | if (type==0) // div\r |
6003a768 |
251 | {\r |
d9d77995 |
252 | // the manual says C is always cleared, but neither Musashi nor FAME do that\r |
253 | //ot(" bic r10,r10,#0x20000000 ;@ always clear C\n");\r |
254 | ot(" beq divzero%.4x ;@ division by zero\n",op);\r |
6003a768 |
255 | ot("\n");\r |
256 | \r |
257 | if (sign)\r |
258 | {\r |
d9d77995 |
259 | ot(" mov r12,#0 ;@ r12 = 1 or 2 if the result is negative\n");\r |
260 | ot(" tst r2,r2\n");\r |
261 | ot(" orrmi r12,r12,#2\n");\r |
262 | ot(" rsbmi r2,r2,#0 ;@ Make r2 positive\n");\r |
6003a768 |
263 | ot("\n");\r |
d9d77995 |
264 | ot(" movs r0,r1,asr #16\n");\r |
265 | ot(" orrmi r12,r12,#1\n");\r |
266 | ot(" rsbmi r0,r0,#0 ;@ Make r0 positive\n");\r |
6003a768 |
267 | ot("\n");\r |
d9d77995 |
268 | ot(";@ detect the nasty 0x80000000 / -1 situation\n");\r |
269 | ot(" mov r3,r2,asr #31\n");\r |
270 | ot(" eors r3,r3,r1,asr #16\n");\r |
271 | ot(" beq wrendofop%.4x\n",op);\r |
272 | }\r |
273 | else\r |
274 | {\r |
275 | ot(" mov r0,r1,lsr #16 ;@ use only 16 bits of divisor\n");\r |
6003a768 |
276 | }\r |
277 | \r |
d9d77995 |
278 | ot("\n");\r |
279 | ot(";@ Divide r2 by r0\n");\r |
6003a768 |
280 | ot(" mov r3,#0\n");\r |
d9d77995 |
281 | ot(" mov r1,r0\n");\r |
6003a768 |
282 | ot("\n");\r |
283 | ot(";@ Shift up divisor till it's just less than numerator\n");\r |
284 | ot("Shift%.4x%s\n",op,ms?"":":");\r |
285 | ot(" cmp r1,r2,lsr #1\n");\r |
286 | ot(" movls r1,r1,lsl #1\n");\r |
287 | ot(" bcc Shift%.4x\n",op);\r |
288 | ot("\n");\r |
289 | \r |
290 | ot("Divide%.4x%s\n",op,ms?"":":");\r |
291 | ot(" cmp r2,r1\n");\r |
292 | ot(" adc r3,r3,r3 ;@ Double r3 and add 1 if carry set\n");\r |
293 | ot(" subcs r2,r2,r1\n");\r |
d9d77995 |
294 | ot(" teq r1,r0\n");\r |
6003a768 |
295 | ot(" movne r1,r1,lsr #1\n");\r |
296 | ot(" bne Divide%.4x\n",op);\r |
297 | ot("\n");\r |
d9d77995 |
298 | ot(";@r3==quotient,r2==remainder\n");\r |
6003a768 |
299 | \r |
300 | if (sign)\r |
301 | {\r |
d9d77995 |
302 | // sign correction\r |
303 | ot(" and r1,r12,#1\n");\r |
304 | ot(" teq r1,r12,lsr #1\n");\r |
305 | ot(" rsbne r3,r3,#0 ;@ negate if quotient is negative\n");\r |
306 | ot(" tst r12,#2\n");\r |
307 | ot(" rsbne r2,r2,#0 ;@ negate the remainder if divident was negative\n");\r |
308 | ot("\n");\r |
6003a768 |
309 | \r |
d9d77995 |
310 | // signed overflow check\r |
311 | ot(" mov r1,r3,asl #16\n");\r |
312 | ot(" cmp r3,r1,asr #16 ;@ signed overflow?\n");\r |
313 | ot(" orrne r10,r10,#0x10000000 ;@ set overflow flag\n");\r |
314 | ot(" bne endofop%.4x ;@ overflow!\n",op);\r |
315 | ot("\n");\r |
316 | ot("wrendofop%.4x%s\n",op,ms?"":":");\r |
317 | }\r |
318 | else\r |
319 | {\r |
320 | // overflow check\r |
321 | ot(" movs r1,r3,lsr #16 ;@ check for overflow condition\n");\r |
322 | ot(" orrne r10,r10,#0x10000000 ;@ set overflow flag\n");\r |
323 | ot(" bne endofop%.4x ;@ overflow!\n",op);\r |
324 | ot("\n");\r |
325 | }\r |
6003a768 |
326 | \r |
3504ce94 |
327 | ot(" movs r1,r3,lsl #16 ;@ Clip to 16-bits\n");\r |
328 | OpGetFlagsNZ(1);\r |
6003a768 |
329 | \r |
6003a768 |
330 | ot(" mov r1,r1,lsr #16\n");\r |
d9d77995 |
331 | ot(" orr r1,r1,r2,lsl #16 ;@ Insert remainder\n");\r |
6003a768 |
332 | }\r |
333 | \r |
334 | if (type==1)\r |
335 | {\r |
6003a768 |
336 | ot(";@ Get 16-bit signs right:\n");\r |
d9d77995 |
337 | ot(" mov r0,r1,%s #16\n",sign?"asr":"lsr");\r |
6003a768 |
338 | ot(" mov r2,r2,lsl #16\n");\r |
d9d77995 |
339 | ot(" mov r2,r2,%s #16\n",sign?"asr":"lsr");\r |
6003a768 |
340 | ot("\n");\r |
341 | \r |
3504ce94 |
342 | ot(" muls r1,r2,r0\n");\r |
343 | OpGetFlagsNZ(1);\r |
6003a768 |
344 | }\r |
345 | ot("\n");\r |
346 | \r |
65044ba9 |
347 | EaWrite(11, 1,rea, 2,0x0e00,earwt_shifted_up);\r |
6003a768 |
348 | \r |
d9d77995 |
349 | if (type==0) ot("endofop%.4x%s\n",op,ms?"":":");\r |
350 | OpEnd(ea);\r |
6003a768 |
351 | \r |
d9d77995 |
352 | if (type==0) // div\r |
353 | {\r |
354 | ot("divzero%.4x%s\n",op,ms?"":":");\r |
355 | ot(" mov r0,#5 ;@ Divide by zero\n");\r |
356 | ot(" bl Exception\n");\r |
357 | Cycles+=38;\r |
358 | OpEnd(ea);\r |
359 | ot("\n");\r |
360 | }\r |
6003a768 |
361 | \r |
362 | return 0;\r |
363 | }\r |
364 | \r |
365 | // Get X Bit into carry - trashes r2\r |
d9d77995 |
366 | int GetXBit(int subtract)\r |
6003a768 |
367 | {\r |
368 | ot(";@ Get X bit:\n");\r |
d9d77995 |
369 | ot(" ldr r2,[r7,#0x4c]\n");\r |
370 | if (subtract) ot(" mvn r2,r2 ;@ Invert it\n");\r |
cfe17eee |
371 | ot(" tst r2,r2,lsl #3 ;@ Get into Carry\n");\r |
6003a768 |
372 | ot("\n");\r |
373 | return 0;\r |
374 | }\r |
375 | \r |
376 | // --------------------- Opcodes 0x8100+ ---------------------\r |
377 | // 1t00ddd1 0000asss - sbcd/abcd Ds,Dd or -(As),-(Ad)\r |
378 | int OpAbcd(int op)\r |
379 | {\r |
380 | int use=0;\r |
d9d77995 |
381 | int type=0,sea=0,mem=0,dea=0;\r |
6003a768 |
382 | \r |
d9d77995 |
383 | type=(op>>14)&1; // sbcd/abcd\r |
6003a768 |
384 | dea =(op>> 9)&7;\r |
d9d77995 |
385 | mem =(op>> 3)&1;\r |
6003a768 |
386 | sea = op &7;\r |
387 | \r |
d9d77995 |
388 | if (mem) { sea|=0x20; dea|=0x20; }\r |
6003a768 |
389 | \r |
d9d77995 |
390 | use=op&~0x0e07; // Use same opcode for all registers..\r |
391 | if (sea==0x27) use|=0x0007; // ___x.b -(a7)\r |
392 | if (dea==0x27) use|=0x0e00; // ___x.b -(a7)\r |
6003a768 |
393 | if (op!=use) { OpUse(op,use); return 0; } // Use existing handler\r |
394 | \r |
d9d77995 |
395 | OpStart(op,sea,dea); Cycles=6;\r |
6003a768 |
396 | \r |
d9d77995 |
397 | if (mem)\r |
398 | {\r |
399 | ot(";@ Get src/dest EA vals\n");\r |
65044ba9 |
400 | EaCalc (0,0x000f, sea,0,earwt_shifted_up);\r |
401 | EaRead (0, 6, sea,0,0x000f,earwt_shifted_up);\r |
402 | EaCalcRead(11,0,dea,0,0x0e00,earwt_msb_dont_care);\r |
d9d77995 |
403 | }\r |
404 | else\r |
405 | {\r |
406 | ot(";@ Get src/dest reg vals\n");\r |
65044ba9 |
407 | EaCalcRead(-1,6,sea,0,0x0007,earwt_msb_dont_care);\r |
408 | EaCalcRead(11,0,dea,0,0x0e00,earwt_msb_dont_care);\r |
d9d77995 |
409 | ot(" mov r6,r6,asl #24\n");\r |
410 | }\r |
411 | ot(" mov r1,r0,asl #24\n\n");\r |
6003a768 |
412 | \r |
d9d77995 |
413 | ot(" bic r10,r10,#0xb1000000 ;@ clear all flags except old Z\n");\r |
6003a768 |
414 | \r |
415 | if (type)\r |
416 | {\r |
d9d77995 |
417 | ot(" ldr r0,[r7,#0x4c] ;@ Get X bit\n");\r |
418 | ot(" mov r3,#0x00f00000\n");\r |
419 | ot(" and r2,r3,r1,lsr #4\n");\r |
420 | ot(" tst r0,#0x20000000\n");\r |
421 | ot(" and r0,r3,r6,lsr #4\n");\r |
422 | ot(" add r0,r0,r2\n");\r |
423 | ot(" addne r0,r0,#0x00100000\n");\r |
424 | // ot(" tst r0,#0x00800000\n");\r |
425 | // ot(" orreq r10,r10,#0x01000000 ;@ Undefined V behavior\n");\r |
426 | ot(" cmp r0,#0x00900000\n");\r |
427 | ot(" addhi r0,r0,#0x00600000 ;@ Decimal adjust units\n");\r |
428 | \r |
429 | ot(" mov r2,r1,lsr #28\n");\r |
430 | ot(" add r0,r0,r2,lsl #24\n");\r |
431 | ot(" mov r2,r6,lsr #28\n");\r |
432 | ot(" add r0,r0,r2,lsl #24\n");\r |
433 | ot(" cmp r0,#0x09900000\n");\r |
434 | ot(" orrhi r10,r10,#0x20000000 ;@ C\n");\r |
435 | ot(" subhi r0,r0,#0x0a000000\n");\r |
436 | // ot(" and r3,r10,r0,lsr #3 ;@ Undefined V behavior part II\n");\r |
437 | // ot(" orr r10,r10,r3,lsl #4 ;@ V\n");\r |
438 | ot(" movs r0,r0,lsl #4\n");\r |
439 | ot(" orrmi r10,r10,#0x90000000 ;@ Undefined N+V behavior\n"); // this is what Musashi really does\r |
440 | ot(" bicne r10,r10,#0x40000000 ;@ Z flag\n");\r |
6003a768 |
441 | }\r |
442 | else\r |
443 | {\r |
d9d77995 |
444 | ot(" ldr r0,[r7,#0x4c] ;@ Get X bit\n");\r |
445 | ot(" mov r3,#0x00f00000\n");\r |
446 | ot(" and r2,r3,r6,lsr #4\n");\r |
447 | ot(" tst r0,#0x20000000\n");\r |
448 | ot(" and r0,r3,r1,lsr #4\n");\r |
449 | ot(" sub r0,r0,r2\n");\r |
450 | ot(" subne r0,r0,#0x00100000\n");\r |
451 | // ot(" tst r0,#0x00800000\n");\r |
452 | // ot(" orreq r10,r10,#0x01000000 ;@ Undefined V behavior\n");\r |
453 | ot(" cmp r0,#0x00900000\n");\r |
454 | ot(" subhi r0,r0,#0x00600000 ;@ Decimal adjust units\n");\r |
455 | \r |
456 | ot(" mov r2,r1,lsr #28\n");\r |
457 | ot(" add r0,r0,r2,lsl #24\n");\r |
458 | ot(" mov r2,r6,lsr #28\n");\r |
459 | ot(" sub r0,r0,r2,lsl #24\n");\r |
460 | ot(" cmp r0,#0x09900000\n");\r |
461 | ot(" orrhi r10,r10,#0xa0000000 ;@ N and C\n");\r |
462 | ot(" addhi r0,r0,#0x0a000000\n");\r |
463 | // ot(" and r3,r10,r0,lsr #3 ;@ Undefined V behavior part II\n");\r |
464 | // ot(" orr r10,r10,r3,lsl #4 ;@ V\n");\r |
465 | ot(" movs r0,r0,lsl #4\n");\r |
466 | // ot(" orrmi r10,r10,#0x80000000 ;@ Undefined N behavior\n");\r |
467 | ot(" bicne r10,r10,#0x40000000 ;@ Z flag\n");\r |
6003a768 |
468 | }\r |
d9d77995 |
469 | \r |
470 | ot(" str r10,[r7,#0x4c] ;@ Save X bit\n");\r |
471 | ot("\n");\r |
472 | \r |
65044ba9 |
473 | EaWrite(11, 0, dea,0,0x0e00,earwt_shifted_up);\r |
d9d77995 |
474 | \r |
475 | ot(" ldr r6,[r7,#0x54]\n");\r |
476 | OpEnd(sea,dea);\r |
477 | \r |
478 | return 0;\r |
479 | }\r |
480 | \r |
481 | // 01001000 00eeeeee - nbcd <ea>\r |
482 | int OpNbcd(int op)\r |
483 | {\r |
484 | int use=0;\r |
485 | int ea=0;\r |
486 | \r |
487 | ea=op&0x3f;\r |
488 | \r |
489 | if(EaCanWrite(ea)==0||EaAn(ea)) return 1;\r |
490 | \r |
491 | use=OpBase(op,0);\r |
492 | if(op!=use) { OpUse(op,use); return 0; } // Use existing handler\r |
493 | \r |
494 | OpStart(op,ea); Cycles=6;\r |
495 | if(ea >= 8) Cycles+=2;\r |
496 | \r |
65044ba9 |
497 | EaCalcRead(6,0,ea,0,0x003f,earwt_msb_dont_care);\r |
d9d77995 |
498 | \r |
499 | // this is rewrite of Musashi's code\r |
500 | ot(" ldr r2,[r7,#0x4c]\n");\r |
501 | ot(" bic r10,r10,#0xb0000000 ;@ clear all flags, except Z\n");\r |
502 | ot(" mov r0,r0,asl #24\n");\r |
503 | ot(" and r2,r2,#0x20000000\n");\r |
504 | ot(" add r2,r0,r2,lsr #5 ;@ add X\n");\r |
505 | ot(" rsb r11,r2,#0x9a000000 ;@ do arithmetic\n");\r |
506 | \r |
507 | ot(" cmp r11,#0x9a000000\n");\r |
508 | ot(" beq finish%.4x\n",op);\r |
6003a768 |
509 | ot("\n");\r |
510 | \r |
d9d77995 |
511 | ot(" mvn r3,r11,lsr #31 ;@ Undefined V behavior\n",op);\r |
512 | ot(" and r2,r11,#0x0f000000\n");\r |
513 | ot(" cmp r2,#0x0a000000\n");\r |
514 | ot(" andeq r11,r11,#0xf0000000\n");\r |
515 | ot(" addeq r11,r11,#0x10000000\n");\r |
516 | ot(" and r3,r3,r11,lsr #31 ;@ Undefined V behavior part II\n",op);\r |
517 | ot(" movs r1,r11,asr #24\n");\r |
518 | ot(" bicne r10,r10,#0x40000000 ;@ Z\n");\r |
519 | ot(" orr r10,r10,r3,lsl #28 ;@ save V\n",op);\r |
520 | ot(" orr r10,r10,#0x20000000 ;@ C\n");\r |
521 | ot("\n");\r |
522 | \r |
65044ba9 |
523 | EaWrite(6, 1, ea,0,0x3f,earwt_msb_dont_care);\r |
d9d77995 |
524 | \r |
525 | ot("finish%.4x%s\n",op,ms?"":":");\r |
526 | ot(" tst r11,r11\n");\r |
527 | ot(" orrmi r10,r10,#0x80000000 ;@ N\n");\r |
528 | ot(" str r10,[r7,#0x4c] ;@ Save X\n");\r |
529 | ot("\n");\r |
6003a768 |
530 | \r |
d9d77995 |
531 | ot(" ldr r6,[r7,#0x54]\n");\r |
532 | OpEnd(ea);\r |
6003a768 |
533 | \r |
534 | return 0;\r |
535 | }\r |
536 | \r |
537 | // --------------------- Opcodes 0x90c0+ ---------------------\r |
538 | // Suba/Cmpa/Adda 1tt1nnnx 11eeeeee (tt=type, x=size, eeeeee=Source EA)\r |
539 | int OpAritha(int op)\r |
540 | {\r |
541 | int use=0;\r |
542 | int type=0,size=0,sea=0,dea=0;\r |
d9d77995 |
543 | const char *asr="";\r |
6003a768 |
544 | \r |
545 | // Suba/Cmpa/Adda/(invalid):\r |
546 | type=(op>>13)&3; if (type>=3) return 1;\r |
547 | \r |
548 | size=(op>>8)&1; size++;\r |
549 | dea=(op>>9)&7; dea|=8; // Dest=An\r |
550 | sea=op&0x003f; // Source\r |
551 | \r |
552 | // See if we can do this opcode:\r |
553 | if (EaCanRead(sea,size)==0) return 1;\r |
554 | \r |
d9d77995 |
555 | use=OpBase(op,size);\r |
6003a768 |
556 | use&=~0x0e00; // Use same opcode for An\r |
557 | if (op!=use) { OpUse(op,use); return 0; } // Use existing handler\r |
558 | \r |
d9d77995 |
559 | OpStart(op,sea); Cycles=(size==2)?6:8;\r |
560 | if(size==2&&(sea<0x10||sea==0x3c)) Cycles+=2;\r |
561 | if(type==1) Cycles=6;\r |
562 | \r |
563 | // EA calculation order defines how situations like suba.w (A0)+, A0 get handled.\r |
564 | // different emus act differently in this situation, I couldn't fugure which is right behaviour.\r |
565 | //if (type == 1)\r |
566 | {\r |
65044ba9 |
567 | EaCalcRead(-1,0,sea,size,0x003f,earwt_msb_dont_care);\r |
568 | EaCalcRead(type!=1?11:-1,1,dea,2,0x0e00,earwt_msb_dont_care);\r |
d9d77995 |
569 | }\r |
570 | #if 0\r |
571 | else\r |
572 | {\r |
65044ba9 |
573 | EaCalcRead(type!=1?11:-1,1,dea,2,0x0e00,earwt_msb_dont_care);\r |
574 | EaCalcRead(-1,0,sea,size,0x003f,earwt_msb_dont_care);\r |
d9d77995 |
575 | }\r |
576 | #endif\r |
6003a768 |
577 | \r |
d9d77995 |
578 | if (size<2) ot(" mov r0,r0,asl #%d\n\n",size?16:24);\r |
579 | if (size<2) asr=(char *)(size?",asr #16":",asr #24");\r |
6003a768 |
580 | \r |
d9d77995 |
581 | if (type==0) ot(" sub r1,r1,r0%s\n",asr);\r |
582 | if (type==1) ot(" cmp r1,r0%s ;@ Defines NZCV\n",asr);\r |
6003a768 |
583 | if (type==1) OpGetFlags(1,0); // Get Cmp flags\r |
d9d77995 |
584 | if (type==2) ot(" add r1,r1,r0%s\n",asr);\r |
6003a768 |
585 | ot("\n");\r |
6003a768 |
586 | \r |
d9d77995 |
587 | if (type!=1) EaWrite(11, 1, dea,2,0x0e00);\r |
6003a768 |
588 | \r |
d9d77995 |
589 | OpEnd(sea);\r |
6003a768 |
590 | \r |
591 | return 0;\r |
592 | }\r |
593 | \r |
594 | // --------------------- Opcodes 0x9100+ ---------------------\r |
d9d77995 |
595 | // Emit a Subx/Addx opcode, 1t01ddd1 zz00rsss addx.z Ds,Dd\r |
6003a768 |
596 | int OpAddx(int op)\r |
597 | {\r |
598 | int use=0;\r |
d9d77995 |
599 | int type=0,size=0,dea=0,sea=0,mem=0;\r |
600 | const char *asl="";\r |
6003a768 |
601 | \r |
d9d77995 |
602 | type=(op>>14)&1;\r |
6003a768 |
603 | dea =(op>> 9)&7;\r |
604 | size=(op>> 6)&3; if (size>=3) return 1;\r |
d9d77995 |
605 | sea = op&7;\r |
606 | mem =(op>> 3)&1;\r |
6003a768 |
607 | \r |
608 | // See if we can do this opcode:\r |
609 | if (EaCanRead(sea,size)==0) return 1;\r |
610 | if (EaCanWrite(dea)==0) return 1;\r |
611 | \r |
d9d77995 |
612 | if (mem) { sea+=0x20; dea+=0x20; }\r |
613 | \r |
614 | use=op&~0x0e07; // Use same opcode for Dn\r |
615 | if (size==0&&sea==0x27) use|=0x0007; // ___x.b -(a7)\r |
616 | if (size==0&&dea==0x27) use|=0x0e00; // ___x.b -(a7)\r |
6003a768 |
617 | if (op!=use) { OpUse(op,use); return 0; } // Use existing handler\r |
618 | \r |
d9d77995 |
619 | OpStart(op,sea,dea); Cycles=4;\r |
620 | if(size>=2) Cycles+=4;\r |
621 | if(sea>=0x10) Cycles+=2;\r |
6003a768 |
622 | \r |
d9d77995 |
623 | if (mem)\r |
624 | {\r |
625 | ot(";@ Get src/dest EA vals\n");\r |
65044ba9 |
626 | EaCalc (0,0x000f, sea,size,earwt_shifted_up);\r |
627 | EaRead (0, 6, sea,size,0x000f,earwt_shifted_up);\r |
628 | EaCalcRead(11,0,dea,size,0x0e00,earwt_msb_dont_care);\r |
d9d77995 |
629 | }\r |
630 | else\r |
631 | {\r |
632 | ot(";@ Get src/dest reg vals\n");\r |
65044ba9 |
633 | EaCalcRead(-1,6,sea,size,0x0007,earwt_msb_dont_care);\r |
634 | EaCalcRead(11,0,dea,size,0x0e00,earwt_msb_dont_care);\r |
d9d77995 |
635 | if (size<2) ot(" mov r6,r6,asl #%d\n\n",size?16:24);\r |
636 | }\r |
637 | \r |
638 | if (size<2) asl=(char *)(size?",asl #16":",asl #24");\r |
6003a768 |
639 | \r |
640 | ot(";@ Do arithmetic:\n");\r |
d9d77995 |
641 | GetXBit(type==0);\r |
6003a768 |
642 | \r |
d9d77995 |
643 | if (type==1 && size<2)\r |
6003a768 |
644 | {\r |
645 | ot(";@ Make sure the carry bit will tip the balance:\n");\r |
d9d77995 |
646 | ot(" mvn r2,#0\n");\r |
647 | ot(" orr r6,r6,r2,lsr #%i\n",(size==0)?8:16);\r |
6003a768 |
648 | ot("\n");\r |
649 | }\r |
650 | \r |
d9d77995 |
651 | if (type==0) ot(" rscs r1,r6,r0%s\n",asl);\r |
652 | if (type==1) ot(" adcs r1,r6,r0%s\n",asl);\r |
653 | ot(" orr r3,r10,#0xb0000000 ;@ for old Z\n");\r |
654 | OpGetFlags(type==0,1,0); // subtract\r |
655 | if (size<2) {\r |
656 | ot(" movs r2,r1,lsr #%i\n", size?16:24);\r |
657 | ot(" orreq r10,r10,#0x40000000 ;@ add potentially missed Z\n");\r |
658 | }\r |
659 | ot(" andeq r10,r10,r3 ;@ fix Z\n");\r |
6003a768 |
660 | ot("\n");\r |
661 | \r |
662 | ot(";@ Save result:\n");\r |
65044ba9 |
663 | EaWrite(11, 1, dea,size,0x0e00,earwt_shifted_up);\r |
6003a768 |
664 | \r |
d9d77995 |
665 | ot(" ldr r6,[r7,#0x54]\n");\r |
666 | OpEnd(sea,dea);\r |
6003a768 |
667 | \r |
668 | return 0;\r |
669 | }\r |
670 | \r |
671 | // --------------------- Opcodes 0xb000+ ---------------------\r |
672 | // Emit a Cmp/Eor opcode, 1011rrrt xxeeeeee (rrr=Dn, t=cmp/eor, xx=size extension, eeeeee=ea)\r |
673 | int OpCmpEor(int op)\r |
674 | {\r |
675 | int rea=0,eor=0;\r |
676 | int size=0,ea=0,use=0;\r |
d9d77995 |
677 | const char *asl="";\r |
6003a768 |
678 | \r |
679 | // Get EA and register EA\r |
680 | rea=(op>>9)&7;\r |
681 | eor=(op>>8)&1;\r |
682 | size=(op>>6)&3; if (size>=3) return 1;\r |
683 | ea=op&0x3f;\r |
684 | \r |
d9d77995 |
685 | if (eor && (ea>>3) == 1) return 1; // not a valid mode for eor\r |
686 | \r |
6003a768 |
687 | // See if we can do this opcode:\r |
688 | if (EaCanRead(ea,size)==0) return 1;\r |
689 | if (eor && EaCanWrite(ea)==0) return 1;\r |
d9d77995 |
690 | if (EaAn(ea)&&(eor||size==0)) return 1;\r |
6003a768 |
691 | \r |
d9d77995 |
692 | use=OpBase(op,size);\r |
6003a768 |
693 | use&=~0x0e00; // Use 1 handler for register d0-7\r |
694 | if (op!=use) { OpUse(op,use); return 0; } // Use existing handler\r |
695 | \r |
d9d77995 |
696 | OpStart(op,ea); Cycles=4;\r |
697 | if(eor) {\r |
698 | if(ea>8) Cycles+=4;\r |
699 | if(size>=2) Cycles+=4;\r |
700 | } else {\r |
701 | if(size>=2) Cycles+=2;\r |
702 | }\r |
6003a768 |
703 | \r |
d9d77995 |
704 | ot(";@ Get EA into r11 and value into r0:\n");\r |
65044ba9 |
705 | EaCalcRead(eor?11:-1,0,ea,size,0x003f,earwt_msb_dont_care);\r |
6003a768 |
706 | \r |
707 | ot(";@ Get register operand into r1:\n");\r |
65044ba9 |
708 | EaCalcRead(-1,1,rea,size,0x0e00,earwt_msb_dont_care);\r |
d9d77995 |
709 | \r |
710 | if (size<2) ot(" mov r0,r0,asl #%d\n\n",size?16:24);\r |
711 | if (size<2) asl=(char *)(size?",asl #16":",asl #24");\r |
6003a768 |
712 | \r |
713 | ot(";@ Do arithmetic:\n");\r |
6003a768 |
714 | if (eor)\r |
715 | {\r |
3504ce94 |
716 | ot(" eors r1,r0,r1%s\n",asl);\r |
717 | OpGetFlagsNZ(1);\r |
718 | }\r |
719 | else\r |
720 | {\r |
721 | ot(" rsbs r1,r0,r1%s\n",asl);\r |
722 | OpGetFlags(1,0); // Cmp like subtract\r |
6003a768 |
723 | }\r |
6003a768 |
724 | ot("\n");\r |
725 | \r |
65044ba9 |
726 | if (eor) EaWrite(11, 1,ea,size,0x003f,earwt_shifted_up);\r |
d9d77995 |
727 | \r |
728 | OpEnd(ea);\r |
729 | return 0;\r |
730 | }\r |
731 | \r |
732 | // Emit a Cmpm opcode, 1011ddd1 xx001sss (rrr=Adst, xx=size extension, sss=Asrc)\r |
733 | int OpCmpm(int op)\r |
734 | {\r |
735 | int size=0,sea=0,dea=0,use=0;\r |
736 | const char *asl="";\r |
737 | \r |
738 | // get size, get EAs\r |
739 | size=(op>>6)&3; if (size>=3) return 1;\r |
740 | sea=(op&7)|0x18;\r |
741 | dea=(op>>9)&0x3f;\r |
742 | \r |
743 | use=op&~0x0e07; // Use 1 handler for all registers..\r |
744 | if (size==0&&sea==0x1f) use|=0x0007; // ..except (a7)+\r |
745 | if (size==0&&dea==0x1f) use|=0x0e00;\r |
746 | if (op!=use) { OpUse(op,use); return 0; } // Use existing handler\r |
747 | \r |
748 | OpStart(op,sea); Cycles=4;\r |
749 | \r |
750 | ot(";@ Get src operand into r11:\n");\r |
65044ba9 |
751 | EaCalc (0,0x0007, sea,size,earwt_shifted_up);\r |
752 | EaRead (0, 11, sea,size,0x0007,earwt_shifted_up);\r |
d9d77995 |
753 | \r |
754 | ot(";@ Get dst operand into r0:\n");\r |
65044ba9 |
755 | EaCalcRead(-1,0,dea,size,0x0e00,earwt_msb_dont_care);\r |
d9d77995 |
756 | \r |
757 | if (size<2) asl=(char *)(size?",asl #16":",asl #24");\r |
758 | \r |
759 | ot(" rsbs r0,r11,r0%s\n",asl);\r |
760 | OpGetFlags(1,0); // Cmp like subtract\r |
761 | ot("\n");\r |
762 | \r |
763 | OpEnd(sea);\r |
764 | return 0;\r |
765 | }\r |
766 | \r |
767 | \r |
768 | // Emit a Chk opcode, 0100ddd1 x0eeeeee (rrr=Dn, x=size extension, eeeeee=ea)\r |
769 | int OpChk(int op)\r |
770 | {\r |
771 | int rea=0;\r |
772 | int size=0,ea=0,use=0;\r |
773 | \r |
774 | // Get EA and register EA\r |
775 | rea=(op>>9)&7;\r |
776 | if((op>>7)&1)\r |
777 | size=1; // word operation\r |
778 | else size=2; // long\r |
779 | ea=op&0x3f;\r |
780 | \r |
781 | if (EaAn(ea)) return 1; // not a valid mode\r |
782 | if (size!=1) return 1; // 000 variant only supports word\r |
783 | \r |
784 | // See if we can do this opcode:\r |
785 | if (EaCanRead(ea,size)==0) return 1;\r |
786 | \r |
787 | use=OpBase(op,size);\r |
788 | use&=~0x0e00; // Use 1 handler for register d0-7\r |
789 | if (op!=use) { OpUse(op,use); return 0; } // Use existing handler\r |
790 | \r |
791 | OpStart(op,ea); Cycles=10;\r |
792 | \r |
793 | ot(";@ Get value into r0:\n");\r |
65044ba9 |
794 | EaCalcRead(-1,0,ea,size,0x003f,earwt_msb_dont_care);\r |
d9d77995 |
795 | \r |
796 | ot(";@ Get register operand into r1:\n");\r |
65044ba9 |
797 | EaCalcRead(-1,1,rea,size,0x0e00,earwt_msb_dont_care);\r |
d9d77995 |
798 | \r |
799 | if (size<2) ot(" mov r0,r0,asl #%d\n",size?16:24);\r |
3504ce94 |
800 | \r |
801 | if (size<2) ot(" movs r1,r1,asl #%d\n\n",size?16:24);\r |
802 | else ot(" adds r1,r1,#0 ;@ Define flags\n");\r |
d9d77995 |
803 | \r |
804 | ot(";@ get flags, including undocumented ones\n");\r |
805 | ot(" and r3,r10,#0x80000000\n");\r |
3504ce94 |
806 | OpGetFlagsNZ(1);\r |
d9d77995 |
807 | \r |
808 | ot(";@ is reg negative?\n");\r |
809 | ot(" bmi chktrap%.4x\n",op);\r |
810 | \r |
811 | ot(";@ Do arithmetic:\n");\r |
d9d77995 |
812 | ot(" cmp r1,r0\n");\r |
813 | ot(" bgt chktrap%.4x\n",op);\r |
814 | \r |
815 | ot(";@ old N remains\n");\r |
816 | ot(" orr r10,r10,r3\n");\r |
817 | OpEnd(ea);\r |
6003a768 |
818 | \r |
d9d77995 |
819 | ot("chktrap%.4x%s ;@ CHK exception:\n",op,ms?"":":");\r |
820 | ot(" mov r0,#6\n");\r |
821 | ot(" bl Exception\n");\r |
822 | Cycles+=40;\r |
823 | OpEnd(ea);\r |
6003a768 |
824 | \r |
6003a768 |
825 | return 0;\r |
826 | }\r |
827 | \r |