...
|
...
|
@@ -30,71 +30,25 @@ static void (*devw)(Device *d, Uint8 a, Uint16 b);
|
30
|
30
|
static Uint16 (*devr)(Device *d, Uint8 a);
|
31
|
31
|
static void (*warp)(Uxn *u, Uint16 a);
|
32
|
32
|
static void (*pull)(Uxn *u);
|
33
|
|
-
|
|
33
|
+/* byte mode */
|
34
|
34
|
static void push8(Stack *s, Uint16 a) { if(s->ptr == 0xff) { s->error = 2; return; } s->dat[s->ptr++] = a; }
|
35
|
|
-static Uint16 pop8_keep(Stack *s) { if(s->kptr == 0) { s->error = 1; return 0; } return s->dat[--s->kptr]; }
|
36
|
|
-static Uint16 pop8_nokeep(Stack *s) { if(s->ptr == 0) { s->error = 1; return 0; } return s->dat[--s->ptr]; }
|
|
35
|
+static Uint16 pop8k(Stack *s) { if(s->kptr == 0) { s->error = 1; return 0; } return s->dat[--s->kptr]; }
|
|
36
|
+static Uint16 pop8d(Stack *s) { if(s->ptr == 0) { s->error = 1; return 0; } return s->dat[--s->ptr]; }
|
37
|
37
|
static void poke8(Uint8 *m, Uint16 a, Uint16 b) { m[a] = b; }
|
38
|
38
|
static Uint16 peek8(Uint8 *m, Uint16 a) { return m[a]; }
|
39
|
39
|
static void devw8(Device *d, Uint8 a, Uint16 b) { d->dat[a & 0xf] = b; d->talk(d, a & 0x0f, 1); }
|
40
|
40
|
static Uint16 devr8(Device *d, Uint8 a) { d->talk(d, a & 0x0f, 0); return d->dat[a & 0xf]; }
|
41
|
|
-static void warp8(Uxn *u, Uint16 a){ u->ram.ptr += (Sint8)a; }
|
42
|
|
-static void pull8(Uxn *u){ push8(u->src, peek8(u->ram.dat, u->ram.ptr++)); }
|
43
|
|
-
|
44
|
|
-void poke16(Uint8 *m, Uint16 a, Uint16 b) { poke8(m, a, b >> 8); poke8(m, a + 1, b); }
|
45
|
|
-Uint16 peek16(Uint8 *m, Uint16 a) { return (peek8(m, a) << 8) + peek8(m, a + 1); }
|
|
41
|
+static void warp8(Uxn *u, Uint16 a){ u->ram.ptr += (Sint8)a; }
|
|
42
|
+static void pull8(Uxn *u){ push8(u->src, peek8(u->ram.dat, u->ram.ptr++)); }
|
|
43
|
+/* short mode */
|
|
44
|
+void poke16(Uint8 *m, Uint16 a, Uint16 b) { poke8(m, a, b >> 8); poke8(m, a + 1, b); }
|
|
45
|
+Uint16 peek16(Uint8 *m, Uint16 a) { return (peek8(m, a) << 8) + peek8(m, a + 1); }
|
46
|
46
|
static void push16(Stack *s, Uint16 a) { push8(s, a >> 8); push8(s, a); }
|
47
|
47
|
static Uint16 pop16(Stack *s) { Uint8 a = pop8(s), b = pop8(s); return a + (b << 8); }
|
48
|
48
|
static void devw16(Device *d, Uint8 a, Uint16 b) { devw8(d, a, b >> 8); devw8(d, a + 1, b); }
|
49
|
49
|
static Uint16 devr16(Device *d, Uint8 a) { return (devr8(d, a) << 8) + devr8(d, a + 1); }
|
50
|
|
-static void warp16(Uxn *u, Uint16 a){ u->ram.ptr = a; }
|
51
|
|
-static void pull16(Uxn *u){ push16(u->src, peek16(u->ram.dat, u->ram.ptr++)); u->ram.ptr++; }
|
52
|
|
-
|
53
|
|
-/* Stack */
|
54
|
|
-static void op_lit(Uxn *u) { pull(u); }
|
55
|
|
-static void op_inc(Uxn *u) { Uint16 a = pop(u->src); push(u->src, a + 1); }
|
56
|
|
-static void op_pop(Uxn *u) { pop(u->src); }
|
57
|
|
-static void op_dup(Uxn *u) { Uint16 a = pop(u->src); push(u->src, a); push(u->src, a); }
|
58
|
|
-static void op_nip(Uxn *u) { Uint16 a = pop(u->src); pop(u->src); push(u->src, a); }
|
59
|
|
-static void op_swp(Uxn *u) { Uint16 a = pop(u->src), b = pop(u->src); push(u->src, a); push(u->src, b); }
|
60
|
|
-static void op_ovr(Uxn *u) { Uint16 a = pop(u->src), b = pop(u->src); push(u->src, b); push(u->src, a); push(u->src, b); }
|
61
|
|
-static void op_rot(Uxn *u) { Uint16 a = pop(u->src), b = pop(u->src), c = pop(u->src); push(u->src, b); push(u->src, a); push(u->src, c); }
|
62
|
|
-/* Logic */
|
63
|
|
-static void op_equ(Uxn *u) { Uint16 a = pop(u->src), b = pop(u->src); push8(u->src, b == a); }
|
64
|
|
-static void op_neq(Uxn *u) { Uint16 a = pop(u->src), b = pop(u->src); push8(u->src, b != a); }
|
65
|
|
-static void op_gth(Uxn *u) { Uint16 a = pop(u->src), b = pop(u->src); push8(u->src, b > a); }
|
66
|
|
-static void op_lth(Uxn *u) { Uint16 a = pop(u->src), b = pop(u->src); push8(u->src, b < a); }
|
67
|
|
-static void op_jmp(Uxn *u) { Uint16 a = pop(u->src); warp(u, a); }
|
68
|
|
-static void op_jnz(Uxn *u) { Uint16 a = pop(u->src); if(pop8(u->src)) warp(u, a); }
|
69
|
|
-static void op_jsr(Uxn *u) { Uint16 a = pop(u->src); push16(u->dst, u->ram.ptr); warp(u, a); }
|
70
|
|
-static void op_sth(Uxn *u) { Uint16 a = pop(u->src); push(u->dst, a); }
|
71
|
|
-/* Memory */
|
72
|
|
-static void op_ldz(Uxn *u) { Uint8 a = pop8(u->src); push(u->src, peek(u->ram.dat, a)); }
|
73
|
|
-static void op_stz(Uxn *u) { Uint8 a = pop8(u->src); Uint16 b = pop(u->src); poke(u->ram.dat, a, b); }
|
74
|
|
-static void op_ldr(Uxn *u) { Uint8 a = pop8(u->src); push(u->src, peek(u->ram.dat, u->ram.ptr + (Sint8)a)); }
|
75
|
|
-static void op_str(Uxn *u) { Uint8 a = pop8(u->src); Uint8 b = pop(u->src); poke(u->ram.dat, u->ram.ptr + (Sint8)a, b); }
|
76
|
|
-static void op_lda(Uxn *u) { Uint16 a = pop16(u->src); push(u->src, peek(u->ram.dat, a)); }
|
77
|
|
-static void op_sta(Uxn *u) { Uint16 a = pop16(u->src); Uint16 b = pop(u->src); poke(u->ram.dat, a, b); }
|
78
|
|
-static void op_dei(Uxn *u) { Uint8 a = pop8(u->src); push(u->src, devr(&u->dev[a >> 4], a)); }
|
79
|
|
-static void op_deo(Uxn *u) { Uint8 a = pop8(u->src); Uint16 b = pop(u->src); devw(&u->dev[a >> 4], a, b); }
|
80
|
|
-/* Arithmetic */
|
81
|
|
-static void op_add(Uxn *u) { Uint16 a = pop(u->src), b = pop(u->src); push(u->src, b + a); }
|
82
|
|
-static void op_sub(Uxn *u) { Uint16 a = pop(u->src), b = pop(u->src); push(u->src, b - a); }
|
83
|
|
-static void op_mul(Uxn *u) { Uint16 a = pop(u->src), b = pop(u->src); push(u->src, b * a); }
|
84
|
|
-static void op_div(Uxn *u) { Uint16 a = pop(u->src), b = pop(u->src); if(a == 0) { u->src->error = 3; a = 1; } push(u->src, b / a); }
|
85
|
|
-static void op_and(Uxn *u) { Uint16 a = pop(u->src), b = pop(u->src); push(u->src, b & a); }
|
86
|
|
-static void op_ora(Uxn *u) { Uint16 a = pop(u->src), b = pop(u->src); push(u->src, b | a); }
|
87
|
|
-static void op_eor(Uxn *u) { Uint16 a = pop(u->src), b = pop(u->src); push(u->src, b ^ a); }
|
88
|
|
-static void op_sft(Uxn *u) { Uint16 a = pop8(u->src), b = pop(u->src); push(u->src, b >> (a & 0x07) << ((a & 0x70) >> 4)); }
|
89
|
|
-
|
90
|
|
-static void (*ops[])(Uxn *u) = {
|
91
|
|
- op_lit, op_inc, op_pop, op_dup, op_nip, op_swp, op_ovr, op_rot,
|
92
|
|
- op_equ, op_neq, op_gth, op_lth, op_jmp, op_jnz, op_jsr, op_sth,
|
93
|
|
- op_ldz, op_stz, op_ldr, op_str, op_lda, op_sta, op_dei, op_deo,
|
94
|
|
- op_add, op_sub, op_mul, op_div, op_and, op_ora, op_eor, op_sft,
|
95
|
|
-};
|
96
|
|
-
|
97
|
|
-/* clang-format on */
|
|
50
|
+static void warp16(Uxn *u, Uint16 a){ u->ram.ptr = a; }
|
|
51
|
+static void pull16(Uxn *u){ push16(u->src, peek16(u->ram.dat, u->ram.ptr++)); u->ram.ptr++; }
|
98
|
52
|
|
99
|
53
|
#pragma mark - Core
|
100
|
54
|
|
...
|
...
|
@@ -102,6 +56,7 @@ int
|
102
|
56
|
uxn_eval(Uxn *u, Uint16 vec)
|
103
|
57
|
{
|
104
|
58
|
Uint8 instr;
|
|
59
|
+ Uint16 a,b,c;
|
105
|
60
|
if(!vec || u->dev[0].dat[0xf])
|
106
|
61
|
return 0;
|
107
|
62
|
u->ram.ptr = vec;
|
...
|
...
|
@@ -109,40 +64,69 @@ uxn_eval(Uxn *u, Uint16 vec)
|
109
|
64
|
while((instr = u->ram.dat[u->ram.ptr++])) {
|
110
|
65
|
/* Return Mode */
|
111
|
66
|
if(instr & MODE_RETURN) {
|
112
|
|
- u->src = &u->rst;
|
|
67
|
+ u->src = &u->rst;
|
113
|
68
|
u->dst = &u->wst;
|
114
|
69
|
} else {
|
115
|
|
- u->src = &u->wst;
|
|
70
|
+ u->src = &u->wst;
|
116
|
71
|
u->dst = &u->rst;
|
117
|
72
|
}
|
118
|
73
|
/* Keep Mode */
|
119
|
74
|
if(instr & MODE_KEEP) {
|
120
|
|
- pop8 = pop8_keep;
|
|
75
|
+ pop8 = pop8k;
|
121
|
76
|
u->src->kptr = u->src->ptr;
|
122
|
77
|
} else {
|
123
|
|
- pop8 = pop8_nokeep;
|
|
78
|
+ pop8 = pop8d;
|
124
|
79
|
}
|
125
|
80
|
/* Short Mode */
|
126
|
81
|
if(instr & MODE_SHORT) {
|
127
|
|
- pop = pop16;
|
128
|
|
- push = push16;
|
129
|
|
- peek = peek16;
|
130
|
|
- poke = poke16;
|
131
|
|
- devr = devr16;
|
132
|
|
- devw = devw16;
|
133
|
|
- warp = warp16;
|
134
|
|
- pull = pull16;
|
|
82
|
+ push = push16; pop = pop16;
|
|
83
|
+ poke = poke16; peek = peek16;
|
|
84
|
+ devw = devw16; devr = devr16;
|
|
85
|
+ warp = warp16; pull = pull16;
|
135
|
86
|
} else {
|
136
|
|
- pop = pop8;
|
137
|
|
- push = push8;
|
138
|
|
- peek = peek8;
|
139
|
|
- poke = poke8;
|
140
|
|
- devr = devr8;
|
141
|
|
- devw = devw8;
|
142
|
|
- warp = warp8;
|
143
|
|
- pull = pull8;
|
|
87
|
+ push = push8; pop = pop8;
|
|
88
|
+ poke = poke8; peek = peek8;
|
|
89
|
+ devw = devw8; devr = devr8;
|
|
90
|
+ warp = warp8; pull = pull8;
|
|
91
|
+ }
|
|
92
|
+ switch(instr & 0x1f){
|
|
93
|
+ /* Stack */
|
|
94
|
+ case 0x00: /* LIT */ pull(u); break;
|
|
95
|
+ case 0x01: /* INC */ a = pop(u->src); push(u->src, a + 1); break;
|
|
96
|
+ case 0x02: /* POP */ pop(u->src); break;
|
|
97
|
+ case 0x03: /* DUP */ a = pop(u->src); push(u->src, a); push(u->src, a); break;
|
|
98
|
+ case 0x04: /* NIP */ a = pop(u->src); pop(u->src); push(u->src, a); break;
|
|
99
|
+ case 0x05: /* SWP */ a = pop(u->src), b = pop(u->src); push(u->src, a); push(u->src, b); break;
|
|
100
|
+ case 0x06: /* OVR */ a = pop(u->src), b = pop(u->src); push(u->src, b); push(u->src, a); push(u->src, b); break;
|
|
101
|
+ case 0x07: /* ROT */ a = pop(u->src), b = pop(u->src), c = pop(u->src); push(u->src, b); push(u->src, a); push(u->src, c); break;
|
|
102
|
+ /* Logic */
|
|
103
|
+ case 0x08: /* EQU */ a = pop(u->src), b = pop(u->src); push8(u->src, b == a); break;
|
|
104
|
+ case 0x09: /* NEQ */ a = pop(u->src), b = pop(u->src); push8(u->src, b != a); break;
|
|
105
|
+ case 0x0a: /* GTH */ a = pop(u->src), b = pop(u->src); push8(u->src, b > a); break;
|
|
106
|
+ case 0x0b: /* LTH */ a = pop(u->src), b = pop(u->src); push8(u->src, b < a); break;
|
|
107
|
+ case 0x0c: /* JMP */ a = pop(u->src); warp(u, a); break;
|
|
108
|
+ case 0x0d: /* JNZ */ a = pop(u->src); if(pop8(u->src)) warp(u, a); break;
|
|
109
|
+ case 0x0e: /* JSR */ a = pop(u->src); push16(u->dst, u->ram.ptr); warp(u, a); break;
|
|
110
|
+ case 0x0f: /* STH */ a = pop(u->src); push(u->dst, a); break;
|
|
111
|
+ /* Memory */
|
|
112
|
+ case 0x10: /* LDZ */ a = pop8(u->src); push(u->src, peek(u->ram.dat, a)); break;
|
|
113
|
+ case 0x11: /* STZ */ a = pop8(u->src); b = pop(u->src); poke(u->ram.dat, a, b); break;
|
|
114
|
+ case 0x12: /* LDR */ a = pop8(u->src); push(u->src, peek(u->ram.dat, u->ram.ptr + (Sint8)a)); break;
|
|
115
|
+ case 0x13: /* STR */ a = pop8(u->src); b = pop(u->src); poke(u->ram.dat, u->ram.ptr + (Sint8)a, b); break;
|
|
116
|
+ case 0x14: /* LDA */ a = pop16(u->src); push(u->src, peek(u->ram.dat, a)); break;
|
|
117
|
+ case 0x15: /* STA */ a = pop16(u->src); b = pop(u->src); poke(u->ram.dat, a, b); break;
|
|
118
|
+ case 0x16: /* DEI */ a = pop8(u->src); push(u->src, devr(&u->dev[a >> 4], a)); break;
|
|
119
|
+ case 0x17: /* DEO */ a = pop8(u->src); b = pop(u->src); devw(&u->dev[a >> 4], a, b); break;
|
|
120
|
+ /* Arithmetic */
|
|
121
|
+ case 0x18: /* ADD */ a = pop(u->src), b = pop(u->src); push(u->src, b + a); break;
|
|
122
|
+ case 0x19: /* SUB */ a = pop(u->src), b = pop(u->src); push(u->src, b - a); break;
|
|
123
|
+ case 0x1a: /* MUL */ a = pop(u->src), b = pop(u->src); push(u->src, b * a); break;
|
|
124
|
+ case 0x1b: /* DIV */ a = pop(u->src), b = pop(u->src); if(a == 0) { u->src->error = 3; a = 1; } push(u->src, b / a); break;
|
|
125
|
+ case 0x1c: /* AND */ a = pop(u->src), b = pop(u->src); push(u->src, b & a); break;
|
|
126
|
+ case 0x1d: /* ORA */ a = pop(u->src), b = pop(u->src); push(u->src, b | a); break;
|
|
127
|
+ case 0x1e: /* EOR */ a = pop(u->src), b = pop(u->src); push(u->src, b ^ a); break;
|
|
128
|
+ case 0x1f: /* SFT */ a = pop8(u->src), b = pop(u->src); push(u->src, b >> (a & 0x07) << ((a & 0x70) >> 4)); break;
|
144
|
129
|
}
|
145
|
|
- (*ops[instr & 0x1f])(u);
|
146
|
130
|
if(u->wst.error)
|
147
|
131
|
return uxn_halt(u, u->wst.error, "Working-stack", instr);
|
148
|
132
|
if(u->rst.error)
|
...
|
...
|
@@ -151,6 +135,8 @@ uxn_eval(Uxn *u, Uint16 vec)
|
151
|
135
|
return 1;
|
152
|
136
|
}
|
153
|
137
|
|
|
138
|
+/* clang-format on */
|
|
139
|
+
|
154
|
140
|
int
|
155
|
141
|
uxn_boot(Uxn *u)
|
156
|
142
|
{
|