Previous 15994 Revisions Next

r7033 Wednesday 13th January, 2010 at 23:23:53 UTC by Harmony
[UNSP] Considerable code cleanup in the u'nSP CPU core. [Harmony]
[src/emu/cpu/unsp]unsp.c

src/emu/cpu/unsp/unsp.c
r7032r7033
3030#define OPB      (op & 7)
3131#define OPIMM   (op & 0x3f)
3232#define OP2X   ((OP0 < 14 && OP1 == 4 && (OPN >= 1 && OPN <= 3)) || (OP0 == 15 && (OP1 == 1 || OP1 == 2)))
33
34#define UNSP_LPC         (((UNSP_REG(SR) & 0x3f) << 16) | UNSP_REG(PC))
35
3336#define UNSP_REG(reg)      unsp->r[UNSP_##reg - 1]
3437#define UNSP_REG_I(reg)      unsp->r[reg]
3538#define UNSP_LREG_I(reg)   (((UNSP_REG(SR) << 6) & 0x3f0000) | UNSP_REG_I(reg))
36#define UNSP_LPC         (((UNSP_REG(SR) & 0x3f) << 16) | UNSP_REG(PC))
3739
40#define UNSP_N   0x0200
41#define UNSP_Z   0x0100
42#define UNSP_S   0x0080
43#define UNSP_C   0x0040
44
45#define STANDARD_ALU_CASES \
46      case 0: \
47         lres = r0 + r1; \
48         unsp_update_nzsc(unsp, lres, r0, r1); \
49         break; \
50      case 1: \
51         lres = r0 + r1; \
52         if(UNSP_REG(SR) & UNSP_C) lres++; \
53         unsp_update_nzsc(unsp, lres, r0, r1); \
54         break; \
55      case 3: \
56         lres = r0 + (~r1 & 0x0000ffff); \
57         if(UNSP_REG(SR) & UNSP_C) lres++; \
58         unsp_update_nzsc(unsp, lres, r0, r1); \
59         break; \
60      case 2: \
61      case 4: \
62         lres = r0 + (~r1 & 0x0000ffff) + 1; \
63         unsp_update_nzsc(unsp, lres, r0, r1); \
64         break; \
65      case 6: \
66         lres = -r1; \
67         unsp_update_nz(unsp, lres); \
68         break; \
69      case 8: \
70         lres = r0 ^ r1; \
71         unsp_update_nz(unsp, lres); \
72         break; \
73      case 9: \
74         lres = r1; \
75         unsp_update_nz(unsp, lres); \
76         break; \
77      case 10: \
78         lres = r0 | r1; \
79         unsp_update_nz(unsp, lres); \
80         break; \
81      case 11: \
82      case 12: \
83         lres = r0 & r1; \
84         unsp_update_nz(unsp, lres); \
85         break
86
3887/*****************************************************************************/
3988
4089static void unimplemented_opcode(unsp_state *unsp, UINT16 op)
r7032r7033
67116    unsp->fiq = 0;
68117}
69118
70static CPU_EXIT( unsp )
71{
72}
73
74119static CPU_RESET( unsp )
75120{
76121    unsp_state *unsp = get_safe_token(device);
r7032r7033
83128
84129static void unsp_update_nz(unsp_state *unsp, UINT32 value)
85130{
86   UNSP_REG(SR) &= ~0x0300;
131   UNSP_REG(SR) &= ~(UNSP_N | UNSP_Z);
87132   if(value & 0x8000)
88133   {
89      UNSP_REG(SR) |= 0x0200;
134      UNSP_REG(SR) |= UNSP_N;
90135   }
91136   if((UINT16)value == 0)
92137   {
93      UNSP_REG(SR) |= 0x0100;
138      UNSP_REG(SR) |= UNSP_Z;
94139   }
95140}
96141
97142static void unsp_update_nzsc(unsp_state *unsp, UINT32 value, UINT16 r0, UINT16 r1)
98143{
99   UNSP_REG(SR) &= ~0x00c0;
144   UNSP_REG(SR) &= ~(UNSP_C | UNSP_S);
100145   unsp_update_nz(unsp, value);
101146   if(value != (UINT16)value)
102147   {
103      UNSP_REG(SR) |= 0x0040;
148      UNSP_REG(SR) |= UNSP_C;
104149   }
105150
106151   if((INT16)r0 < (INT16)r1)
107152   {
108      UNSP_REG(SR) |= 0x0080;
153      UNSP_REG(SR) |= UNSP_S;
109154   }
110155}
111156
r7032r7033
131176
132177    while (unsp->icount > 0)
133178    {
134      int jumped = 0;
135179        debugger_instruction_hook(device, UNSP_LPC<<1);
136180
137181        op = READ16(unsp, UNSP_LPC);
138182
183      UNSP_REG(PC)++;
184
139185      if(OP0 < 0xf && OPA == 0x7 && OP1 < 2)
140186      {
141         //print("%s %04x", jmp[OP0], OP1 ? (pc - OPIMM*2) : (pc + OPIMM*2));
142187         switch(OP0)
143188         {
144189            case 0: // JB
145               if(!(UNSP_REG(SR) & 0x0040))
190               if(!(UNSP_REG(SR) & UNSP_C))
146191               {
147                  UNSP_REG(PC)++;
148192                  UNSP_REG(PC) += (OP1 == 0) ? OPIMM : (0 - OPIMM);
149                  jumped = 1;
150193               }
151194               break;
152195            case 1: // JAE
153               if(UNSP_REG(SR) & 0x0040)
196               if(UNSP_REG(SR) & UNSP_C)
154197               {
155                  UNSP_REG(PC)++;
156198                  UNSP_REG(PC) += (OP1 == 0) ? OPIMM : (0 - OPIMM);
157                  jumped = 1;
158199               }
159200               break;
160201            case 2: // JGE
161               if(!(UNSP_REG(SR) & 0x0080))
202               if(!(UNSP_REG(SR) & UNSP_S))
162203               {
163                  UNSP_REG(PC)++;
164204                  UNSP_REG(PC) += (OP1 == 0) ? OPIMM : (0 - OPIMM);
165                  jumped = 1;
166205               }
167206               break;
168207            case 3: // JL
169               if(UNSP_REG(SR) & 0x0080)
208               if(UNSP_REG(SR) & UNSP_S)
170209               {
171                  UNSP_REG(PC)++;
172210                  UNSP_REG(PC) += (OP1 == 0) ? OPIMM : (0 - OPIMM);
173                  jumped = 1;
174211               }
175212               break;
176213            case 4: // JNE
177               if(!(UNSP_REG(SR) & 0x0100))
214               if(!(UNSP_REG(SR) & UNSP_Z))
178215               {
179                  UNSP_REG(PC)++;
180216                  UNSP_REG(PC) += (OP1 == 0) ? OPIMM : (0 - OPIMM);
181                  jumped = 1;
182217               }
183218               break;
184219            case 5: // JE
185               if(UNSP_REG(SR) & 0x0100)
220               if(UNSP_REG(SR) & UNSP_Z)
186221               {
187                  UNSP_REG(PC)++;
188222                  UNSP_REG(PC) += (OP1 == 0) ? OPIMM : (0 - OPIMM);
189                  jumped = 1;
190223               }
191224               break;
192225            case 6: // JPL
193               if(!(UNSP_REG(SR) & 0x0200))
226               if(!(UNSP_REG(SR) & UNSP_N))
194227               {
195                  UNSP_REG(PC)++;
196228                  UNSP_REG(PC) += (OP1 == 0) ? OPIMM : (0 - OPIMM);
197                  jumped = 1;
198229               }
199230               break;
200231            case 7: // JMI
201               if(UNSP_REG(SR) & 0x0200)
232               if(UNSP_REG(SR) & UNSP_N)
202233               {
203                  UNSP_REG(PC)++;
204234                  UNSP_REG(PC) += (OP1 == 0) ? OPIMM : (0 - OPIMM);
205                  jumped = 1;
206235               }
207236               break;
208237            case 8: // JBE
209               if((UNSP_REG(SR) & 0x0140) != 0x0040)
238               if((UNSP_REG(SR) & (UNSP_Z | UNSP_C)) != UNSP_C)
210239               {
211                  UNSP_REG(PC)++;
212240                  UNSP_REG(PC) += (OP1 == 0) ? OPIMM : (0 - OPIMM);
213                  jumped = 1;
214241               }
215242               break;
216243            case 9: // JA
217               if((UNSP_REG(SR) & 0x0140) == 0x0040)
244               if((UNSP_REG(SR) & (UNSP_Z | UNSP_C)) == UNSP_C)
218245               {
219                  UNSP_REG(PC)++;
220246                  UNSP_REG(PC) += (OP1 == 0) ? OPIMM : (0 - OPIMM);
221                  jumped = 1;
222247               }
223248               break;
224249            case 10: // JLE
225               if(UNSP_REG(SR) & 0x0180)
250               if(UNSP_REG(SR) & (UNSP_Z | UNSP_S))
226251               {
227                  UNSP_REG(PC)++;
228252                  UNSP_REG(PC) += (OP1 == 0) ? OPIMM : (0 - OPIMM);
229                  jumped = 1;
230253               }
231254               break;
232255            case 11: // JG
233               if(!(UNSP_REG(SR) & 0x0180))
256               if(!(UNSP_REG(SR) & (UNSP_Z | UNSP_S)))
234257               {
235                  UNSP_REG(PC)++;
236258                  UNSP_REG(PC) += (OP1 == 0) ? OPIMM : (0 - OPIMM);
237                  jumped = 1;
238259               }
239260               break;
240261            case 14: // JMP
241               UNSP_REG(PC)++;
242262               UNSP_REG(PC) += (OP1 == 0) ? OPIMM : (0 - OPIMM);
243               jumped = 1;
244263               break;
245264         }
246265      }
r7032r7033
248267      {
249268         switch((OP1 << 4) | OP0)
250269         {
251            // ALU, Indexed
270            // r, [bp+imm6]
252271            case 0x00: case 0x01: case 0x02: case 0x03: case 0x04: case 0x06: case 0x08: case 0x09: case 0x0a: case 0x0b: case 0x0c: case 0x0d:
272               r0 = UNSP_REG_I(OPA);
273               r1 = READ16(unsp, UNSP_REG(BP) + OPIMM);
253274               switch(OP0)
254275               {
255                  case 0: // add r, [bp+imm6]
256                     r0 = UNSP_REG_I(OPA);
257                     r1 = READ16(unsp, UNSP_REG(BP) + OPIMM);
258                     lres = r0 + r1;
259                     unsp_update_nzsc(unsp, lres, r0, r1);
260                     UNSP_REG_I(OPA) = (UINT16)lres;
261                     if(OPA == (UNSP_PC-1)) jumped = 1;
262                     break;
263                  case 1: // adc r, [bp+imm6]
264                     r0 = UNSP_REG_I(OPA);
265                     r1 = READ16(unsp, UNSP_REG(BP) + OPIMM);
266                     lres = r0 + r1;
267                     if(UNSP_REG(SR) & 0x0040) lres++;
268                     unsp_update_nzsc(unsp, lres, r0, r1);
269                     UNSP_REG_I(OPA) = (UINT16)lres;
270                     if(OPA == (UNSP_PC-1)) jumped = 1;
271                     break;
272                  case 2: // sub r, [bp+imm6]
273                     r0 = UNSP_REG_I(OPA);
274                     r1 = READ16(unsp, UNSP_REG(BP) + OPIMM);
275                     lres = r0 + (~r1 & 0x0000ffff) + 1;
276                     unsp_update_nzsc(unsp, lres, r0, r1);
277                     UNSP_REG_I(OPA) = (UINT16)lres;
278                     if(OPA == (UNSP_PC-1)) jumped = 1;
279                     break;
280                  case 3: // sbc r, [bp+imm6]
281                     r0 = UNSP_REG_I(OPA);
282                     r1 = READ16(unsp, UNSP_REG(BP) + OPIMM);
283                     lres = r0 + (~r1 & 0x0000ffff);
284                     if(UNSP_REG(SR) & 0x0040) lres++;
285                     unsp_update_nzsc(unsp, lres, r0, r1);
286                     UNSP_REG_I(OPA) = (UINT16)lres;
287                     if(OPA == (UNSP_PC-1)) jumped = 1;
288                     break;
289                  case 4: // cmp r, [bp+imm6]
290                     r0 = UNSP_REG_I(OPA);
291                     r1 = READ16(unsp, UNSP_REG(BP) + OPIMM);
292                     lres = r0 + (~r1 & 0x0000ffff) + 1;
293                     unsp_update_nzsc(unsp, lres, r0, r1);
294                     break;
295                  case 6: // neg r, [bp+imm6]
296                     r0 = UNSP_REG_I(OPA);
297                     r1 = READ16(unsp, UNSP_REG(BP) + OPIMM);
298                     lres = -r1;
299                     unsp_update_nz(unsp, lres);
300                     UNSP_REG_I(OPA) = (UINT16)lres;
301                     if(OPA == (UNSP_PC-1)) jumped = 1;
302                     break;
303                  case 8: // xor r, [bp+imm6]
304                     r0 = UNSP_REG_I(OPA);
305                     r1 = READ16(unsp, UNSP_REG(BP) + OPIMM);
306                     lres = r0 ^ r1;
307                     unsp_update_nz(unsp, lres);
308                     UNSP_REG_I(OPA) = (UINT16)lres;
309                     if(OPA == (UNSP_PC-1)) jumped = 1;
310                     break;
311                  case 9: // load r, [bp+imm6]
312                     lres = READ16(unsp, UNSP_REG(BP) + OPIMM);
313                     unsp_update_nz(unsp, lres);
314                     UNSP_REG_I(OPA) = (UINT16)lres;
315                     if(OPA == (UNSP_PC-1)) jumped = 1;
316                     break;
317                  case 10: // or r, [bp+imm6]
318                     r0 = UNSP_REG_I(OPA);
319                     r1 = READ16(unsp, UNSP_REG(BP) + OPIMM);
320                     lres = r0 | r1;
321                     unsp_update_nz(unsp, lres);
322                     UNSP_REG_I(OPA) = (UINT16)lres;
323                     if(OPA == (UNSP_PC-1)) jumped = 1;
324                     break;
325                  case 11: // and r, [bp+imm6]
326                     r0 = UNSP_REG_I(OPA);
327                     r1 = READ16(unsp, UNSP_REG(BP) + OPIMM);
328                     lres = r0 & r1;
329                     unsp_update_nz(unsp, lres);
330                     UNSP_REG_I(OPA) = (UINT16)lres;
331                     if(OPA == (UNSP_PC-1)) jumped = 1;
332                     break;
276                  STANDARD_ALU_CASES;
333277                  case 13: // store r, [bp+imm6]
334278                     WRITE16(unsp, UNSP_REG(BP) + OPIMM, UNSP_REG_I(OPA));
335279                     break;
r7032r7033
337281                     unimplemented_opcode(unsp, op);
338282                     break;
339283               }
284               if(OP0 != 4 && OP0 < 12)
285               {
286                  UNSP_REG_I(OPA) = (UINT16)lres;
287               }
340288               break;
341289
342            // ALU, Immediate
290            // r, imm6
343291            case 0x10: case 0x11: case 0x12: case 0x13: case 0x14: case 0x16: case 0x18: case 0x19: case 0x1a: case 0x1b: case 0x1c:
292               r0 = UNSP_REG_I(OPA);
293               r1 = OPIMM;
344294               switch(OP0)
345295               {
346                  case 0: // add r, imm6
347                     r0 = UNSP_REG_I(OPA);
348                     r1 = OPIMM;
349                     lres = r0 + r1;
350                     unsp_update_nzsc(unsp, lres, r0, r1);
351                     UNSP_REG_I(OPA) = (UINT16)lres;
352                     if(OPA == (UNSP_PC-1)) jumped = 1;
353                     break;
354                  case 1: // adc r, imm6
355                     r0 = UNSP_REG_I(OPA);
356                     r1 = OPIMM;
357                     lres = r0 + r1;
358                     if(UNSP_REG(SR) & 0x0040) lres++;
359                     unsp_update_nzsc(unsp, lres, r0, r1);
360                     UNSP_REG_I(OPA) = (UINT16)lres;
361                     if(OPA == (UNSP_PC-1)) jumped = 1;
362                     break;
363                  case 2: // sub r, imm6
364                     r0 = UNSP_REG_I(OPA);
365                     r1 = OPIMM;
366                     lres = r0 + (~r1 & 0x0000ffff) + 1;
367                     unsp_update_nzsc(unsp, lres, r0, r1);
368                     UNSP_REG_I(OPA) = (UINT16)lres;
369                     if(OPA == (UNSP_PC-1)) jumped = 1;
370                     break;
371                  case 4: // cmp r, imm6
372                     r0 = UNSP_REG_I(OPA);
373                     r1 = OPIMM;
374                     lres = r0 + (~r1 & 0x0000ffff) + 1;
375                     unsp_update_nzsc(unsp, lres, r0, r1);
376                     break;
377                  case 6: // neg r, imm6
378                     r0 = UNSP_REG_I(OPA);
379                     r1 = OPIMM;
380                     lres = -r1;
381                     unsp_update_nz(unsp, lres);
382                     UNSP_REG_I(OPA) = (UINT16)lres;
383                     if(OPA == (UNSP_PC-1)) jumped = 1;
384                     break;
385                  case 8: // xor r, imm6
386                     r0 = UNSP_REG_I(OPA);
387                     r1 = OPIMM;
388                     lres = r0 ^ r1;
389                     unsp_update_nz(unsp, lres);
390                     UNSP_REG_I(OPA) = (UINT16)lres;
391                     if(OPA == (UNSP_PC-1)) jumped = 1;
392                     break;
393                  case 9: // load r, imm6
394                     lres = OPIMM;
395                     unsp_update_nz(unsp, lres);
396                     UNSP_REG_I(OPA) = (UINT16)lres;
397                     if(OPA == (UNSP_PC-1)) jumped = 1;
398                     break;
399                  case 10: // or r, imm6
400                     r0 = UNSP_REG_I(OPA);
401                     r1 = OPIMM;
402                     lres = r0 | r1;
403                     unsp_update_nz(unsp, lres);
404                     UNSP_REG_I(OPA) = (UINT16)lres;
405                     if(OPA == (UNSP_PC-1)) jumped = 1;
406                     break;
407                  case 11: // and r, imm6
408                     r0 = UNSP_REG_I(OPA);
409                     r1 = OPIMM;
410                     lres = r0 & r1;
411                     unsp_update_nz(unsp, lres);
412                     UNSP_REG_I(OPA) = (UINT16)lres;
413                     if(OPA == (UNSP_PC-1)) jumped = 1;
414                     break;
415                  case 12: // test r, imm6
416                     r0 = UNSP_REG_I(OPA);
417                     r1 = OPIMM;
418                     lres = r0 & r1;
419                     unsp_update_nz(unsp, lres);
420                     break;
296                  STANDARD_ALU_CASES;
421297                  default:
422298                     unimplemented_opcode(unsp, op);
423299                     break;
424300               }
301               if(OP0 != 4 && OP0 < 12)
302               {
303                  UNSP_REG_I(OPA) = (UINT16)lres;
304               }
425305               break;
426306
427307            // Pop / Interrupt return
r7032r7033
430310               {
431311                  UNSP_REG(SR) = unsp_pop(unsp, &UNSP_REG(SP));
432312                  UNSP_REG(PC) = unsp_pop(unsp, &UNSP_REG(SP));
433                  jumped = 1;
434313                  break;
435314               }
436315               else if(op == 0x9a98) // reti
r7032r7033
438317                  int i;
439318                  UNSP_REG(SR) = unsp_pop(unsp, &UNSP_REG(SP));
440319                  UNSP_REG(PC) = unsp_pop(unsp, &UNSP_REG(SP));
441                  jumped = 1;
442320                  if(unsp->fiq & 2)
443321                  {
444322                     unsp->fiq &= 1;
r7032r7033
472350                  while(r0--)
473351                  {
474352                     UNSP_REG_I(++r1) = unsp_pop(unsp, &UNSP_REG_I(OPB));
475                     if(r1 == (UNSP_PC-1)) jumped = 1;
476353                  }
477354               }
478355               break;
r7032r7033
491368            case 0x30: case 0x31: case 0x32: case 0x33: case 0x34: case 0x36: case 0x38: case 0x39: case 0x3a: case 0x3b: case 0x3c: case 0x3d:
492369               switch(OPN & 3)
493370               {
494                  case 0:
371                  case 0: // r, [r]
372                     r0 = UNSP_REG_I(OPA);
373                     r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
495374                     switch(OP0)
496375                     {
497                        case 0: // add r, [r]
498                           r0 = UNSP_REG_I(OPA);
499                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
500                           lres = r0 + r1;
501                           unsp_update_nzsc(unsp, lres, r0, r1);
502                           UNSP_REG_I(OPA) = (UINT16)lres;
503                           if(OPA == (UNSP_PC-1)) jumped = 1;
504                           break;
505                        case 1: // adc r, [r]
506                           r0 = UNSP_REG_I(OPA);
507                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
508                           lres = r0 + r1;
509                           if(UNSP_REG(SR) & 0x0040) lres++;
510                           unsp_update_nzsc(unsp, lres, r0, r1);
511                           UNSP_REG_I(OPA) = (UINT16)lres;
512                           if(OPA == (UNSP_PC-1)) jumped = 1;
513                           break;
514                        case 2: // sub r, [r]
515                           r0 = UNSP_REG_I(OPA);
516                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
517                           lres = r0 + (~r1 & 0x0000ffff) + 1;
518                           unsp_update_nzsc(unsp, lres, r0, r1);
519                           UNSP_REG_I(OPA) = (UINT16)lres;
520                           if(OPA == (UNSP_PC-1)) jumped = 1;
521                           break;
522                        case 3: // sbc r, [r]
523                           r0 = UNSP_REG_I(OPA);
524                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
525                           lres = r0 + (~r1 & 0x0000ffff);
526                           if(UNSP_REG(SR) & 0x0040) lres++;
527                           unsp_update_nzsc(unsp, lres, r0, r1);
528                           UNSP_REG_I(OPA) = (UINT16)lres;
529                           if(OPA == (UNSP_PC-1)) jumped = 1;
530                           break;
531                        case 4: // cmp r, [r]
532                           r0 = UNSP_REG_I(OPA);
533                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
534                           lres = r0 + (~r1 & 0x0000ffff) + 1;
535                           unsp_update_nzsc(unsp, lres, r0, r1);
536                           break;
537                        case 6: // neg r, [r]
538                           r0 = UNSP_REG_I(OPA);
539                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
540                           lres = -r1;
541                           unsp_update_nz(unsp, lres);
542                           UNSP_REG_I(OPA) = (UINT16)lres;
543                           if(OPA == (UNSP_PC-1)) jumped = 1;
544                           break;
545                        case 9: // load r, [r]
546                           lres = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
547                           unsp_update_nz(unsp, lres);
548                           UNSP_REG_I(OPA) = (UINT16)lres;
549                           if(OPA == (UNSP_PC-1)) jumped = 1;
550                           break;
551                        case 10: // or r, [r]
552                           r0 = UNSP_REG_I(OPA);
553                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
554                           lres = r0 | r1;
555                           unsp_update_nz(unsp, lres);
556                           UNSP_REG_I(OPA) = (UINT16)lres;
557                           if(OPA == (UNSP_PC-1)) jumped = 1;
558                           break;
559                        case 11: // and r, [r]
560                           r0 = UNSP_REG_I(OPA);
561                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
562                           lres = r0 & r1;
563                           unsp_update_nz(unsp, lres);
564                           UNSP_REG_I(OPA) = (UINT16)lres;
565                           if(OPA == (UNSP_PC-1)) jumped = 1;
566                           break;
376                        STANDARD_ALU_CASES;
567377                        case 13: // store r, [r]
568378                           WRITE16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB), UNSP_REG_I(OPA));
569379                           break;
r7032r7033
571381                           unimplemented_opcode(unsp, op);
572382                           break;
573383                     }
384                     if(OP0 != 4 && OP0 < 12)
385                     {
386                        UNSP_REG_I(OPA) = (UINT16)lres;
387                     }
574388                     break;
575                  case 1:
576                     //print("%s %s, [%s%s--]", alu[OP0], reg[OPA], (OPN & 4) ? "ds:" : "", reg[OPB]);
389                  case 1: // r, [<ds:>r--]
390                     r0 = UNSP_REG_I(OPA);
391                     r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
577392                     switch(OP0)
578393                     {
579                        case 0: // add r, [<ds:>r--]
580                           r0 = UNSP_REG_I(OPA);
581                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
582                           lres = r0 + r1;
583                           unsp_update_nzsc(unsp, lres, r0, r1);
584                           UNSP_REG_I(OPB)--;
585                           UNSP_REG_I(OPA) = (UINT16)lres;
586                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
587                           break;
588                        case 1: // adc r, [<ds:>r--]
589                           r0 = UNSP_REG_I(OPA);
590                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
591                           lres = r0 + r1;
592                           if(UNSP_REG(SR) & 0x0040) lres++;
593                           unsp_update_nzsc(unsp, lres, r0, r1);
594                           UNSP_REG_I(OPB)--;
595                           UNSP_REG_I(OPA) = (UINT16)lres;
596                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
597                           break;
598                        case 2: // sub r, [<ds:>r--]
599                           r0 = UNSP_REG_I(OPA);
600                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
601                           lres = r0 + (~r1 & 0x0000ffff) + 1;
602                           unsp_update_nzsc(unsp, lres, r0, r1);
603                           UNSP_REG_I(OPB)--;
604                           UNSP_REG_I(OPA) = (UINT16)lres;
605                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
606                           break;
607                        case 3: // sbc r, [<ds:>r--]
608                           r0 = UNSP_REG_I(OPA);
609                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
610                           lres = r0 + (~r1 & 0x0000ffff);
611                           if(UNSP_REG(SR) & 0x0040) lres++;
612                           unsp_update_nzsc(unsp, lres, r0, r1);
613                           UNSP_REG_I(OPB)--;
614                           UNSP_REG_I(OPA) = (UINT16)lres;
615                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
616                           break;
617                        case 4: // cmp r, [<ds:>r--]
618                           r0 = UNSP_REG_I(OPA);
619                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
620                           lres = r0 + (~r1 & 0x0000ffff) + 1;
621                           unsp_update_nzsc(unsp, lres, r0, r1);
622                           UNSP_REG_I(OPB)--;
623                           if(OPB == (UNSP_PC-1)) jumped = 1;
624                           break;
625                        case 6: // neg r, [<ds:>r--]
626                           r0 = UNSP_REG_I(OPA);
627                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
628                           lres = -r1;
629                           unsp_update_nz(unsp, lres);
630                           UNSP_REG_I(OPB)--;
631                           UNSP_REG_I(OPA) = (UINT16)lres;
632                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
633                           break;
634                        case 8: // xor r, [<ds:>r--]
635                           r0 = UNSP_REG_I(OPA);
636                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
637                           lres = r0 ^ r1;
638                           unsp_update_nz(unsp, lres);
639                           UNSP_REG_I(OPB)--;
640                           UNSP_REG_I(OPA) = (UINT16)lres;
641                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
642                           break;
643                        case 9: // load r, [<ds:>r--]
644                           lres = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
645                           unsp_update_nz(unsp, lres);
646                           UNSP_REG_I(OPB)--;
647                           UNSP_REG_I(OPA) = (UINT16)lres;
648                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
649                           break;
650                        case 10: // or r, [<ds:>r--]
651                           r0 = UNSP_REG_I(OPA);
652                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
653                           lres = r0 | r1;
654                           unsp_update_nz(unsp, lres);
655                           UNSP_REG_I(OPB)--;
656                           UNSP_REG_I(OPA) = (UINT16)lres;
657                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
658                           break;
659                        case 11: // and r, [<ds:>r--]
660                           r0 = UNSP_REG_I(OPA);
661                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
662                           lres = r0 & r1;
663                           unsp_update_nz(unsp, lres);
664                           UNSP_REG_I(OPB)--;
665                           UNSP_REG_I(OPA) = (UINT16)lres;
666                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
667                           break;
668                        case 12: // test r, [<ds:>r--]
669                           r0 = UNSP_REG_I(OPA);
670                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
671                           lres = r0 & r1;
672                           unsp_update_nz(unsp, lres);
673                           UNSP_REG_I(OPB)--;
674                           if(OPB == (UNSP_PC-1)) jumped = 1;
675                           break;
394                        STANDARD_ALU_CASES;
676395                        case 13: // store r, [<ds:>r--]
677396                           WRITE16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB), UNSP_REG_I(OPA));
678                           UNSP_REG_I(OPB)--;
679                           if(OPB == (UNSP_PC-1)) jumped = 1;
680397                           break;
681398                        default:
682399                           unimplemented_opcode(unsp, op);
683400                           break;
684401                     }
402                     UNSP_REG_I(OPB)--;
403                     if(OP0 != 4 && OP0 < 12)
404                     {
405                        UNSP_REG_I(OPA) = (UINT16)lres;
406                     }
685407                     break;
686                  case 2:
408                  case 2: // r, [<ds:>r++]
409                     r0 = UNSP_REG_I(OPA);
410                     r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
687411                     switch(OP0)
688412                     {
689                        case 0: // add r, [<ds:>r++]
690                           r0 = UNSP_REG_I(OPA);
691                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
692                           lres = r0 + r1;
693                           unsp_update_nzsc(unsp, lres, r0, r1);
694                           UNSP_REG_I(OPB)++;
695                           UNSP_REG_I(OPA) = (UINT16)lres;
696                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
697                           break;
698                        case 1: // adc r, [<ds:>r++]
699                           r0 = UNSP_REG_I(OPA);
700                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
701                           lres = r0 + r1;
702                           if(UNSP_REG(SR) & 0x0040) lres++;
703                           unsp_update_nzsc(unsp, lres, r0, r1);
704                           UNSP_REG_I(OPB)++;
705                           UNSP_REG_I(OPA) = (UINT16)lres;
706                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
707                           break;
708                        case 2: // sub r, [<ds:>r++]
709                           r0 = UNSP_REG_I(OPA);
710                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
711                           lres = r0 + (~r1 & 0x0000ffff) + 1;
712                           unsp_update_nzsc(unsp, lres, r0, r1);
713                           UNSP_REG_I(OPB)++;
714                           UNSP_REG_I(OPA) = (UINT16)lres;
715                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
716                           break;
717                        case 3: // sbc r, [<ds:>r++]
718                           r0 = UNSP_REG_I(OPA);
719                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
720                           lres = r0 + (~r1 & 0x0000ffff);
721                           if(UNSP_REG(SR) & 0x0040) lres++;
722                           unsp_update_nzsc(unsp, lres, r0, r1);
723                           UNSP_REG_I(OPB)++;
724                           UNSP_REG_I(OPA) = (UINT16)lres;
725                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
726                           break;
727                        case 4: // cmp r, [<ds:>r++]
728                           r0 = UNSP_REG_I(OPA);
729                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
730                           lres = r0 + (~r1 & 0x0000ffff) + 1;
731                           unsp_update_nzsc(unsp, lres, r0, r1);
732                           UNSP_REG_I(OPB)++;
733                           if(OPB == (UNSP_PC-1)) jumped = 1;
734                           break;
735                        case 6: // neg r, [<ds:>r++]
736                           r0 = UNSP_REG_I(OPA);
737                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
738                           lres = -r1;
739                           unsp_update_nz(unsp, lres);
740                           UNSP_REG_I(OPB)++;
741                           UNSP_REG_I(OPA) = (UINT16)lres;
742                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
743                           break;
744                        case 8: // xor r, [<ds:>r++]
745                           r0 = UNSP_REG_I(OPA);
746                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
747                           lres = r0 ^ r1;
748                           unsp_update_nz(unsp, lres);
749                           UNSP_REG_I(OPB)++;
750                           UNSP_REG_I(OPA) = (UINT16)lres;
751                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
752                           break;
753                        case 9: // load r, [<ds:>r++]
754                           lres = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
755                           unsp_update_nz(unsp, lres);
756                           UNSP_REG_I(OPA) = (UINT16)lres;
757                           UNSP_REG_I(OPB)++;
758                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
759                           break;
760                        case 10: // or r, [<ds:>r++]
761                           r0 = UNSP_REG_I(OPA);
762                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
763                           lres = r0 | r1;
764                           unsp_update_nz(unsp, lres);
765                           UNSP_REG_I(OPB)++;
766                           UNSP_REG_I(OPA) = (UINT16)lres;
767                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
768                           break;
769                        case 11: // and r, [<ds:>r++]
770                           r0 = UNSP_REG_I(OPA);
771                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
772                           lres = r0 & r1;
773                           unsp_update_nz(unsp, lres);
774                           UNSP_REG_I(OPB)++;
775                           UNSP_REG_I(OPA) = (UINT16)lres;
776                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
777                           break;
778                        case 12: // test r, [<ds:>r++]
779                           r0 = UNSP_REG_I(OPA);
780                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
781                           lres = r0 & r1;
782                           unsp_update_nz(unsp, lres);
783                           UNSP_REG_I(OPB)++;
784                           if(OPB == (UNSP_PC-1)) jumped = 1;
785                           break;
413                        STANDARD_ALU_CASES;
786414                        case 13: // store r, [<ds:>r++]
787415                           WRITE16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB), UNSP_REG_I(OPA));
788                           UNSP_REG_I(OPB)++;
789                           if(OPB == (UNSP_PC-1)) jumped = 1;
790416                           break;
791417                        default:
792418                           unimplemented_opcode(unsp, op);
793419                           break;
794420                     }
421                     UNSP_REG_I(OPB)++;
422                     if(OP0 != 4 && OP0 < 12)
423                     {
424                        UNSP_REG_I(OPA) = (UINT16)lres;
425                     }
795426                     break;
796                  case 3:
427                  case 3: // r, [<ds:>++r]
428                     UNSP_REG_I(OPB)++;
429                     r0 = UNSP_REG_I(OPA);
430                     r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
797431                     switch(OP0)
798432                     {
799                        case 0: // add r, [<ds:>++r]
800                           UNSP_REG_I(OPB)++;
801                           r0 = UNSP_REG_I(OPA);
802                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
803                           lres = r0 + r1;
804                           unsp_update_nzsc(unsp, lres, r0, r1);
805                           UNSP_REG_I(OPA) = (UINT16)lres;
806                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
807                           break;
808                        case 1: // adc r, [<ds:>++r]
809                           UNSP_REG_I(OPB)++;
810                           r0 = UNSP_REG_I(OPA);
811                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
812                           lres = r0 + r1;
813                           if(UNSP_REG(SR) & 0x0040) lres++;
814                           unsp_update_nzsc(unsp, lres, r0, r1);
815                           UNSP_REG_I(OPA) = (UINT16)lres;
816                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
817                           break;
818                        case 2: // sub r, [<ds:>++r]
819                           UNSP_REG_I(OPB)++;
820                           r0 = UNSP_REG_I(OPA);
821                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
822                           lres = r0 + (~r1 & 0x0000ffff) + 1;
823                           unsp_update_nzsc(unsp, lres, r0, r1);
824                           UNSP_REG_I(OPA) = (UINT16)lres;
825                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
826                           break;
827                        case 3: // sbc r, [<ds:>++r]
828                           UNSP_REG_I(OPB)++;
829                           r0 = UNSP_REG_I(OPA);
830                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
831                           lres = r0 + (~r1 & 0x0000ffff);
832                           if(UNSP_REG(SR) & 0x0040) lres++;
833                           unsp_update_nzsc(unsp, lres, r0, r1);
834                           UNSP_REG_I(OPA) = (UINT16)lres;
835                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
836                           break;
837                        case 6: // neg r, [<ds:>++r]
838                           UNSP_REG_I(OPB)++;
839                           r0 = UNSP_REG_I(OPA);
840                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
841                           lres = -r1;
842                           unsp_update_nz(unsp, lres);
843                           UNSP_REG_I(OPA) = (UINT16)lres;
844                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
845                           break;
846                        case 8: // xor r, [<ds:>++r]
847                           UNSP_REG_I(OPB)++;
848                           r0 = UNSP_REG_I(OPA);
849                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
850                           lres = r0 ^ r1;
851                           unsp_update_nz(unsp, lres);
852                           UNSP_REG_I(OPA) = (UINT16)lres;
853                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
854                           break;
855                        case 9: // load r, [<ds:>++r]
856                           UNSP_REG_I(OPB)++;
857                           lres = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
858                           unsp_update_nz(unsp, lres);
859                           UNSP_REG_I(OPA) = (UINT16)lres;
860                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
861                           break;
862                        case 10: // or r, [<ds:>++r]
863                           UNSP_REG_I(OPB)++;
864                           r0 = UNSP_REG_I(OPA);
865                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
866                           lres = r0 | r1;
867                           unsp_update_nz(unsp, lres);
868                           UNSP_REG_I(OPA) = (UINT16)lres;
869                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
870                           break;
871                        case 11: // and r, [<ds:>++r]
872                           UNSP_REG_I(OPB)++;
873                           r0 = UNSP_REG_I(OPA);
874                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
875                           lres = r0 & r1;
876                           unsp_update_nz(unsp, lres);
877                           UNSP_REG_I(OPA) = (UINT16)lres;
878                           if(OPA == (UNSP_PC-1) || OPB == (UNSP_PC-1)) jumped = 1;
879                           break;
880                        case 12: // test r, [<ds:>++r]
881                           UNSP_REG_I(OPB)++;
882                           r0 = UNSP_REG_I(OPA);
883                           r1 = READ16(unsp, (OPN & 4) ? UNSP_LREG_I(OPB) : UNSP_REG_I(OPB));
884                           lres = r0 & r1;
885                           unsp_update_nz(unsp, lres);
886                           if(OPB == (UNSP_PC-1)) jumped = 1;
887                           break;
433                        STANDARD_ALU_CASES;
888434                        default:
889435                           unimplemented_opcode(unsp, op);
890436                           break;
891437                     }
438                     if(OP0 != 4 && OP0 < 12)
439                     {
440                        UNSP_REG_I(OPA) = (UINT16)lres;
441                     }
892442                     break;
893443               }
894444               break;
r7032r7033
897447            case 0x40: case 0x41: case 0x42: case 0x43: case 0x44: case 0x46: case 0x48: case 0x49: case 0x4a: case 0x4b: case 0x4c:
898448               switch(OPN)
899449               {
900                  // ALU, Register
450                  // r, r
901451                  case 0:
452                     r0 = UNSP_REG_I(OPA);
453                     r1 = UNSP_REG_I(OPB);
902454                     switch(OP0)
903455                     {
904                        case 0: // add r, r
905                           r0 = UNSP_REG_I(OPA);
906                           r1 = UNSP_REG_I(OPB);
907                           lres = r0 + r1;
908                           unsp_update_nzsc(unsp, lres, r0, r1);
909                           UNSP_REG_I(OPA) = (UINT16)lres;
910                           if(OPA == (UNSP_PC-1)) jumped = 1;
911                           break;
912                        case 1: // adc r, r
913                           r0 = UNSP_REG_I(OPA);
914                           r1 = UNSP_REG_I(OPB);
915                           lres = r0 + r1;
916                           if(UNSP_REG(SR) & 0x0040) lres++;
917                           unsp_update_nzsc(unsp, lres, r0, r1);
918                           UNSP_REG_I(OPA) = (UINT16)lres;
919                           if(OPA == (UNSP_PC-1)) jumped = 1;
920                           break;
921                        case 2: // sub r, r
922                           r0 = UNSP_REG_I(OPA);
923                           r1 = UNSP_REG_I(OPB);
924                           lres = r0 + (~r1 & 0x0000ffff) + 1;
925                           unsp_update_nzsc(unsp, lres, r0, r1);
926                           UNSP_REG_I(OPA) = (UINT16)lres;
927                           if(OPA == (UNSP_PC-1)) jumped = 1;
928                           break;
929                        case 4: // cmp r, r
930                           r0 = UNSP_REG_I(OPA);
931                           r1 = UNSP_REG_I(OPB);
932                           lres = r0 + (~r1 & 0x0000ffff) + 1;
933                           unsp_update_nzsc(unsp, lres, r0, r1);
934                           break;
935                        case 6: // neg r, r
936                           r0 = UNSP_REG_I(OPA);
937                           r1 = UNSP_REG_I(OPB);
938                           lres = -r1;
939                           unsp_update_nz(unsp, lres);
940                           UNSP_REG_I(OPA) = (UINT16)lres;
941                           if(OPA == (UNSP_PC-1)) jumped = 1;
942                           break;
943                        case 8: // xor r, r
944                           r0 = UNSP_REG_I(OPA);
945                           r1 = UNSP_REG_I(OPB);
946                           lres = r0 ^ r1;
947                           unsp_update_nz(unsp, lres);
948                           UNSP_REG_I(OPA) = (UINT16)lres;
949                           if(OPA == (UNSP_PC-1)) jumped = 1;
950                           break;
951                        case 9: // load r, r
952                           lres = UNSP_REG_I(OPB);
953                           unsp_update_nz(unsp, lres);
954                           UNSP_REG_I(OPA) = (UINT16)lres;
955                           if(OPA == (UNSP_PC-1)) jumped = 1;
956                           break;
957                        case 10: // or r, r
958                           r0 = UNSP_REG_I(OPA);
959                           r1 = UNSP_REG_I(OPB);
960                           lres = r0 | r1;
961                           unsp_update_nz(unsp, lres);
962                           UNSP_REG_I(OPA) = (UINT16)lres;
963                           if(OPA == (UNSP_PC-1)) jumped = 1;
964                           break;
965                        case 11: // and r, r
966                           r0 = UNSP_REG_I(OPA);
967                           r1 = UNSP_REG_I(OPB);
968                           lres = r0 & r1;
969                           unsp_update_nz(unsp, lres);
970                           UNSP_REG_I(OPA) = (UINT16)lres;
971                           if(OPA == (UNSP_PC-1)) jumped = 1;
972                           break;
973                        case 12: // test r, r
974                           r0 = UNSP_REG_I(OPA);
975                           r1 = UNSP_REG_I(OPB);
976                           lres = r0 & r1;
977                           unsp_update_nz(unsp, lres);
978                           break;
456                        STANDARD_ALU_CASES;
979457                        default:
980458                           unimplemented_opcode(unsp, op);
981459                           break;
982460                     }
461                     if(OP0 != 4 && OP0 < 12)
462                     {
463                        UNSP_REG_I(OPA) = (UINT16)lres;
464                     }
983465                     break;
984466
985467                  // ALU, 16-bit Immediate
986                  case 1:
468                  case 1: // r, r, imm16
987469                     if(!((OP0 == 4 || OP0 == 6 || OP0 == 9 || OP0 == 12) && OPA != OPB))
988470                     {
471                        r0 = UNSP_REG_I(OPB);
472                        r1 = READ16(unsp, UNSP_LPC);
473                        UNSP_REG(PC)++;
989474                        switch(OP0)
990475                        {
991                           case 0: // add  r, r, imm16
992                              UNSP_REG(PC)++;
993                              r0 = UNSP_REG_I(OPB);
994                              r1 = READ16(unsp, UNSP_LPC);
995                              lres = r0 + r1;
996                              unsp_update_nzsc(unsp, lres, r0, r1);
997                              UNSP_REG_I(OPA) = (UINT16)lres;
998                              if(OPA == (UNSP_PC-1)) jumped = 1;
999                              break;
1000                           case 1: // adc r, r, imm16
1001                              UNSP_REG(PC)++;
1002                              r0 = UNSP_REG_I(OPB);
1003                              r1 = READ16(unsp, UNSP_LPC);
1004                              lres = r0 + r1;
1005                              if(UNSP_REG(SR) & 0x0040) lres++;
1006                              unsp_update_nzsc(unsp, lres, r0, r1);
1007                              UNSP_REG_I(OPA) = (UINT16)lres;
1008                              if(OPA == (UNSP_PC-1)) jumped = 1;
1009                              break;
1010                           case 2: // sub r, r, imm16
1011                              UNSP_REG(PC)++;
1012                              r0 = UNSP_REG_I(OPB);
1013                              r1 = READ16(unsp, UNSP_LPC);
1014                              lres = r0 + (~r1 & 0x0000ffff) + 1;
1015                              unsp_update_nzsc(unsp, lres, r0, r1);
1016                              UNSP_REG_I(OPA) = (UINT16)lres;
1017                              if(OPA == (UNSP_PC-1)) jumped = 1;
1018                              break;
1019                           case 3: // sbc r, r, imm16
1020                              UNSP_REG(PC)++;
1021                              r0 = UNSP_REG_I(OPB);
1022                              r1 = READ16(unsp, UNSP_LPC);
1023                              lres = r0 + (~r1 & 0x0000ffff);
1024                              if(UNSP_REG(SR) & 0x0040) lres++;
1025                              unsp_update_nzsc(unsp, lres, r0, r1);
1026                              UNSP_REG_I(OPA) = (UINT16)lres;
1027                              if(OPA == (UNSP_PC-1)) jumped = 1;
1028                              break;
1029                           case 4: // cmp r, imm16
1030                              UNSP_REG(PC)++;
1031                              r0 = UNSP_REG_I(OPB);
1032                              r1 = READ16(unsp, UNSP_LPC);
1033                              lres = r0 + (~r1 & 0x0000ffff) + 1;
1034                              unsp_update_nzsc(unsp, lres, r0, r1);
1035                              break;
1036                           case 6: // neg r, imm16
1037                              UNSP_REG(PC)++;
1038                              r0 = UNSP_REG_I(OPB);
1039                              r1 = READ16(unsp, UNSP_LPC);
1040                              lres = -r1;
1041                              unsp_update_nz(unsp, lres);
1042                              UNSP_REG_I(OPA) = (UINT16)lres;
1043                              if(OPA == (UNSP_PC-1)) jumped = 1;
1044                              break;
1045                           case 8: // xor r, imm16
1046                              UNSP_REG(PC)++;
1047                              r0 = UNSP_REG_I(OPB);
1048                              r1 = READ16(unsp, UNSP_LPC);
1049                              lres = r0 ^ r1;
1050                              unsp_update_nz(unsp, lres);
1051                              UNSP_REG_I(OPA) = (UINT16)lres;
1052                              if(OPA == (UNSP_PC-1)) jumped = 1;
1053                              break;
1054                           case 9:   // load r, imm16
1055                              UNSP_REG(PC)++;
1056                              lres = READ16(unsp, UNSP_LPC);
1057                              unsp_update_nz(unsp, lres);
1058                              UNSP_REG_I(OPA) = (UINT16)lres;
1059                              if(OPA == (UNSP_PC-1)) jumped = 1;
1060                              break;
1061                           case 10: // or r, imm16
1062                              UNSP_REG(PC)++;
1063                              r0 = UNSP_REG_I(OPB);
1064                              r1 = READ16(unsp, UNSP_LPC);
1065                              lres = r0 | r1;
1066                              unsp_update_nz(unsp, lres);
1067                              UNSP_REG_I(OPA) = (UINT16)lres;
1068                              if(OPA == (UNSP_PC-1)) jumped = 1;
1069                              break;
1070                           case 11: // and r, imm16
1071                              UNSP_REG(PC)++;
1072                              r0 = UNSP_REG_I(OPB);
1073                              r1 = READ16(unsp, UNSP_LPC);
1074                              lres = r0 & r1;
1075                              unsp_update_nz(unsp, lres);
1076                              UNSP_REG_I(OPA) = (UINT16)lres;
1077                              if(OPA == (UNSP_PC-1)) jumped = 1;
1078                              break;
1079                           case 12: // test r, imm16
1080                              UNSP_REG(PC)++;
1081                              r0 = UNSP_REG_I(OPB);
1082                              r1 = READ16(unsp, UNSP_LPC);
1083                              lres = r0 & r1;
1084                              unsp_update_nz(unsp, lres);
1085                              break;
476                           STANDARD_ALU_CASES;
1086477                           default:
1087478                              unimplemented_opcode(unsp, op);
1088479                              break;
1089480                        }
481                        if(OP0 != 4 && OP0 < 12)
482                        {
483                           UNSP_REG_I(OPA) = (UINT16)lres;
484                        }
1090485                     }
1091486                     else
1092487                     {
r7032r7033
1095490                     break;
1096491
1097492                  // ALU, Direct 16
1098                  case 2:
493                  case 2: // r, [imm16]
494                     r0 = UNSP_REG_I(OPB);
495                     r1 = READ16(unsp, READ16(unsp, UNSP_LPC));
496                     UNSP_REG(PC)++;
1099497                     switch(OP0)
1100498                     {
1101                        case 0: // add r, [imm16]
1102                           UNSP_REG(PC)++;
1103                           r0 = UNSP_REG_I(OPB);
1104                           r1 = READ16(unsp, READ16(unsp, UNSP_LPC));
1105                           lres = r0 + r1;
1106                           UNSP_REG_I(OPA) = (UINT16)lres;
1107                           unsp_update_nzsc(unsp, lres, r0, r1);
1108                           if(OPA == (UNSP_PC-1)) jumped = 1;
1109                           break;
1110                        case 1: // adc r, [imm16]
1111                           UNSP_REG(PC)++;
1112                           r0 = UNSP_REG_I(OPB);
1113                           r1 = READ16(unsp, READ16(unsp, UNSP_LPC));
1114                           lres = r0 + r1;
1115                           if(UNSP_REG(SR) & 0x0040) lres++;
1116                           unsp_update_nzsc(unsp, lres, r0, r1);
1117                           UNSP_REG_I(OPA) = (UINT16)lres;
1118                           if(OPA == (UNSP_PC-1)) jumped = 1;
1119                           break;
1120                        case 2: // sub r, [imm16]
1121                           UNSP_REG(PC)++;
1122                           r0 = UNSP_REG_I(OPB);
1123                           r1 = READ16(unsp, READ16(unsp, UNSP_LPC));
1124                           lres = r0 + (~r1 & 0x0000ffff) + 1;
1125                           unsp_update_nzsc(unsp, lres, r0, r1);
1126                           UNSP_REG_I(OPA) = (UINT16)lres;
1127                           if(OPA == (UNSP_PC-1)) jumped = 1;
1128                           break;
1129                        case 3: // sbc r, [imm16]
1130                           UNSP_REG(PC)++;
1131                           r0 = UNSP_REG_I(OPB);
1132                           r1 = READ16(unsp, READ16(unsp, UNSP_LPC));
1133                           lres = r0 + (~r1 & 0x0000ffff);
1134                           if(UNSP_REG(SR) & 0x0040) lres++;
1135                           unsp_update_nzsc(unsp, lres, r0, r1);
1136                           UNSP_REG_I(OPA) = (UINT16)lres;
1137                           if(OPA == (UNSP_PC-1)) jumped = 1;
1138                           break;
1139                        case 4: // cmp r, [imm16]
1140                           UNSP_REG(PC)++;
1141                           r0 = UNSP_REG_I(OPB);
1142                           r1 = READ16(unsp, READ16(unsp, UNSP_LPC));
1143                           lres = r0 + (~r1 & 0x0000ffff) + 1;
1144                           unsp_update_nzsc(unsp, lres, r0, r1);
1145                           break;
1146                        case 6: // neg r, [imm16]
1147                           UNSP_REG(PC)++;
1148                           r0 = UNSP_REG_I(OPB);
1149                           r1 = READ16(unsp, READ16(unsp, UNSP_LPC));
1150                           lres = -r1;
1151                           unsp_update_nz(unsp, lres);
1152                           UNSP_REG_I(OPA) = (UINT16)lres;
1153                           if(OPA == (UNSP_PC-1)) jumped = 1;
1154                           break;
1155                        case 8: // xor r, [imm16]
1156                           UNSP_REG(PC)++;
1157                           r0 = UNSP_REG_I(OPB);
1158                           r1 = READ16(unsp, READ16(unsp, UNSP_LPC));
1159                           lres = r0 ^ r1;
1160                           unsp_update_nz(unsp, lres);
1161                           UNSP_REG_I(OPA) = (UINT16)lres;
1162                           if(OPA == (UNSP_PC-1)) jumped = 1;
1163                           break;
1164                        case 9: // load r, [imm16]
1165                           UNSP_REG(PC)++;
1166                           lres = READ16(unsp, READ16(unsp, UNSP_LPC));
1167                           unsp_update_nz(unsp, lres);
1168                           UNSP_REG_I(OPA) = (UINT16)lres;
1169                           if(OPA == (UNSP_PC-1)) jumped = 1;
1170                           break;
1171                        case 10: // or r, [imm16]
1172                           UNSP_REG(PC)++;
1173                           r0 = UNSP_REG_I(OPB);
1174                           r1 = READ16(unsp, READ16(unsp, UNSP_LPC));
1175                           lres = r0 | r1;
1176                           unsp_update_nz(unsp, lres);
1177                           UNSP_REG_I(OPA) = (UINT16)lres;
1178                           if(OPA == (UNSP_PC-1)) jumped = 1;
1179                           break;
1180                        case 11: // and r, [imm16]
1181                           UNSP_REG(PC)++;
1182                           r0 = UNSP_REG_I(OPB);
1183                           r1 = READ16(unsp, READ16(unsp, UNSP_LPC));
1184                           lres = r0 & r1;
1185                           unsp_update_nz(unsp, lres);
1186                           UNSP_REG_I(OPA) = (UINT16)lres;
1187                           if(OPA == (UNSP_PC-1)) jumped = 1;
1188                           break;
1189                        case 12: // test r, [imm16]
1190                           UNSP_REG(PC)++;
1191                           r0 = UNSP_REG_I(OPB);
1192                           r1 = READ16(unsp, READ16(unsp, UNSP_LPC));
1193                           lres = r0 & r1;
1194                           unsp_update_nz(unsp, lres);
1195                           break;
499                        STANDARD_ALU_CASES;
1196500                        default:
1197501                           unimplemented_opcode(unsp, op);
1198502                           break;
1199503                     }
504                     if(OP0 != 4 && OP0 < 12)
505                     {
506                        UNSP_REG_I(OPA) = (UINT16)lres;
507                     }
1200508                     break;
1201509
1202510                  // ALU, Direct 16
1203                  case 3:
511                  case 3: // [imm16], r
512                     r0 = UNSP_REG_I(OPB);
513                     r1 = UNSP_REG_I(OPA);
1204514                     switch(OP0)
1205515                     {
1206                        case 0: // add [imm16], r
1207                           UNSP_REG(PC)++;
1208                           r0 = UNSP_REG_I(OPB);
1209                           r1 = UNSP_REG_I(OPA);
1210                           lres = r0 + r1;
1211                           unsp_update_nzsc(unsp, lres, r0, r1);
1212                           WRITE16(unsp, READ16(unsp, UNSP_LPC), (UINT16)lres);
1213                           break;
1214                        case 1: // adc [imm16], r
1215                           UNSP_REG(PC)++;
1216                           r0 = UNSP_REG_I(OPB);
1217                           r1 = UNSP_REG_I(OPA);
1218                           lres = r0 + r1;
1219                           if(UNSP_REG(SR) & 0x0040) lres++;
1220                           unsp_update_nzsc(unsp, lres, r0, r1);
1221                           WRITE16(unsp, READ16(unsp, UNSP_LPC), (UINT16)lres);
1222                           break;
1223                        case 2: // sub [imm16], r
1224                           UNSP_REG(PC)++;
1225                           r0 = UNSP_REG_I(OPB);
1226                           r1 = UNSP_REG_I(OPA);
1227                           lres = r0 + (~r1 & 0x0000ffff) + 1;
1228                           unsp_update_nzsc(unsp, lres, r0, r1);
1229                           WRITE16(unsp, READ16(unsp, UNSP_LPC), (UINT16)lres);
1230                           break;
1231                        case 3: // sbc [imm16], r
1232                           UNSP_REG(PC)++;
1233                           r0 = UNSP_REG_I(OPB);
1234                           r1 = UNSP_REG_I(OPA);
1235                           lres = r0 + (~r1 & 0x0000ffff);
1236                           if(UNSP_REG(SR) & 0x0040) lres++;
1237                           unsp_update_nzsc(unsp, lres, r0, r1);
1238                           WRITE16(unsp, READ16(unsp, UNSP_LPC), (UINT16)lres);
1239                           break;
1240                        case 4: // cmp [imm16], r
1241                           UNSP_REG(PC)++;
1242                           r0 = UNSP_REG_I(OPB);
1243                           r1 = UNSP_REG_I(OPA);
1244                           lres = r0 + (~r1 & 0x0000ffff) + 1;
1245                           unsp_update_nzsc(unsp, lres, r0, r1);
1246                           break;
1247                        case 6: // neg [imm16], r
1248                           UNSP_REG(PC)++;
1249                           r0 = UNSP_REG_I(OPB);
1250                           r1 = UNSP_REG_I(OPA);
1251                           lres = -r1;
1252                           unsp_update_nz(unsp, lres);
1253                           WRITE16(unsp, READ16(unsp, UNSP_LPC), (UINT16)lres);
1254                           break;
1255                        case 8: // xor [imm16], r
1256                           UNSP_REG(PC)++;
1257                           r0 = UNSP_REG_I(OPB);
1258                           r1 = UNSP_REG_I(OPA);
1259                           lres = r0 ^ r1;
1260                           unsp_update_nz(unsp, lres);
1261                           WRITE16(unsp, READ16(unsp, UNSP_LPC), (UINT16)lres);
1262                           break;
1263                        case 10: // or [imm16], r
1264                           UNSP_REG(PC)++;
1265                           r0 = UNSP_REG_I(OPB);
1266                           r1 = UNSP_REG_I(OPA);
1267                           lres = r0 | r1;
1268                           unsp_update_nz(unsp, lres);
1269                           WRITE16(unsp, READ16(unsp, UNSP_LPC), (UINT16)lres);
1270                           break;
1271                        case 11: // and [imm16], r
1272                           UNSP_REG(PC)++;
1273                           r0 = UNSP_REG_I(OPB);
1274                           r1 = UNSP_REG_I(OPA);
1275                           lres = r0 & r1;
1276                           unsp_update_nz(unsp, lres);
1277                           WRITE16(unsp, READ16(unsp, UNSP_LPC), (UINT16)lres);
1278                           break;
516                        STANDARD_ALU_CASES;
1279517                        default:
1280518                           unimplemented_opcode(unsp, op);
1281519                           break;
1282520                     }
521                     if(OP0 != 4 && OP0 < 12)
522                     {
523                        WRITE16(unsp, READ16(unsp, UNSP_LPC), (UINT16)lres);
524                     }
525                     UNSP_REG(PC)++;
1283526                     break;
1284527
1285528                  // ALU, Shifted
r7032r7033
1299542                        case 9: // load r, r asr n
1300543                           unsp_update_nz(unsp, r1);
1301544                           UNSP_REG_I(OPA) = r1;
1302                           if(OPA == (UNSP_PC-1)) jumped = 1;
1303545                           break;
1304546                        default:
1305                           //print("%s %s, %s asr %d", alu[OP0], reg[OPA], reg[OPB], (OPN & 3) + 1);
1306547                           unimplemented_opcode(unsp, op);
1307548                           break;
1308549                     }
r7032r7033
1316557               {
1317558                  if(OPA == OPB)
1318559                  {
1319                     UNSP_REG(PC)++;
1320560                     WRITE16(unsp, READ16(unsp, UNSP_LPC), UNSP_REG_I(OPB));
561                     UNSP_REG(PC)++;
1321562                  }
1322563                  else
1323564                  {
r7032r7033
1341582                        unsp->sb = lres & 0x0f;
1342583                        unsp_update_nz(unsp, (UINT16)(lres >> 4));
1343584                        UNSP_REG_I(OPA) = (UINT16)(lres >> 4);
1344                        if(OPA == (UNSP_PC-1)) jumped = 1;
1345585                        break;
1346586                     default:
1347587                        unimplemented_opcode(unsp, op);
r7032r7033
1361601                        lres = r0 + r1;
1362602                        unsp_update_nzsc(unsp, lres, r0, r1);
1363603                        UNSP_REG_I(OPA) = (UINT16)lres;
1364                        if(OPA == (UNSP_PC-1)) jumped = 1;
1365604                        break;
1366605                     case 9: // load r, r << imm2
1367606                        lres = r1;
1368607                        unsp_update_nz(unsp, lres);
1369608                        UNSP_REG_I(OPA) = (UINT16)lres;
1370                        if(OPA == (UNSP_PC-1)) jumped = 1;
1371609                        break;
1372610                     case 10: // or r, r << imm2
1373611                        lres = r0 | r1;
1374612                        unsp_update_nz(unsp, lres);
1375613                        UNSP_REG_I(OPA) = (UINT16)lres;
1376                        if(OPA == (UNSP_PC-1)) jumped = 1;
1377614                        break;
1378615                     default:
1379616                        unimplemented_opcode(unsp, op);
r7032r7033
1402639                  case 9: // load r, r ror imm2
1403640                     unsp_update_nz(unsp, r1);
1404641                     UNSP_REG_I(OPA) = r1;
1405                     if(OPA == (UNSP_PC-1)) jumped = 1;
1406642                     break;
1407643                  default:
1408644                     unimplemented_opcode(unsp, op);
r7032r7033
1420656            case 0x1f:
1421657               if(OPA == 0)
1422658               {
1423                  UNSP_REG(PC)++;
1424659                  r1 = READ16(unsp, UNSP_LPC);
1425660                  UNSP_REG(PC)++;
1426661                  unsp_push(unsp, UNSP_REG(PC), &UNSP_REG(SP));
r7032r7033
1428663                  UNSP_REG(PC) = r1;
1429664                  UNSP_REG(SR) &= 0xffc0;
1430665                  UNSP_REG(SR) |= OPIMM;
1431                  jumped = 1;
1432666               }
1433667               else
1434668               {
r7032r7033
1485719                  switch(OPIMM)
1486720                  {
1487721                     case 0:
1488                        //print("int off");
1489                        unimplemented_opcode(unsp, op);
722                        unsp->irq &= ~1;
723                        unsp->fiq &= ~1;
1490724                        break;
1491725                     case 1:
1492                        //print("int irq");
1493                        unimplemented_opcode(unsp, op);
726                        unsp->irq |=  1;
727                        unsp->fiq &= ~1;
1494728                        break;
1495729                     case 2:
1496                        //print("int fiq");
1497                        unimplemented_opcode(unsp, op);
730                        unsp->irq &= ~1;
731                        unsp->fiq |=  1;
1498732                        break;
1499733                     case 3:
1500                        //print("int irq,fiq");
1501                        unimplemented_opcode(unsp, op);
734                        unsp->irq |=  1;
735                        unsp->fiq |=  1;
1502736                        break;
1503737                     case 8: // irq off
1504738                        unsp->irq &= ~1;
r7032r7033
1524758         }
1525759      }
1526760
1527      if(!jumped)
1528      {
1529         UNSP_REG(PC)++;
1530      }
1531
1532761      unsp->icount -= 5;
1533762      unsp->icount = MAX(unsp->icount, 0);
1534763    }
r7032r7033
1682911        case CPUINFO_FCT_SET_INFO:              info->setinfo = CPU_SET_INFO_NAME(unsp);        break;
1683912        case CPUINFO_FCT_INIT:                  info->init = CPU_INIT_NAME(unsp);               break;
1684913        case CPUINFO_FCT_RESET:                 info->reset = CPU_RESET_NAME(unsp);             break;
1685        case CPUINFO_FCT_EXIT:                  info->exit = CPU_EXIT_NAME(unsp);               break;
1686914        case CPUINFO_FCT_EXECUTE:               info->execute = CPU_EXECUTE_NAME(unsp);         break;
1687915        case CPUINFO_FCT_BURN:                  info->burn = NULL;                              break;
1688916        case CPUINFO_FCT_DISASSEMBLE:           info->disassemble = CPU_DISASSEMBLE_NAME(unsp); break;

Previous 15994 Revisions Next


© 1998-2018 The MESS Team