Browse code

(uxn.c) Reconnected tnl core without device masks

neauoire authored on 30/10/2023 22:12:25
Showing 1 changed files
... ...
@@ -11,77 +11,109 @@ THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
11 11
 WITH REGARD TO THIS SOFTWARE.
12 12
 */
13 13
 
14
-#define FLIP       { s = ins & 0x40 ? &u->wst : &u->rst; }
15
-#define JUMP(x)    { if(m2) pc = (x); else pc += (Sint8)(x); }
16
-#define POKE(x, y) { if(m2) { POKE2(ram + x, y) } else ram[(x)] = (y); }
17
-#define PEEK(o, x) { if(m2) { o = PEEK2(ram + x); } else o = ram[(x)]; }
18
-#define DEVR(o, p) { if(m2) { o = ((emu_dei(u, p) << 8) + emu_dei(u, p + 1)); } else o = emu_dei(u, p); }
19
-#define DEVW(p, y) { if(m2) { emu_deo(u, p, y >> 8); emu_deo(u, p + 1, y); } else emu_deo(u, p, y); }
20
-#define PUSH1(y)   { s->dat[s->ptr++] = (y); }
21
-#define PUSH2(y)   { t = (y); s->dat[s->ptr++] = t >> 8; s->dat[s->ptr++] = t; }
22
-#define PUSHx(y)   { if(m2) { PUSH2(y) } else PUSH1(y) }
23
-#define POP1(o)    { o = s->dat[--*sp]; }
24
-#define POP2(o)    { o = s->dat[--*sp] | s->dat[--*sp] << 8; }
25
-#define POPx(o)    { if(m2) { POP2(o) } else POP1(o) }
14
+/* Registers
15
+[ Z ][ Y ][ X ][ L ][ N ][ T ] <
16
+[ . ][ . ][ . ][   H2   ][ . ] <
17
+[   L2   ][   N2   ][   T2   ] <
18
+*/
19
+
20
+#define T *(s->dat + s->ptr)
21
+#define N *(s->dat + (Uint8)(s->ptr - 1))
22
+#define L *(s->dat + (Uint8)(s->ptr - 2))
23
+#define X *(s->dat + (Uint8)(s->ptr - 3))
24
+#define Y *(s->dat + (Uint8)(s->ptr - 4))
25
+#define Z *(s->dat + (Uint8)(s->ptr - 5))
26
+#define T2 (N << 8 | T)
27
+#define H2 (L << 8 | N)
28
+#define N2 (X << 8 | L)
29
+#define L2 (Z << 8 | Y)
30
+#define T2_(v) { r = (v); T = r; N = r >> 8; }
31
+#define N2_(v) { r = (v); L = r; X = r >> 8; }
32
+#define L2_(v) { r = (v); Y = r; Z = r >> 8; }
33
+#define FLIP      { s = ins & 0x40 ? &u->wst : &u->rst; }
34
+#define SHIFT(y)  { s->ptr += (y); }
35
+#define SET(x, y) { SHIFT((ins & 0x80) ? x + y : y) }
26 36
 
27 37
 int
28 38
 uxn_eval(Uxn *u, Uint16 pc)
