ref: 2c9e3861a54e22498fb2e3226defe4393b20b202
dir: /sys/src/games/blit/cpu.c/
#include <u.h> #include <libc.h> #include <thread.h> #include "dat.h" #include "fns.h" enum { FLAGS = 1<<13, FLAGX = 16, FLAGN = 8, FLAGZ = 4, FLAGV = 2, FLAGC = 1, }; u32int r[16], pc, curpc; u32int asp, irq, stop; extern u32int irql[8]; u32int irqla[8]; u16int rS; static u32int op; int trace, tim; #define ra (r+8) static void undef(void) { sysfatal("undefined opcode %#o at pc=%#.6x", op, curpc); } static u16int fetch16(void) { u16int v; v = memread(pc); pc += 2; return v; } static u32int fetch32(void) { u32int v; v = fetch16() << 16; return v | fetch16(); } static void push16(u16int u) { ra[7] -= 2; memwrite(ra[7], u, -1); } static u16int pop16(void) { u16int v; v = memread(ra[7]); ra[7] += 2; return v; } static void push32(u32int u) { ra[7] -= 4; memwrite(ra[7], u >> 16, -1); memwrite(ra[7] + 2, u, -1); } static u32int pop32(void) { u32int v; v = memread(ra[7]) << 16; v |= memread(ra[7] + 2); ra[7] += 4; return v; } static vlong amode(int m, int n, int s) { u16int w; u32int v; m &= 7; n &= 7; s &= 3; if(n == 7 && s == 0) s++; switch(m){ case 0: return ~n; case 1: return ~(n+8); case 2: tim += s == 2 ? 8 : 4; return ra[n]; case 3: v = ra[n]; ra[n] += 1<<s; tim += s == 2 ? 8 : 4; return v; case 4: tim += s == 2 ? 10 : 6; return ra[n] -= 1<<s; case 5: tim += s == 2 ? 12 : 8; return (u32int)(ra[n] + (s16int)fetch16()); case 6: tim += s == 2 ? 14 : 10; w = fetch16(); v = r[w >> 12]; if((w & 1<<11) == 0) v = (s16int)v; return (u32int)(ra[n] + v + (s8int)w); case 7: switch(n){ case 0: tim += s == 2 ? 12 : 8; return (u32int)(s16int)fetch16(); case 1: tim += s == 2 ? 16 : 12; return fetch32(); case 2: tim += s == 2 ? 12 : 8; v = fetch16(); return (u32int)(pc + (s16int)v - 2); case 3: tim += s == 2 ? 14 : 10; w = fetch16(); v = r[w >> 12]; if((w & 1<<11) == 0) v = (s16int)v; return (u32int)(pc + v + (s8int)w - 2); case 4: tim += s == 2 ? 8 : 4; v = pc; pc += 1<<s; if(s == 0) v = pc++; return v; default: undef(); } default: undef(); } return 0; } static u32int rmode(vlong a, int s) { u32int v; if(a >= 0){ switch(s & 3){ case 0: v = memread(a); if((a & 1) == 0) v >>= 8; return (s8int) v; default: return (s16int) memread(a); case 2: v = memread(a) << 16; return v | memread(a + 2); } } v = r[~a]; switch(s & 3){ case 0: return (s8int) v; case 1: return (s16int) v; default: return v; } } static void wmode(vlong a, int s, u32int v) { int n; if(a >= 0){ switch(s & 3){ case 0: memwrite(a, (u8int)v | (u8int)v << 8, (a & 1) != 0 ? 0xff : 0xff00); return; default: memwrite(a, v, -1); return; case 2: memwrite(a, v >> 16, -1); memwrite(a + 2, v, -1); return; } } n = ~a; if(n < 8){ switch(s){ case 0: r[n] = r[n] & 0xffffff00 | v & 0xff; break; case 1: r[n] = r[n] & 0xffff0000 | v & 0xffff; break; default: r[n] = v; } }else{ if(s == 1) v = (s16int) v; r[n] = v; } } static void nz(u32int v, int s) { switch(s){ case 0: v = (s8int) v; break; case 1: v = (s16int) v; break; } rS &= ~(FLAGC|FLAGN|FLAGV|FLAGZ); if(v == 0) rS |= FLAGZ; if((s32int)v < 0) rS |= FLAGN; } static u32int add(u32int u, u32int w, int c, int s) { u64int v; rS &= ~(FLAGN|FLAGV|FLAGC); switch(s){ case 0: v = (u8int)w + (u8int)u + c; if(v >= 0x100) rS |= FLAGC; if((v & 0x80) != 0) rS |= FLAGN; if((~(w ^ u) & (v ^ u) & 0x80) != 0) rS |= FLAGV; if((u8int)v != 0) rS &= ~FLAGZ; break; case 1: v = (u16int)w + (u16int)u + c; if(v >= 0x10000) rS |= FLAGC; if((v & 0x8000) != 0) rS |= FLAGN; if((~(w ^ u) & (v ^ u) & 0x8000) != 0) rS |= FLAGV; if((u16int)v != 0) rS &= ~FLAGZ; break; default: v = (u64int)w + u + c; if((v >> 32) != 0) rS |= FLAGC; if((v & 0x80000000) != 0) rS |= FLAGN; if((~(w ^ u) & (v ^ u) & 0x80000000) != 0) rS |= FLAGV; if((u32int)v != 0) rS &= ~FLAGZ; break; } return v; } static u32int sub(u32int u, u32int w, int c, int s) { u64int v; rS &= ~(FLAGN|FLAGV|FLAGC); switch(s){ case 0: v = (u8int)u - (u8int)w - c; if(v >= 0x100) rS |= FLAGC; if((v & 0x80) != 0) rS |= FLAGN; if(((w ^ u) & (v ^ u) & 0x80) != 0) rS |= FLAGV; if((u8int)v != 0) rS &= ~FLAGZ; break; case 1: v = (u16int)u - (u16int)w - c; if(v >= 0x10000) rS |= FLAGC; if((v & 0x8000) != 0) rS |= FLAGN; if(((w ^ u) & (v ^ u) & 0x8000) != 0) rS |= FLAGV; if((u16int)v != 0) rS &= ~FLAGZ; break; default: v = (u64int)u - w - c; if((v >> 32) != 0) rS |= FLAGC; if((v & 0x80000000) != 0) rS |= FLAGN; if(((w ^ u) & (v ^ u) & (1<<31)) != 0) rS |= FLAGV; if((u32int)v != 0) rS &= ~FLAGZ; break; } return v; } static int cond(int n) { switch(n){ case 0: return 1; break; default: return 0; break; case 2: return (rS & (FLAGC|FLAGZ)) == 0; break; case 3: return (rS & (FLAGC|FLAGZ)) != 0; break; case 4: return (rS & FLAGC) == 0; break; case 5: return (rS & FLAGC) != 0; break; case 6: return (rS & FLAGZ) == 0; break; case 7: return (rS & FLAGZ) != 0; break; case 8: return (rS & FLAGV) == 0; break; case 9: return (rS & FLAGV) != 0; break; case 10: return (rS & FLAGN) == 0; break; case 11: return (rS & FLAGN) != 0; break; case 12: return ((rS ^ (rS << 2)) & FLAGN) == 0; break; case 13: return ((rS ^ (rS << 2)) & FLAGN) != 0; break; case 14: return ((rS ^ (rS << 2)) & FLAGN) == 0 && (rS & FLAGZ) == 0; break; case 15: return ((rS ^ (rS << 2)) & FLAGN) != 0 || (rS & FLAGZ) != 0; break; } } static u32int rot(u32int v, int m, int n, int s) { int l, ll, x, vf; u32int msb; /* abandon all hope ye who enter here */ msb = 1 << (8 << s) - 1; v &= (msb << 1) - 1; if(m == 0) x = (v & msb) != 0; else x = 0; if((m & 6) == 4) ll = l = (rS & FLAGX) != 0; else ll = l = 0; vf = 0; while(n--){ if((m & 1) == 0){ l = v & 1; v >>= 1; }else{ l = (v & msb) != 0; v <<= 1; } if((m & 6) != 6) rS = rS & ~FLAGX | l << 4; if(m >= 6) x = l; else if(m >= 4){ x = ll; ll = l; } if((m & 1) == 0){ if(x != 0) v |= msb; }else v |= x; vf |= l ^ (v & msb) != 0; tim += 2; } nz(v, s); rS |= l; if(m == 1 && vf) rS |= FLAGV; tim += s == 2 ? 8 : 6; return v; } static u8int addbcd(u8int a, u8int b) { int r; u8int bc, dc, s; r = a + b + (rS >> 4 & 1); bc = ((a ^ b ^ r) & 0x110) >> 1; dc = ((r + 0x66 ^ r) & 0x110) >> 1; s = r + (bc | dc) - ((bc | dc) >> 2); rS &= ~(FLAGC|FLAGX|FLAGN|FLAGV); if(((bc | r & ~s) & 0x80) != 0) rS |= FLAGC|FLAGX; if(s != 0) rS &= ~FLAGZ; if((s & 0x80) != 0) rS |= FLAGN; if((~r & s & 0x80) != 0) rS |= FLAGV; return s; } static u8int subbcd(u8int a, u8int b) { int r; u8int bc, s; r = a - b - (rS >> 4 & 1); bc = ((a ^ b ^ r) & 0x110) >> 1; s = r - (bc - (bc >> 2)); rS &= ~(FLAGC|FLAGX|FLAGN|FLAGV); if(((bc | (~r & s)) & 0x80) != 0) rS |= FLAGC|FLAGX; if(s != 0) rS &= ~FLAGZ; if((s & 0x80) != 0) rS |= FLAGN; if((r & ~s & 0x80) != 0) rS |= FLAGV; return s; } static void dtime(u16int op, u8int s) { if((op & 0x100) == 0){ if(s == 2) if((op & 0x30) == 0 || (op & 0x3f) == 0x3c) tim += 8; else tim += 6; else tim += 4; }else tim += s == 2 ? 12 : 8; } static void stime(int a, u8int s) { if(a) tim += s == 2 ? 6 : 4; else tim += s == 2 ? 12 : 8; } static void trap(int n, u32int pcv) { int l, v; u32int sr, t; sr = rS; if(n < 0){ for(l = 7; l > ((rS >> 8) & 7); l--) if((irql[l] & irq) != 0) break; v = intack(l); rS = rS & ~0x700 | l << 8; tim += 44; }else{ switch(n){ case 2: case 3: tim += 50; break; case 5: tim += 38; break; case 6: tim += 40; break; default: tim += 34; break; } v = n; } if((rS & FLAGS) == 0){ t = asp; asp = ra[7]; ra[7] = t; } rS |= FLAGS; push32(pcv); push16(sr); pc = memread(v * 4) << 16; pc |= memread(v * 4 + 2); stop = 0; } void cpureset(void) { u32int v; int i; ra[7] = memread(0) << 16 | memread(2); pc = memread(4) << 16 | memread(6); rS = 0x2700; for(i = 7, v = 0; i >= 0; i--){ irqla[i] = v; v |= irql[i]; } } static void cputrace(void) { int i; static char buf[1024]; static u32int oldr[16]; char *p, *e; p = buf; e = buf + sizeof(buf); p = seprint(p, e, "%.6ux %.6uo %.4x %.8ux %.8ux |", curpc, op, rS, ra[7], asp); for(i = 0; i < 16; i++) if(oldr[i] != r[i]) p = seprint(p, e, " %c%d=%.8ux", i >= 8 ? 'A' : 'D', i & 7, r[i]); print("%s\n", buf); memcpy(oldr, r, sizeof(r)); } static void ccr_sr_op(u16int op) { int s; u32int v, w; s = op >> 6 & 3; if(s == 1 && (rS & FLAGS) == 0){ trap(8, curpc); return; } v = rS; w = fetch16(); switch(op >> 9 & 7){ case 0: v |= w; break; case 1: v &= w; break; case 5: v ^= w; break; default: undef(); } if(s != 1) v = v & 0x1f | rS & 0xff00; rS = v; if(s == 1 && (rS & FLAGS) == 0){ v = ra[7]; ra[7] = asp; asp = v; } tim += 20; } static void op_movep(u16int op) { int s, n; vlong a; u32int v; a = (u32int)(ra[op & 7] + (s16int)fetch16()); s = op >> 6 & 3; n = op >> 9 & 7; switch(s){ case 0: v = (u8int)rmode(a, 0) << 8; v |= (u8int)rmode(a + 2, 0); r[n] = r[n] & 0xffff0000 | v; tim += 16; break; case 1: v = (u8int)rmode(a, 0) << 24; v |= (u8int)rmode(a + 2, 0) << 16; v |= (u8int)rmode(a + 4, 0) << 8; v |= (u8int)rmode(a + 6, 0); tim += 24; r[n] = v; break; case 2: wmode(a, 0, r[n] >> 8); wmode(a + 2, 0, r[n]); tim += 16; break; case 3: wmode(a, 0, r[n] >> 24); wmode(a + 2, 0, r[n] >> 16); wmode(a + 4, 0, r[n] >> 8); wmode(a + 6, 0, r[n]); tim += 24; break; } } static void bitop(u16int op) { int s, n; u32int v, w; vlong a; s = op >> 6 & 3; n = op >> 9 & 7; if((op & 0x100) != 0) w = r[n]; else w = fetch16(); if((op & 0x38) != 0){ n = 0; w = 1<<(w & 7); }else{ n = 2; w = 1<<(w & 31); } a = amode(op >> 3, op, n); v = rmode(a, n); rS &= ~FLAGZ; if((v & w) == 0) rS |= FLAGZ; switch(s){ case 1: v ^= w; break; case 2: v &= ~w; if(n == 2) tim += 2; break; case 3: v |= w; break; } if(s != 0){ wmode(a, n, v); tim += (op & 0x100) != 0 ? 8 : 12; }else{ tim += (op & 0x100) != 0 ? 4 : 8; if(n == 2) tim += 2; } } static void immop(u16int op) { int s, n; u32int v, w; vlong a; s = op >> 6 & 3; n = op >> 9 & 7; switch(s){ case 0: w = (s8int)fetch16(); break; default: w = fetch16(); break; case 2: w = fetch32(); break; } a = amode(op >> 3, op, s); v = rmode(a, s); switch(n){ case 0: nz(v |= w, s); break; case 1: nz(v &= w, s); break; case 2: rS |= FLAGZ; v = sub(v, w, 0, s); rS = rS & ~FLAGX | rS << 4 & FLAGX; break; case 3: rS |= FLAGZ; v = add(v, w, 0, s); rS = rS & ~FLAGX | rS << 4 & FLAGX; break; case 5: nz(v ^= w, s); break; case 6: rS |= FLAGZ; sub(v, w, 0, s); break; default: undef(); } if(n == 6){ if(a < 0) tim += s == 2 ? 14 : 8; else tim += s == 2 ? 12 : 8; }else{ if(a < 0) tim += s == 2 ? 16 : 8; else tim += s == 2 ? 20 : 12; } if(n != 6) wmode(a, s, v); } void op_move(u16int op, int s) { u32int v; v = rmode(amode(op >> 3, op, s), s); wmode(amode(op >> 6, op >> 9, s), s, v); if((op & 0x1c0) != 0x40) nz(v, s); tim += 4; if((op & 0700) == 0400) tim -= 2; } static void op_lea(u16int op) { int n; n = op >> 9 & 7; ra[n] = amode(op >> 3, op, 1); if((op & 070) == 060 || (op & 077) == 073) tim += 2; } static void op_chk(u16int op) { int s, n; u32int v; vlong a; s = op >> 6 & 3; n = op >> 9 & 7; a = amode(op >> 3, op, s); v = rmode(a, s); if((s32int)r[n] < 0 || (s32int)r[n] > (s32int)v) trap(6, curpc); else tim += 10; } static void op_movem(u16int op) { int s, n, m; u32int w; vlong a; s = (op >> 6 & 1) + 1; w = fetch16(); if((op & 0x38) == 0x18){ n = op & 7; a = ra[n]; for(m = 0; m < 16; m++){ if((w & 1) != 0){ r[m] = rmode(a, s); a += 1<<s; tim += 2<<s; } w >>= 1; } ra[n] = a; tim += 12; }else if((op & 0x38) == 0x20){ n = op & 7; a = ra[n]; for(m = 0; m < 16; m++){ if((w & 1) != 0){ a -= 1<<s; wmode(a, s, r[15 - m]); tim += 2<<s; } w >>= 1; } ra[n] = a; tim += 8; }else{ a = amode(op >> 3, op, s); for(m = 0; m < 16; m++){ if((w & 1) != 0){ if((op & 0x400) != 0) r[m] = rmode(a, s); else wmode(a, s, r[m]); a += 1<<s; tim += 2<<s; } w >>= 1; } tim += (op & 0x400) != 0 ? 8 : 4; if(s == 2) tim -= 4; } } static void op_move_from_sr(u16int op) { vlong a; a = amode(op >> 3, op, 1); wmode(a, 1, rS); tim += a < 0 ? 6 : 8; } static void op_negx(u16int op) { int s; u32int v; vlong a; s = op >> 6 & 3; a = amode(op >> 3, op, s); v = rmode(a, s); wmode(a, s, sub(0, v, rS>>4 & 1, s)); rS = rS & ~FLAGX | rS << 4 & FLAGX; stime(a < 0, s); } static void op_clr(u16int op) { int s; vlong a; s = op >> 6 & 3; a = amode(op >> 3, op, s); wmode(a, s, 0); nz(0, 0); stime(a < 0, s); } static void op_move_to_ccr(u16int op) { rS = rS & 0xff00 | rmode(amode(op >> 3, op, 1), 1) & 0x1f; tim += 12; } static void op_neg(u16int op) { int s; u32int v; vlong a; s = op >> 6 & 3; a = amode(op >> 3, op, s); v = rmode(a, s); rS |= FLAGZ; wmode(a, s, sub(0, v, 0, s)); rS = rS & ~FLAGX | rS << 4 & FLAGX; stime(a < 0, s); } static void op_move_to_sr(u16int op) { u32int v; if((rS & FLAGS) != 0){ rS = rmode(amode(op >> 3, op, 1), 1); if((rS & FLAGS) == 0){ v = asp; asp = ra[7]; ra[7] = v; } tim += 12; }else trap(8, curpc); } static void op_not(u16int op) { int s; u32int v; vlong a; s = op >> 6 & 3; a = amode(op >> 3, op, s); v = ~rmode(a, s); nz(v, s); wmode(a, s, v); stime(a < 0, s); } static void op_nbcd(u16int op) { u32int v; vlong a; a = amode(op >> 3, op, 0); v = rmode(a, 0); wmode(a, 0, subbcd(0, v)); if(a < 0) tim += 6; else tim += 8; } static void op_pea(u16int op) { ra[7] -= 4; wmode(ra[7], 2, amode(op >> 3, op, 1)); tim += 8; if((op & 070) == 060 || (op & 077) == 073) tim += 2; } static void op_swap(u16int op) { int n; n = op & 7; nz(r[n] = r[n] >> 16 | r[n] << 16, 2); tim += 4; } static void op_ext_b(u16int op) { int n; n = op & 7; nz(r[n] = r[n] & 0xffff0000 | (u16int)(s8int)r[n], 1); tim += 4; } static void op_ext_w(u16int op) { int n; n = op & 7; nz(r[n] = (s16int)r[n], 2); tim += 4; } static void op_tas(u16int op) { u32int v; vlong a; a = amode(op >> 3, op, 0); v = rmode(a, 0); nz(v, 0); wmode(a, 0, v | 0x80); tim += a < 0 ? 4 : 14; } static void op_tst(u16int op) { int s; vlong a; s = op >> 6 & 3; a = amode(op >> 3, op, s); nz(rmode(a, s), s); tim += 4; } static void op_trap(u16int op) { trap(0x20 | op & 0xf, pc); } static void op_link(u16int op) { int n; n = op & 7; push32(ra[n]); ra[n] = ra[7]; ra[7] += (s16int)fetch16(); tim += 16; } static void op_unlk(u16int op) { int n; n = op & 7; ra[7] = ra[n]; ra[n] = pop32(); tim += 12; } static void op_move_usp(u16int op) { int n; n = op & 7; if((rS & FLAGS) != 0){ if((op & 8) != 0) ra[n] = asp; else asp = ra[n]; tim += 4; }else trap(8, curpc); } static void jtime(int op) { int a; a = op >> 3 & 7; if(a == 2 || a == 6 || (op & 077) == 073) tim += 2; else if((op & 077) == 071) tim -= 2; } static void op_jmp(u16int op) { pc = amode(op >> 3, op, 1); jtime(op); tim += 2; } static void op_jsr(u16int op) { vlong a; a = amode(op >> 3, op, 1); push32(pc); pc = a; jtime(op); tim += 10; } static void op_reset(u16int op) { USED(op); tim += 132; } static void op_nop(u16int op) { USED(op); tim += 4; } static void op_stop(u16int op) { USED(op); if((rS & FLAGS) != 0){ rS = fetch16(); stop = 1; }else trap(8, curpc); tim += 4; } static void op_rte(u16int op) { u32int v; USED(op); if((rS & FLAGS) != 0){ v = rS; rS = pop16(); pc = pop32(); if(((v ^ rS) & FLAGS) != 0){ v = asp; asp = ra[7]; ra[7] = v; } tim += 20; }else trap(8, curpc); } static void op_rts(u16int op) { USED(op); pc = pop32(); tim += 16; } void op_trapv(u16int op) { USED(op); if((rS & FLAGV) != 0) trap(7, curpc); tim += 4; } void op_rtr(u16int op) { USED(op); rS = rS & 0xff00 | pop16() & 0x1f; pc = pop32(); tim += 20; } static void op_dbcc(u16int op) { int n; u32int v; n = op & 7; v = (s16int)fetch16(); if(!cond((op >> 8) & 0xf)){ if((u16int)r[n] != 0){ r[n]--; pc = pc + v - 2; tim += 10; }else{ r[n] |= 0xffff; tim += 14; } }else tim += 12; } static void op_scc(u16int op) { u32int v; vlong a; a = amode(op >> 3, op, 0); v = cond(op >> 8 & 0xf); wmode(a, 0, -v); if(a < 0) tim += 4 + 2 * v; else tim += 8; } static void op_addq_subq(u16int op) { int s, n; u32int v; vlong a; s = op >> 6 & 3; n = op >> 9 & 7; rS |= FLAGZ; if((op & 0x38) == 0x08) s = 2; a = amode(op >> 3, op, s); v = rmode(a, s); if(n == 0) n = 8; if((op & 0x100) == 0) v = add(v, n, 0, s); else v = sub(v, n, 0, s); rS = rS & ~FLAGX | rS << 4 & FLAGX; if(a < 0) tim += s == 2 ? 8 : 4; else tim += s == 2 ? 12 : 8; wmode(a, s, v); } static void op_addq_subq_a(u16int op) { int s, n; s = op >> 6 & 3; n = op >> 9 & 7; if(n == 0) n = 8; tim += s == 2 || (op & 0x100) != 0 ? 8 : 4; if((op & 0x100) == 0) ra[op & 7] += n; else ra[op & 7] -= n; } static void op_bra(u16int op) { u32int v; v = (s8int)op; if(v == 0) v = (s16int)fetch16(); else if(v == (u32int)-1) v = fetch32(); if((op & 0xf00) == 0x100){ /* BSR */ push32(pc); pc = curpc + 2 + v; tim += 18; return; } if(cond((op >> 8) & 0xf)){ pc = curpc + 2 + v; tim += 10; }else tim += (u8int)(op + 1) <= 1 ? 12 : 8; } static void op_moveq(u16int op) { int n; n = op >> 9 & 7; r[n] = (s8int)op; nz(r[n], 0); tim += 4; } static void op_divu_divs(u16int op) { int n; u32int v, w; vlong a; n = op >> 9 & 7; a = amode(op >> 3, op, 1); v = rmode(a, 1); if(v == 0){ trap(5, curpc); return; } if((op & 0x100) != 0){ w = (s32int)r[n] % (s16int)v; v = (s32int)r[n] / (s16int)v; if((s32int)(w ^ r[n]) < 0) w = -w; tim += 158; if(v != (u32int)(s16int)v){ rS = rS & ~FLAGC | FLAGV; return; } }else{ w = r[n] % (u16int)v; v = r[n] / (u16int)v; tim += 140; if(v >= 0x10000){ rS = rS & ~FLAGC | FLAGV; return; } } r[n] = (u16int)v | w << 16; nz(v, 1); } static void op_sbcd(u16int op) { int n, m; u32int v, w; vlong src, dst; n = op >> 9 & 7; m = op & 7; if((op & 8) != 0){ src = amode(4, m, 0); dst = amode(4, n, 0); w = rmode(src, 0); v = rmode(dst, 0); v = subbcd(v, w); wmode(dst, 0, v); }else r[n] = r[n] & 0xffffff00 | subbcd(r[n], r[m]); tim += 6; } static void logic(u16int op) { int s, n; u32int v; vlong a; s = op >> 6 & 3; a = amode(op >> 3, op, s); n = op >> 9 & 7; v = rmode(a, s); switch(op >> 12){ case 8: v |= r[n]; break; case 11: v ^= r[n]; break; case 12: v &= r[n]; break; } if((op & 0x100) == 0) a = ~n; wmode(a, s, v); nz(v, s); dtime(op, s); } static void op_cmpa(u16int op) { int s, n; vlong a; n = op >> 9 & 7; s = (op >> 8 & 1) + 1; a = amode(op >> 3, op, s); rS |= FLAGZ; sub(ra[n], rmode(a, s), 0, 2); tim += 6; } static void op_cmpm(u16int op) { int s, n, m; vlong src, dst; u32int v, w; s = op >> 6 & 3; n = op >> 9 & 7; m = op & 7; rS |= FLAGZ; src = amode(3, m, s); dst = amode(3, n, s); v = rmode(src, s); w = rmode(dst, s); sub(w, v, 0, s); tim += 4; } static void op_cmp(u16int op) { int s, n; vlong a; s = op >> 6 & 3; n = op >> 9 & 7; a = amode(op >> 3, op, s); rS |= FLAGZ; sub(r[n], rmode(a, s), 0, s); tim += s == 2 ? 6 : 4; } static void op_mulu_muls(u16int op) { int n; u32int v; vlong a; n = op >> 9 & 7; a = amode(op >> 3, op, 1); v = rmode(a, 1); if((op & 0x100) != 0) v *= (s16int)r[n]; else v = (u16int)v * (u16int)r[n]; r[n] = v; nz(v, 2); tim += 70; } static void op_abcd(u16int op) { int n, m; u32int v, w; vlong src, dst; n = op >> 9 & 7; m = op & 7; if((op & 8) != 0){ src = amode(4, m, 0); dst = amode(4, n, 0); v = rmode(src, 0); w = rmode(dst, 0); v = addbcd(v, w); wmode(dst, 0, v); }else r[n] = r[n] & 0xffffff00 | addbcd(r[n], r[m]); tim += 6; } static void op_exg(u16int op) { int n, m; u32int v; n = op >> 9 & 7; m = op & 0xf; if((op & 0xc8) == 0x48) n |= 8; v = r[n]; r[n] = r[m]; r[m] = v; tim += 6; } static void op_adda_suba(u16int op) { int s, n; vlong a; n = op >> 9 & 7; if((op & 0x100) != 0){ s = 2; if((op & 0x30) == 0 || (op & 0x3f) == 0x3c) tim += 8; else tim += 6; }else{ s = 1; tim += 8; } a = amode(op >> 3, op, s); if((op >> 12) == 13) ra[n] += rmode(a, s); else ra[n] -= rmode(a, s); } static void op_addx_subx(u16int op) { int s, n, m; u32int v, w; vlong src, dst; s = op >> 6 & 3; n = op >> 9 & 7; m = op & 7; if((op & 8) != 0){ src = amode(4, m, s); dst = amode(4, n, s); w = rmode(src, s); v = rmode(dst, s); tim += s == 2 ? 10 : 6; }else{ w = r[m]; v = r[n]; dst = ~n; tim += s == 2 ? 8 : 4; } if((op >> 12) == 13) v = add(v, w, (rS & FLAGX) != 0, s); else v = sub(v, w, (rS & FLAGX) != 0, s); wmode(dst, s, v); rS = rS & ~FLAGX | rS << 4 & FLAGX; } static void op_add_sub(u16int op) { int s, n, d; u32int v; vlong a; s = op >> 6 & 3; n = op >> 9 & 7; a = amode(op >> 3, op, s); rS |= FLAGZ; d = (op & 0x100) == 0; v = rmode(a, s); if((op >> 12) == 13) v = add(v, r[n], 0, s); else v = sub(d ? r[n] : v, d ? v : r[n], 0, s); rS = rS & ~FLAGX | rS << 4 & FLAGX; if(d) a = ~n; wmode(a, s, v); dtime(op, s); } static void shifts(u16int op) { int s, n, m; vlong a; s = op >> 6 & 3; if(s == 3){ m = op >> 8 & 7; n = 1; s = 1; a = amode(op >> 3, op, s); }else{ a = ~(uvlong)(op & 7); m = op >> 2 & 6 | op >> 8 & 1; n = (op >> 9) & 7; if((op & 0x20) != 0) n = r[n] & 63; else if(n == 0) n = 8; } wmode(a, s, rot(rmode(a, s), m, n, s)); } int step(void) { int s; int n; static int cnt; if(0 && pc == 0x4118c){ trace++; print("%x\n", curpc); } // if(pc == 0x410de) trace++; tim = 0; curpc = pc; if(irq && (irqla[(rS >> 8) & 7] & irq) != 0){ trap(-1, curpc); return tim; } if(stop) return 1; op = fetch16(); if(trace) cputrace(); s = op >> 6 & 3; n = op >> 9 & 7; switch(op >> 12){ case 0: if((op & 0x3f) == 0x3c) ccr_sr_op(op); else if((op & 0x138) == 0x108) op_movep(op); else if((op & 0x100) != 0 || n == 4) bitop(op); else immop(op); break; case 1: op_move(op, 0); break; case 2: op_move(op, 2); break; case 3: op_move(op, 1); break; case 4: if((op & 0x1c0) == 0x1c0) op_lea(op); else if((op & 0x1c0) == 0x180) op_chk(op); else if((op & 0xb80) == 0x880 && (op & 0x38) >= 0x10) op_movem(op); else switch(op >> 8 & 0xf){ case 0: if(s == 3) op_move_from_sr(op); else op_negx(op); break; case 2: op_clr(op); break; case 4: if(s == 3) op_move_to_ccr(op); else op_neg(op); break; case 6: if(s == 3) op_move_to_sr(op); else op_not(op); break; case 8: switch(s){ case 0: op_nbcd(op); break; case 1: if((op >> 3 & 7) != 0) op_pea(op); else op_swap(op); break; case 2: op_ext_b(op); break; case 3: op_ext_w(op); break; } break; case 10: if(s == 3) op_tas(op); else op_tst(op); break; case 14: switch(op >> 4 & 0xf){ case 4: op_trap(op); break; case 5: if((op & 8) == 0) op_link(op); else op_unlk(op); break; case 6: op_move_usp(op); break; default: if((op & 0xc0) == 0xc0) op_jmp(op); else if((op & 0x80) == 0x80) op_jsr(op); else switch(op){ case 0x4e70: op_reset(op); break; case 0x4e71: op_nop(op); break; case 0x4e72: op_stop(op); break; case 0x4e73: op_rte(op); break; case 0x4e75: op_rts(op); break; case 0x4e76: op_trapv(op); break; case 0x4e77: op_rtr(op); break; default: undef(); } } break; default: undef(); break; } break; case 5: if((op & 0xf8) == 0xc8) op_dbcc(op); else if(s == 3) op_scc(op); else if((op & 070) == 010) op_addq_subq_a(op); else op_addq_subq(op); break; case 6: op_bra(op); break; case 7: op_moveq(op); break; case 8: if(s == 3) op_divu_divs(op); else if((op & 0x1f0) == 0x100) op_sbcd(op); else logic(op); break; case 11: if(s == 3) op_cmpa(op); else if((op & 0x138) == 0x108) op_cmpm(op); else if((op & 0x100) == 0) op_cmp(op); else logic(op); break; case 12: if(s == 3) op_mulu_muls(op); else if((op & 0x1f0) == 0x100) op_abcd(op); else if((op & 0x130) == 0x100) op_exg(op); else logic(op); break; case 9: case 13: if(s == 3) op_adda_suba(op); else if((op & 0x130) == 0x100) op_addx_subx(op); else op_add_sub(op); break; case 14: shifts(op); break; case 10: trap(10, curpc); break; case 15: trap(11, curpc); break; default: undef(); } return tim; }