Dariaceli's Git
Browse code

Temporarily override uxn.c with fast until I can port the devices macros

Devine Lu Linvega authored on 12/03/2023 07:00:32
Showing 1 changed files
src/uxn.c
History View file @ 13ab0e5
... ... 
@@ -11,89 +11,122 @@ THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
11 11 
 WITH REGARD TO THIS SOFTWARE.
12 12 
 */
13 13
14 
-/*	a,b,c: general use. m2: byte/short mode flag.
15 
-	tsp: macro temp stack ptr. ksp: "keep" mode copy of stack ptr. sp: ptr to stack ptr.
16 
-	x,y: macro in params. o: macro out param. */
14 
+#define T s->dat[s->ptr-1]
15 
+#define N s->dat[s->ptr-2]
16 
+#define L s->dat[s->ptr-3]
17 
+#define H2 PEEK16(s->dat+s->ptr-3)
18 
+#define T2 PEEK16(s->dat+s->ptr-2)
19 
+#define N2 PEEK16(s->dat+s->ptr-4)
20 
+#define L2 PEEK16(s->dat+s->ptr-6)
17 21
18 
-#define HALT(c) { return uxn_halt(u, instr, (c), pc - 1); }
19 
-#define JUMP(x) { if(m2) pc = (x); else pc += (Sint8)(x); }
20 
-#define PUSH8(x) { if(s->ptr == 0xff) HALT(2) s->dat[s->ptr++] = (x); }
21 
-#define PUSH16(x) { if((tsp = s->ptr) >= 0xfe) HALT(2) t = (x); POKE16(&s->dat[tsp], t); s->ptr = tsp + 2; }
22 
-#define PUSH(x) { if(m2) { PUSH16(x) } else { PUSH8(x) } }
23 
-#define POP8(o) { if(*sp == 0x00) HALT(1) o = s->dat[--*sp]; }
24 
-#define POP16(o) { if((tsp = *sp) <= 0x01) HALT(1) o = PEEK16(&s->dat[tsp - 2]); *sp = tsp - 2; }
25 
-#define POP(o) { if(m2) { POP16(o) } else { POP8(o) } }
26 
-#define POKE(x, y) { if(m2) { t = (y); POKE16(u->ram + x, t) } else { u->ram[(x)] = (y); } }
27 
-#define PEEK(o, x) { if(m2) { o = PEEK16(u->ram + x); } else o = u->ram[(x)]; }
28 
-#define DEVR(o, x) { o = u->dei(u, x); if(m2) o = (o << 8) | u->dei(u, (x) + 1); }
29 
-#define DEVW(x, y) { if(m2) { u->deo(u, (x), (y) >> 8); u->deo(u, (x) + 1, (y)); } else { u->deo(u, x, (y)); } }
22 
+/* Registers
23 
+
24 
+[ . ][ . ][ . ][ L ][ N ][ T ] <
25 
+[ . ][ . ][ . ][   H2   ][ T ] <
26 
+[   L2   ][   N2   ][   T2   ] <
27 
+
28 
+*/
29 
+
30 
+#define HALT(c) { return uxn_halt(u, ins, (c), pc - 1); }
31 
+#define SET(mul, add) { if(mul > s->ptr) HALT(1) s->ptr += k * mul + add; if(s->ptr > 254) HALT(2) }
32 
+#define PUT(o, v) { s->dat[s->ptr - o - 1] = (v); }
33 
+#define PUT2(o, v) { tmp = (v); s->dat[s->ptr - o - 2] = tmp >> 8; s->dat[s->ptr - o - 1] = tmp; }
34 
+#define PUSH(stack, v) { if(s->ptr > 254) HALT(2) stack->dat[stack->ptr++] = (v); }
35 
+#define PUSH2(stack, v) { if(s->ptr > 253) HALT(2) tmp = (v); stack->dat[stack->ptr] = (v) >> 8; stack->dat[stack->ptr + 1] = (v); stack->ptr += 2; }
36 
+#define DEO(a, b) { u->dev[a] = b; if((deo_mask[(a) >> 4] >> ((a) & 0xf)) & 0x1) uxn_deo(u, a); }
37 
+#define DEI(a, b) { PUT(a, ((dei_mask[(b) >> 4] >> ((b) & 0xf)) & 0x1) ? uxn_dei(u, b) : u->dev[b])  }
30 38
31 39 
 int