29 39
 {
30
-	Uint8 ksp, *sp, *ram = u->ram;
31
-	Uint16 a, b, c, t;
40
+	int t, n, l, r;
41
+	Uint8 *ram = u->ram, *rr;
32 42
 	if(!pc || u->dev[0x0f]) return 0;
33 43
 	for(;;) {
34
-		Uint8 ins = ram[pc++], opc = ins & 0x1f;
35
-		Uint8 m2 = ins & 0x20;
44
+		int ins = ram[pc++];
36 45
 		Stack *s = ins & 0x40 ? &u->rst : &u->wst;
37
-		if(ins & 0x80) {
38
-			ksp = s->ptr;
39
-			sp = &ksp;
40
-		} else
41
-			sp = &s->ptr;
42
-		/* Opcodes */
43
-		switch(opc - (!opc * (ins >> 5))) {
44
-		/* Immediate */
45
-		case -0x0: /* BRK   */ return 1;
46
-		case -0x1: /* JCI   */ POP1(b) if(!b) { pc += 2; break; } /* else fallthrough */
47
-		case -0x2: /* JMI   */ pc += PEEK2(ram + pc) + 2; break;
48
-		case -0x3: /* JSI   */ PUSH2(pc + 2) pc += PEEK2(ram + pc) + 2; break;
49
-		case -0x4: /* LIT   */
50
-		case -0x6: /* LITr  */ PUSH1(ram[pc++]) break;
51
-		case -0x5: /* LIT2  */
52
-		case -0x7: /* LIT2r */ PUSH2(PEEK2(ram + pc)) pc += 2; break;
53
-		/* ALU */
54
-		case 0x01: /* INC */ POPx(a) PUSHx(a + 1) break;
55
-		case 0x02: /* POP */ POPx(a) break;
56
-		case 0x03: /* NIP */ POPx(a) POPx(b) PUSHx(a) break;
57
-		case 0x04: /* SWP */ POPx(a) POPx(b) PUSHx(a) PUSHx(b) break;
58
-		case 0x05: /* ROT */ POPx(a) POPx(b) POPx(c) PUSHx(b) PUSHx(a) PUSHx(c) break;
59
-		case 0x06: /* DUP */ POPx(a) PUSHx(a) PUSHx(a) break;
60
-		case 0x07: /* OVR */ POPx(a) POPx(b) PUSHx(b) PUSHx(a) PUSHx(b) break;
61
-		case 0x08: /* EQU */ POPx(a) POPx(b) PUSH1(b == a) break;
62
-		case 0x09: /* NEQ */ POPx(a) POPx(b) PUSH1(b != a) break;
63
-		case 0x0a: /* GTH */ POPx(a) POPx(b) PUSH1(b > a) break;
64
-		case 0x0b: /* LTH */ POPx(a) POPx(b) PUSH1(b < a) break;
65
-		case 0x0c: /* JMP */ POPx(a) JUMP(a) break;
66
-		case 0x0d: /* JCN */ POPx(a) POP1(b) if(b) JUMP(a) break;
67
-		case 0x0e: /* JSR */ POPx(a) FLIP PUSH2(pc) JUMP(a) break;
68
-		case 0x0f: /* STH */ POPx(a) FLIP PUSHx(a) break;
69
-		case 0x10: /* LDZ */ POP1(a) PEEK(b, a) PUSHx(b) break;
70
-		case 0x11: /* STZ */ POP1(a) POPx(b) POKE(a, b) break;
71
-		case 0x12: /* LDR */ POP1(a) PEEK(b, pc + (Sint8)a) PUSHx(b) break;
72
-		case 0x13: /* STR */ POP1(a) POPx(b) POKE(pc + (Sint8)a, b) break;
73
-		case 0x14: /* LDA */ POP2(a) PEEK(b, a) PUSHx(b) break;
74
-		case 0x15: /* STA */ POP2(a) POPx(b) POKE(a, b) break;
75
-		case 0x16: /* DEI */ POP1(a) DEVR(b, a) PUSHx(b) break;
76
-		case 0x17: /* DEO */ POP1(a) POPx(b) DEVW(a, b) break;
77
-		case 0x18: /* ADD */ POPx(a) POPx(b) PUSHx(b + a) break;
78
-		case 0x19: /* SUB */ POPx(a) POPx(b) PUSHx(b - a) break;
79
-		case 0x1a: /* MUL */ POPx(a) POPx(b) PUSHx((Uint32)b * a) break;
80
-		case 0x1b: /* DIV */ POPx(a) POPx(b) PUSHx(a ? b / a : 0) break;
81
-		case 0x1c: /* AND */ POPx(a) POPx(b) PUSHx(b & a) break;
82
-		case 0x1d: /* ORA */ POPx(a) POPx(b) PUSHx(b | a) break;
83
-		case 0x1e: /* EOR */ POPx(a) POPx(b) PUSHx(b ^ a) break;
84
-		case 0x1f: /* SFT */ POP1(a) POPx(b) PUSHx(b >> (a & 0xf) << (a >> 4)) break;
46
+		switch(ins & 0x1f ? ins & 0x3f : ins << 4) {
47
+			/* IMM */
48
+			case 0x000: /* BRK  */                          return 1;
49
+			case 0x200: /* JCI  */ t=T;           SHIFT(-1) if(!t) { pc += 2; break; } /* else fallthrough */
50
+			case 0x400: /* JMI  */                          rr = ram + pc; pc += PEEK2(rr) + 2; break;
51
+			case 0x600: /* JSI  */                SHIFT( 2) T2_(pc + 2); rr = ram + pc; pc += PEEK2(rr) + 2; break;
52
+			case 0x800: /* LIT  */ case 0xc00:    SHIFT( 1) T = ram[pc++]; break;
53
+			case 0xa00: /* LIT2 */ case 0xe00:    SHIFT( 2) rr = ram + pc; T2_(PEEK2(rr)) pc += 2; break;
54
+			/* ALU */
55
+			case 0x01: /* INC  */ t=T;            SET(1, 0) T = t + 1; break;
56
+			case 0x21: /* INC2 */ t=T2;           SET(2, 0) T2_(t + 1) break;
57
+			case 0x02: /* POP  */                 SET(1,-1) break;
58
+			case 0x22: /* POP2 */                 SET(2,-2) break;
59
+			case 0x03: /* NIP  */ t=T;            SET(2,-1) T = t; break;
60
+			case 0x23: /* NIP2 */ t=T2;           SET(4,-2) T2_(t) break;
61
+			case 0x04: /* SWP  */ t=T;n=N;        SET(2, 0) T = n; N = t; break;
62
+			case 0x24: /* SWP2 */ t=T2;n=N2;      SET(4, 0) T2_(n) N2_(t) break;
63
+			case 0x05: /* ROT  */ t=T;n=N;l=L;    SET(3, 0) T = l; N = t; L = n; break;
64
+			case 0x25: /* ROT2 */ t=T2;n=N2;l=L2; SET(6, 0) T2_(l) N2_(t) L2_(n) break;
65
+			case 0x06: /* DUP  */ t=T;            SET(1, 1) T = t; N = t; break;
66
+			case 0x26: /* DUP2 */ t=T2;           SET(2, 2) T2_(t) N2_(t) break;
67
+			case 0x07: /* OVR  */ t=T;n=N;        SET(2, 1) T = n; N = t; L = n; break;
68
+			case 0x27: /* OVR2 */ t=T2;n=N2;      SET(4, 2) T2_(n) N2_(t) L2_(n) break;
69
+			case 0x08: /* EQU  */ t=T;n=N;        SET(2,-1) T = n == t; break;
70
+			case 0x28: /* EQU2 */ t=T2;n=N2;      SET(4,-3) T = n == t; break;
71
+			case 0x09: /* NEQ  */ t=T;n=N;        SET(2,-1) T = n != t; break;
72
+			case 0x29: /* NEQ2 */ t=T2;n=N2;      SET(4,-3) T = n != t; break;
73
+			case 0x0a: /* GTH  */ t=T;n=N;        SET(2,-1) T = n > t; break;
74
+			case 0x2a: /* GTH2 */ t=T2;n=N2;      SET(4,-3) T = n > t; break;
75
+			case 0x0b: /* LTH  */ t=T;n=N;        SET(2,-1) T = n < t; break;
76
+			case 0x2b: /* LTH2 */ t=T2;n=N2;      SET(4,-3) T = n < t; break;
77
+			case 0x0c: /* JMP  */ t=T;            SET(1,-1) pc += (Sint8)t; break;
78
+			case 0x2c: /* JMP2 */ t=T2;           SET(2,-2) pc = t; break;
79
+			case 0x0d: /* JCN  */ t=T;n=N;        SET(2,-2) if(n) pc += (Sint8)t; break;
80
+			case 0x2d: /* JCN2 */ t=T2;n=L;       SET(3,-3) if(n) pc = t; break;
81
+			case 0x0e: /* JSR  */ t=T;            SET(1,-1) FLIP SHIFT(2) T2_(pc) pc += (Sint8)t; break;
82
+			case 0x2e: /* JSR2 */ t=T2;           SET(2,-2) FLIP SHIFT(2) T2_(pc) pc = t; break;
83
+			case 0x0f: /* STH  */ t=T;            SET(1,-1) FLIP SHIFT(1) T = t; break;
84
+			case 0x2f: /* STH2 */ t=T2;           SET(2,-2) FLIP SHIFT(2) T2_(t) break;
85
+			case 0x10: /* LDZ  */ t=T;            SET(1, 0) T = ram[t]; break;
86
+			case 0x30: /* LDZ2 */ t=T;            SET(1, 1) rr = ram + t; T2_(PEEK2(rr)) break;
87
+			case 0x11: /* STZ  */ t=T;n=N;        SET(2,-2) ram[t] = n; break;
88
+			case 0x31: /* STZ2 */ t=T;n=H2;       SET(3,-3) rr = ram + t; POKE2(rr, n) break;
89
+			case 0x12: /* LDR  */ t=T;            SET(1, 0) T = ram[pc + (Sint8)t]; break;
90
+			case 0x32: /* LDR2 */ t=T;            SET(1, 1) rr = ram + pc + (Sint8)t; T2_(PEEK2(rr)) break;
91
+			case 0x13: /* STR  */ t=T;n=N;        SET(2,-2) ram[pc + (Sint8)t] = n; break;
92
+			case 0x33: /* STR2 */ t=T;n=H2;       SET(3,-3) rr = ram + pc + (Sint8)t; POKE2(rr, n) break;
93
+			case 0x14: /* LDA  */ t=T2;           SET(2,-1) T = ram[t]; break;
94
+			case 0x34: /* LDA2 */ t=T2;           SET(2, 0) rr = ram + t; T2_(PEEK2(rr)) break;
95
+			case 0x15: /* STA  */ t=T2;n=L;       SET(3,-3) ram[t] = n; break;
96
+			case 0x35: /* STA2 */ t=T2;n=N2;      SET(4,-4) rr = ram + t; POKE2(rr, n) break;
97
+			case 0x16: /* DEI  */ t=T;            SET(1, 0) T = emu_dei(u, t); break;
98
+			case 0x36: /* DEI2 */ t=T;            SET(1, 1) N = emu_dei(u, t); T = emu_dei(u, t + 1); break;
99
+			case 0x17: /* DEO  */ t=T;n=N;        SET(2,-2) emu_deo(u, t, n); break;
100
+			case 0x37: /* DEO2 */ t=T;n=N;l=L;    SET(3,-3) emu_deo(u, t, l); emu_deo(u, t + 1, n); break;
101
+			case 0x18: /* ADD  */ t=T;n=N;        SET(2,-1) T = n + t; break;
102
+			case 0x38: /* ADD2 */ t=T2;n=N2;      SET(4,-2) T2_(n + t) break;
103
+			case 0x19: /* SUB  */ t=T;n=N;        SET(2,-1) T = n - t; break;
104
+			case 0x39: /* SUB2 */ t=T2;n=N2;      SET(4,-2) T2_(n - t) break;
105
+			case 0x1a: /* MUL  */ t=T;n=N;        SET(2,-1) T = n * t; break;
106
+			case 0x3a: /* MUL2 */ t=T2;n=N2;      SET(4,-2) T2_(n * t) break;
107
+			case 0x1b: /* DIV  */ t=T;n=N;        SET(2,-1) T = t ? n / t : 0; break;
108
+			case 0x3b: /* DIV2 */ t=T2;n=N2;      SET(4,-2) T2_(t ? n / t : 0) break;
109
+			case 0x1c: /* AND  */ t=T;n=N;        SET(2,-1) T = n & t; break;
110
+			case 0x3c: /* AND2 */ t=T2;n=N2;      SET(4,-2) T2_(n & t) break;
111
+			case 0x1d: /* ORA  */ t=T;n=N;        SET(2,-1) T = n | t; break;
112
+			case 0x3d: /* ORA2 */ t=T2;n=N2;      SET(4,-2) T2_(n | t) break;
113
+			case 0x1e: /* EOR  */ t=T;n=N;        SET(2,-1) T = n ^ t; break;
114
+			case 0x3e: /* EOR2 */ t=T2;n=N2;      SET(4,-2) T2_(n ^ t) break;
115
+			case 0x1f: /* SFT  */ t=T;n=N;        SET(2,-1) T = n >> (t & 0xf) << (t >> 4); break;
116
+			case 0x3f: /* SFT2 */ t=T;n=H2;       SET(3,-1) T2_(n >> (t & 0xf) << (t >> 4)) break;
85 117
 		}
86 118
 	}
87 119
 }