32 40 
 uxn_eval(Uxn *u, Uint16 pc)
33 41 
 {
34 
-	Uint8 instr, opcode, m2, ksp, tsp, *sp;
35 
-	Uint16 a, b, c, t;
42 
+	Uint8 ins, opc, k;
43 
+	Uint16 t, n, l, tmp;
36 44 
 	Stack *s;
37 45 
 	if(!pc || u->dev[0x0f]) return 0;
38 46 
 	for(;;) {
39 
-		instr = u->ram[pc++];
40 
-		opcode = instr & 0x1f;
41 
-		/* Short Mode */
42 
-		m2 = instr & 0x20;
43 
-		/* Return Mode */
44 
-		s = instr & 0x40 ? u->rst : u->wst;
45 
-		/* Keep Mode */
46 
-		if(instr & 0x80) { ksp = s->ptr; sp = &ksp; }
47 
-		else sp = &s->ptr;
48 
-		/* Opcodes */
49 
-		switch(opcode - (!opcode * (instr >> 5))) {
50 
-		/* Immediate */
51 
-		case -0x0: /* BRK */ return 1;
52 
-		case -0x1: /* JCI */ POP8(b) if(!b) { pc += 2; break; } /* else fallthrough */
53 
-		case -0x2: /* JMI */ pc += PEEK16(u->ram + pc) + 2; break;
54 
-		case -0x3: /* JSI */ s = u->rst; PUSH16(pc + 2) pc += PEEK16(u->ram + pc) + 2; break;
55 
-		case -0x4: /* LIT */
56 
-		case -0x6: /* LITr */ a = u->ram[pc++]; PUSH8(a) break;
57 
-		case -0x5: /* LIT2 */
58 
-		case -0x7: /* LIT2r */ PUSH16(PEEK16(u->ram + pc)) pc += 2; break;
59 
-		/* ALU */
60 
-		case 0x01: /* INC */ POP(a) PUSH(a + 1) break;
61 
-		case 0x02: /* POP */ POP(a) break;
62 
-		case 0x03: /* NIP */ POP(a) POP(b) PUSH(a) break;
63 
-		case 0x04: /* SWP */ POP(a) POP(b) PUSH(a) PUSH(b) break;
64 
-		case 0x05: /* ROT */ POP(a) POP(b) POP(c) PUSH(b) PUSH(a) PUSH(c) break;
65 
-		case 0x06: /* DUP */ POP(a) PUSH(a) PUSH(a) break;
66 
-		case 0x07: /* OVR */ POP(a) POP(b) PUSH(b) PUSH(a) PUSH(b) break;
67 
-		case 0x08: /* EQU */ POP(a) POP(b) PUSH8(b == a) break;
68 
-		case 0x09: /* NEQ */ POP(a) POP(b) PUSH8(b != a) break;
69 
-		case 0x0a: /* GTH */ POP(a) POP(b) PUSH8(b > a) break;
70 
-		case 0x0b: /* LTH */ POP(a) POP(b) PUSH8(b < a) break;
71 
-		case 0x0c: /* JMP */ POP(a) JUMP(a) break;
72 
-		case 0x0d: /* JCN */ POP(a) POP8(b) if(b) JUMP(a) break;
73 
-		case 0x0e: /* JSR */ POP(a) s = (instr & 0x40) ? u->wst : u->rst; PUSH16(pc) JUMP(a) break;
74 
-		case 0x0f: /* STH */ POP(a) s = (instr & 0x40) ? u->wst : u->rst; PUSH(a) break;
75 
-		case 0x10: /* LDZ */ POP8(a) PEEK(b, a) PUSH(b) break;
76 
-		case 0x11: /* STZ */ POP8(a) POP(b) POKE(a, b) break;
77 
-		case 0x12: /* LDR */ POP8(a) PEEK(b, pc + (Sint8)a) PUSH(b) break;
78 
-		case 0x13: /* STR */ POP8(a) POP(b) POKE(pc + (Sint8)a, b) break;
79 
-		case 0x14: /* LDA */ POP16(a) PEEK(b, a) PUSH(b) break;
80 
-		case 0x15: /* STA */ POP16(a) POP(b) POKE(a, b) break;
81 
-		case 0x16: /* DEI */ POP8(a) DEVR(b, a) PUSH(b) break;
82 
-		case 0x17: /* DEO */ POP8(a) POP(b) DEVW(a, b) break;
83 
-		case 0x18: /* ADD */ POP(a) POP(b) PUSH(b + a) break;
84 
-		case 0x19: /* SUB */ POP(a) POP(b) PUSH(b - a) break;
85 
-		case 0x1a: /* MUL */ POP(a) POP(b) PUSH((Uint32)b * a) break;
86 
-		case 0x1b: /* DIV */ POP(a) POP(b) if(!a) HALT(3) PUSH(b / a) break;
87 
-		case 0x1c: /* AND */ POP(a) POP(b) PUSH(b & a) break;
88 
-		case 0x1d: /* ORA */ POP(a) POP(b) PUSH(b | a) break;
89 
-		case 0x1e: /* EOR */ POP(a) POP(b) PUSH(b ^ a) break;
90 
-		case 0x1f: /* SFT */ POP8(a) POP(b) PUSH(b >> (a & 0x0f) << ((a & 0xf0) >> 4)) break;
47 
+		ins = u->ram[pc++];
48 
+		k = !!(ins & 0x80);
49 
+		s = ins & 0x40 ? u->rst : u->wst;
50 
+		opc = !(ins & 0x1f) ? 0 - (ins >> 5) : ins & 0x3f;
51 
+		switch(opc) {
52 
+			/* IMM */
53 
+			case 0x00: /* BRK   */ return 1;
54 
+			case 0xff: /* JCI   */ pc += !!s->dat[--s->ptr] * PEEK16(u->ram + pc) + 2; break;
55 
+			case 0xfe: /* JMI   */ pc += PEEK16(u->ram + pc) + 2; break;
56 
+			case 0xfd: /* JSI   */ PUSH2(u->rst, pc + 2) pc += PEEK16(u->ram + pc) + 2; break;
57 
+			case 0xfc: /* LIT   */ PUSH(s, u->ram[pc++]) break;
58 
+			case 0xfb: /* LIT2  */ PUSH2(s, PEEK16(u->ram + pc)) pc += 2; break;
59 
+			case 0xfa: /* LITr  */ PUSH(s, u->ram[pc++]) break;
60 
+			case 0xf9: /* LIT2r */ PUSH2(s, PEEK16(u->ram + pc)) pc += 2; break;
61 
+			/* ALU */
62 
+			case 0x21: /* INC2 */ t=T2;           SET(2, 0) PUT2(0, t + 1) break;
63 
+			case 0x01: /* INC  */ t=T;            SET(1, 0) PUT(0, t + 1); break;
64 
+			case 0x22: /* POP2 */                 SET(2,-2) break;
65 
+			case 0x02: /* POP  */                 SET(1,-1) break;
66 
+			case 0x23: /* NIP2 */ t=T2;           SET(2,-2) PUT2(0, t) break;
67 
+			case 0x03: /* NIP  */ t=T;            SET(1,-1) PUT(0, t) break;
68 
+			case 0x24: /* SWP2 */ t=T2;n=N2;      SET(4, 0) PUT2(2, t) PUT2(0, n) break;
69 
+			case 0x04: /* SWP  */ t=T;n=N;        SET(2, 0) PUT(0, n) PUT(1, t) break;
70 
+			case 0x25: /* ROT2 */ t=T2;n=N2;l=L2; SET(6, 0) PUT2(0, l) PUT2(2, t) PUT2(4, n) break;
71 
+			case 0x05: /* ROT  */ t=T;n=N;l=L;    SET(3, 0) PUT(0, l) PUT(1, t) PUT(2, n) break;
72 
+			case 0x26: /* DUP2 */ t=T2;           SET(2, 2) PUT2(0, t) PUT2(2, t) break;
73 
+			case 0x06: /* DUP  */ t=T;            SET(1, 1) PUT(0, t) PUT(1, t) break;
74 
+			case 0x27: /* OVR2 */ t=T2;n=N2;      SET(4, 2) PUT2(0, n) PUT2(2, t) PUT2(4, n) break;
75 
+			case 0x07: /* OVR  */ t=T;n=N;        SET(2, 1) PUT(0, n) PUT(1, t) PUT(2, n) break;
76 
+			case 0x28: /* EQU2 */ t=T2;n=N2;      SET(4,-3) PUT(0, n == t) break;
77 
+			case 0x08: /* EQU  */ t=T;n=N;        SET(2,-1) PUT(0, n == t) break;
78 
+			case 0x29: /* NEQ2 */ t=T2;n=N2;      SET(4,-3) PUT(0, n != t) break;
79 
+			case 0x09: /* NEQ  */ t=T;n=N;        SET(2,-1) PUT(0, n != t) break;
80 
+			case 0x2a: /* GTH2 */ t=T2;n=N2;      SET(4,-3) PUT(0, n > t) break;
81 
+			case 0x0a: /* GTH  */ t=T;n=N;        SET(2,-1) PUT(0, n > t) break;
82 
+			case 0x2b: /* LTH2 */ t=T2;n=N2;      SET(4,-3) PUT(0, n < t) break;
83 
+			case 0x0b: /* LTH  */ t=T;n=N;        SET(2,-1) PUT(0, n < t) break;
84 
+			case 0x2c: /* JMP2 */ t=T2;           SET(2,-2) pc = t; break;
85 
+			case 0x0c: /* JMP  */ t=T;            SET(1,-1) pc += (Sint8)t; break;
86 
+			case 0x2d: /* JCN2 */ t=T2;n=L;       SET(3,-3) if(n) pc = t; break;
87 
+			case 0x0d: /* JCN  */ t=T;n=N;        SET(2,-2) pc += !!n * (Sint8)t; break;
88 
+			case 0x2e: /* JSR2 */ t=T2;           SET(2,-2) PUSH2(u->rst, pc) pc = t; break;
89 
+			case 0x0e: /* JSR  */ t=T;            SET(1,-1) PUSH2(u->rst, pc) pc += (Sint8)t; break;
90 
+			case 0x2f: /* STH2 */ t=T2;           SET(2,-2) PUSH2((ins & 0x40 ? u->wst : u->rst), t) break;
91 
+			case 0x0f: /* STH  */ t=T;            SET(1,-1) PUSH((ins & 0x40 ? u->wst : u->rst), t) break;
92 
+			case 0x30: /* LDZ2 */ t=T;            SET(1, 1) PUT2(0, PEEK16(u->ram + t)) break;
93 
+			case 0x10: /* LDZ  */ t=T;            SET(1, 0) PUT(0, u->ram[t]) break;
94 
+			case 0x31: /* STZ2 */ t=T;n=H2;       SET(3,-3) POKE16(u->ram + t, n) break;
95 
+			case 0x11: /* STZ  */ t=T;n=N;        SET(2,-2) u->ram[t] = n; break;
96 
+			case 0x32: /* LDR2 */ t=T;            SET(1, 1) PUT2(0, PEEK16(u->ram + pc + (Sint8)t)) break;
97 
+			case 0x12: /* LDR  */ t=T;            SET(1, 0) PUT(0, u->ram[pc + (Sint8)t]) break;
98 
+			case 0x33: /* STR2 */ t=T;n=H2;       SET(3,-3) POKE16(u->ram + pc + (Sint8)t, n) break;
99 
+			case 0x13: /* STR  */ t=T;n=N;        SET(2,-2) u->ram[pc + (Sint8)t] = n; break;
100 
+			case 0x34: /* LDA2 */ t=T2;           SET(2, 0) PUT2(0, PEEK16(u->ram + t)) break;
101 
+			case 0x14: /* LDA  */ t=T2;           SET(2,-1) PUT(0, u->ram[t]) break;
102 
+			case 0x35: /* STA2 */ t=T2;n=N2;      SET(4,-4) POKE16(u->ram + t, n) break;
103 
+			case 0x15: /* STA  */ t=T2;n=L;       SET(3,-3) u->ram[t] = n; break;
104 
+			case 0x36: /* DEI2 */ t=T;            SET(1, 1) DEI(1, t) DEI(0, t + 1) break;
105 
+			case 0x16: /* DEI  */ t=T;            SET(1, 0) DEI(0, t) break;
106 
+			case 0x37: /* DEO2 */ t=T;n=N;l=L;    SET(3,-3) DEO(t, l) DEO(t + 1, n) break;
107 
+			case 0x17: /* DEO  */ t=T;n=N;        SET(2,-2) DEO(t, n) break;
108 
+			case 0x38: /* ADD2 */ t=T2;n=N2;      SET(4,-2) PUT2(0, n + t) break;
109 
+			case 0x18: /* ADD  */ t=T;n=N;        SET(2,-1) PUT(0, n + t) break;
110 
+			case 0x39: /* SUB2 */ t=T2;n=N2;      SET(4,-2) PUT2(0, n - t) break;
111 
+			case 0x19: /* SUB  */ t=T;n=N;        SET(2,-1) PUT(0, n - t) break;
112 
+			case 0x3a: /* MUL2 */ t=T2;n=N2;      SET(4,-2) PUT2(0, n * t) break;
113 
+			case 0x1a: /* MUL  */ t=T;n=N;        SET(2,-1) PUT(0, n * t) break;
114 
+			case 0x3b: /* DIV2 */ t=T2;n=N2;      SET(4,-2) PUT2(0, n / t) break;
115 
+			case 0x1b: /* DIV  */ t=T;n=N;        SET(2,-1) PUT(0, n / t) break;
116 
+			case 0x3c: /* AND2 */ t=T2;n=N2;      SET(4,-2) PUT2(0, n & t) break;
117 
+			case 0x1c: /* AND  */ t=T;n=N;        SET(2,-1) PUT(0, n & t) break;
118 
+			case 0x3d: /* ORA2 */ t=T2;n=N2;      SET(4,-2) PUT2(0, n | t) break;
119 
+			case 0x1d: /* ORA  */ t=T;n=N;        SET(2,-1) PUT(0, n | t) break;
120 
+			case 0x3e: /* EOR2 */ t=T2;n=N2;      SET(4,-2) PUT2(0, n ^ t) break;
121 
+			case 0x1e: /* EOR  */ t=T;n=N;        SET(2,-1) PUT(0, n ^ t) break;
122 
+			case 0x3f: /* SFT2 */ t=T;n=H2;       SET(3,-1) PUT2(0, n >> (t & 0x0f) << (t >> 4)) break;
123 
+			case 0x1f: /* SFT  */ t=T;n=N;        SET(2,-1) PUT(0, n >> (t & 0x0f) << (t >> 4)) break;
91 124 
 		}
92 
-	}
125 
+	}
93 126 
 }
94 127
95 128 
 int
96 
-uxn_boot(Uxn *u, Uint8 *ram, Dei *dei, Deo *deo)
129 
+uxn_boot(Uxn *u, Uint8 *ram)
97 130 
 {
98 131 
 	Uint32 i;
99 132 
 	char *cptr = (char *)u;
... ... 
@@ -103,7 +136,5 @@ uxn_boot(Uxn *u, Uint8 *ram, Dei *dei, Deo *deo)
103 136 
 	u->rst = (Stack *)(ram + 0xf0100);
104 137 
 	u->dev = (Uint8 *)(ram + 0xf0200);
105 138 
 	u->ram = ram;
106 
-	u->dei = dei;
107 
-	u->deo = deo;
108 139 
 	return 1;
109 140 
 }