Temporarily override uxn.c with fast until I can port the devices macros
This commit is contained in:
Devine Lu Linvega
parent
8420c81d52
commit
13ab0e5d95
175
src/uxn.c
175
src/uxn.c
|
|
@ -11,89 +11,122 @@ THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
|
||||||
WITH REGARD TO THIS SOFTWARE.
|
WITH REGARD TO THIS SOFTWARE.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
/* a,b,c: general use. m2: byte/short mode flag.
|
#define T s->dat[s->ptr-1]
|
||||||
tsp: macro temp stack ptr. ksp: "keep" mode copy of stack ptr. sp: ptr to stack ptr.
|
#define N s->dat[s->ptr-2]
|
||||||
x,y: macro in params. o: macro out param. */
|
#define L s->dat[s->ptr-3]
|
||||||
|
#define H2 PEEK16(s->dat+s->ptr-3)
|
||||||
|
#define T2 PEEK16(s->dat+s->ptr-2)
|
||||||
|
#define N2 PEEK16(s->dat+s->ptr-4)
|
||||||
|
#define L2 PEEK16(s->dat+s->ptr-6)
|
||||||
|
|
||||||
#define HALT(c) { return uxn_halt(u, instr, (c), pc - 1); }
|
/* Registers
|
||||||
#define JUMP(x) { if(m2) pc = (x); else pc += (Sint8)(x); }
|
|
||||||
#define PUSH8(x) { if(s->ptr == 0xff) HALT(2) s->dat[s->ptr++] = (x); }
|
[ . ][ . ][ . ][ L ][ N ][ T ] <
|
||||||
#define PUSH16(x) { if((tsp = s->ptr) >= 0xfe) HALT(2) t = (x); POKE16(&s->dat[tsp], t); s->ptr = tsp + 2; }
|
[ . ][ . ][ . ][ H2 ][ T ] <
|
||||||
#define PUSH(x) { if(m2) { PUSH16(x) } else { PUSH8(x) } }
|
[ L2 ][ N2 ][ T2 ] <
|
||||||
#define POP8(o) { if(*sp == 0x00) HALT(1) o = s->dat[--*sp]; }
|
|
||||||
#define POP16(o) { if((tsp = *sp) <= 0x01) HALT(1) o = PEEK16(&s->dat[tsp - 2]); *sp = tsp - 2; }
|
*/
|
||||||
#define POP(o) { if(m2) { POP16(o) } else { POP8(o) } }
|
|
||||||
#define POKE(x, y) { if(m2) { t = (y); POKE16(u->ram + x, t) } else { u->ram[(x)] = (y); } }
|
#define HALT(c) { return uxn_halt(u, ins, (c), pc - 1); }
|
||||||
#define PEEK(o, x) { if(m2) { o = PEEK16(u->ram + x); } else o = u->ram[(x)]; }
|
#define SET(mul, add) { if(mul > s->ptr) HALT(1) s->ptr += k * mul + add; if(s->ptr > 254) HALT(2) }
|
||||||
#define DEVR(o, x) { o = u->dei(u, x); if(m2) o = (o << 8) | u->dei(u, (x) + 1); }
|
#define PUT(o, v) { s->dat[s->ptr - o - 1] = (v); }
|
||||||
#define DEVW(x, y) { if(m2) { u->deo(u, (x), (y) >> 8); u->deo(u, (x) + 1, (y)); } else { u->deo(u, x, (y)); } }
|
#define PUT2(o, v) { tmp = (v); s->dat[s->ptr - o - 2] = tmp >> 8; s->dat[s->ptr - o - 1] = tmp; }
|
||||||
|
#define PUSH(stack, v) { if(s->ptr > 254) HALT(2) stack->dat[stack->ptr++] = (v); }
|
||||||
|
#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; }
|
||||||
|
#define DEO(a, b) { u->dev[a] = b; if((deo_mask[(a) >> 4] >> ((a) & 0xf)) & 0x1) uxn_deo(u, a); }
|
||||||
|
#define DEI(a, b) { PUT(a, ((dei_mask[(b) >> 4] >> ((b) & 0xf)) & 0x1) ? uxn_dei(u, b) : u->dev[b]) }
|
||||||
|
|
||||||
int
|
int
|
||||||
uxn_eval(Uxn *u, Uint16 pc)
|
uxn_eval(Uxn *u, Uint16 pc)
|
||||||
{
|
{
|
||||||
Uint8 instr, opcode, m2, ksp, tsp, *sp;
|
Uint8 ins, opc, k;
|
||||||
Uint16 a, b, c, t;
|
Uint16 t, n, l, tmp;
|
||||||
Stack *s;
|
Stack *s;
|
||||||
if(!pc || u->dev[0x0f]) return 0;
|
if(!pc || u->dev[0x0f]) return 0;
|
||||||
for(;;) {
|
for(;;) {
|
||||||
instr = u->ram[pc++];
|
ins = u->ram[pc++];
|
||||||
opcode = instr & 0x1f;
|
k = !!(ins & 0x80);
|
||||||
/* Short Mode */
|
s = ins & 0x40 ? u->rst : u->wst;
|
||||||
m2 = instr & 0x20;
|
opc = !(ins & 0x1f) ? 0 - (ins >> 5) : ins & 0x3f;
|
||||||
/* Return Mode */
|
switch(opc) {
|
||||||
s = instr & 0x40 ? u->rst : u->wst;
|
/* IMM */
|
||||||
/* Keep Mode */
|
case 0x00: /* BRK */ return 1;
|
||||||
if(instr & 0x80) { ksp = s->ptr; sp = &ksp; }
|
case 0xff: /* JCI */ pc += !!s->dat[--s->ptr] * PEEK16(u->ram + pc) + 2; break;
|
||||||
else sp = &s->ptr;
|
case 0xfe: /* JMI */ pc += PEEK16(u->ram + pc) + 2; break;
|
||||||
/* Opcodes */
|
case 0xfd: /* JSI */ PUSH2(u->rst, pc + 2) pc += PEEK16(u->ram + pc) + 2; break;
|
||||||
switch(opcode - (!opcode * (instr >> 5))) {
|
case 0xfc: /* LIT */ PUSH(s, u->ram[pc++]) break;
|
||||||
/* Immediate */
|
case 0xfb: /* LIT2 */ PUSH2(s, PEEK16(u->ram + pc)) pc += 2; break;
|
||||||
case -0x0: /* BRK */ return 1;
|
case 0xfa: /* LITr */ PUSH(s, u->ram[pc++]) break;
|
||||||
case -0x1: /* JCI */ POP8(b) if(!b) { pc += 2; break; } /* else fallthrough */
|
case 0xf9: /* LIT2r */ PUSH2(s, PEEK16(u->ram + pc)) pc += 2; break;
|
||||||
case -0x2: /* JMI */ pc += PEEK16(u->ram + pc) + 2; break;
|
/* ALU */
|
||||||
case -0x3: /* JSI */ s = u->rst; PUSH16(pc + 2) pc += PEEK16(u->ram + pc) + 2; break;
|
case 0x21: /* INC2 */ t=T2; SET(2, 0) PUT2(0, t + 1) break;
|
||||||
case -0x4: /* LIT */
|
case 0x01: /* INC */ t=T; SET(1, 0) PUT(0, t + 1); break;
|
||||||
case -0x6: /* LITr */ a = u->ram[pc++]; PUSH8(a) break;
|
case 0x22: /* POP2 */ SET(2,-2) break;
|
||||||
case -0x5: /* LIT2 */
|
case 0x02: /* POP */ SET(1,-1) break;
|
||||||
case -0x7: /* LIT2r */ PUSH16(PEEK16(u->ram + pc)) pc += 2; break;
|
case 0x23: /* NIP2 */ t=T2; SET(2,-2) PUT2(0, t) break;
|
||||||
/* ALU */
|
case 0x03: /* NIP */ t=T; SET(1,-1) PUT(0, t) break;
|
||||||
case 0x01: /* INC */ POP(a) PUSH(a + 1) break;
|
case 0x24: /* SWP2 */ t=T2;n=N2; SET(4, 0) PUT2(2, t) PUT2(0, n) break;
|
||||||
case 0x02: /* POP */ POP(a) break;
|
case 0x04: /* SWP */ t=T;n=N; SET(2, 0) PUT(0, n) PUT(1, t) break;
|
||||||
case 0x03: /* NIP */ POP(a) POP(b) PUSH(a) break;
|
case 0x25: /* ROT2 */ t=T2;n=N2;l=L2; SET(6, 0) PUT2(0, l) PUT2(2, t) PUT2(4, n) break;
|
||||||
case 0x04: /* SWP */ POP(a) POP(b) PUSH(a) PUSH(b) break;
|
case 0x05: /* ROT */ t=T;n=N;l=L; SET(3, 0) PUT(0, l) PUT(1, t) PUT(2, n) break;
|
||||||
case 0x05: /* ROT */ POP(a) POP(b) POP(c) PUSH(b) PUSH(a) PUSH(c) break;
|
case 0x26: /* DUP2 */ t=T2; SET(2, 2) PUT2(0, t) PUT2(2, t) break;
|
||||||
case 0x06: /* DUP */ POP(a) PUSH(a) PUSH(a) break;
|
case 0x06: /* DUP */ t=T; SET(1, 1) PUT(0, t) PUT(1, t) break;
|
||||||
case 0x07: /* OVR */ POP(a) POP(b) PUSH(b) PUSH(a) PUSH(b) break;
|
case 0x27: /* OVR2 */ t=T2;n=N2; SET(4, 2) PUT2(0, n) PUT2(2, t) PUT2(4, n) break;
|
||||||
case 0x08: /* EQU */ POP(a) POP(b) PUSH8(b == a) break;
|
case 0x07: /* OVR */ t=T;n=N; SET(2, 1) PUT(0, n) PUT(1, t) PUT(2, n) break;
|
||||||
case 0x09: /* NEQ */ POP(a) POP(b) PUSH8(b != a) break;
|
case 0x28: /* EQU2 */ t=T2;n=N2; SET(4,-3) PUT(0, n == t) break;
|
||||||
case 0x0a: /* GTH */ POP(a) POP(b) PUSH8(b > a) break;
|
case 0x08: /* EQU */ t=T;n=N; SET(2,-1) PUT(0, n == t) break;
|
||||||
case 0x0b: /* LTH */ POP(a) POP(b) PUSH8(b < a) break;
|
case 0x29: /* NEQ2 */ t=T2;n=N2; SET(4,-3) PUT(0, n != t) break;
|
||||||
case 0x0c: /* JMP */ POP(a) JUMP(a) break;
|
case 0x09: /* NEQ */ t=T;n=N; SET(2,-1) PUT(0, n != t) break;
|
||||||
case 0x0d: /* JCN */ POP(a) POP8(b) if(b) JUMP(a) break;
|
case 0x2a: /* GTH2 */ t=T2;n=N2; SET(4,-3) PUT(0, n > t) break;
|
||||||
case 0x0e: /* JSR */ POP(a) s = (instr & 0x40) ? u->wst : u->rst; PUSH16(pc) JUMP(a) break;
|
case 0x0a: /* GTH */ t=T;n=N; SET(2,-1) PUT(0, n > t) break;
|
||||||
case 0x0f: /* STH */ POP(a) s = (instr & 0x40) ? u->wst : u->rst; PUSH(a) break;
|
case 0x2b: /* LTH2 */ t=T2;n=N2; SET(4,-3) PUT(0, n < t) break;
|
||||||
case 0x10: /* LDZ */ POP8(a) PEEK(b, a) PUSH(b) break;
|
case 0x0b: /* LTH */ t=T;n=N; SET(2,-1) PUT(0, n < t) break;
|
||||||
case 0x11: /* STZ */ POP8(a) POP(b) POKE(a, b) break;
|
case 0x2c: /* JMP2 */ t=T2; SET(2,-2) pc = t; break;
|
||||||
case 0x12: /* LDR */ POP8(a) PEEK(b, pc + (Sint8)a) PUSH(b) break;
|
case 0x0c: /* JMP */ t=T; SET(1,-1) pc += (Sint8)t; break;
|
||||||
case 0x13: /* STR */ POP8(a) POP(b) POKE(pc + (Sint8)a, b) break;
|
case 0x2d: /* JCN2 */ t=T2;n=L; SET(3,-3) if(n) pc = t; break;
|
||||||
case 0x14: /* LDA */ POP16(a) PEEK(b, a) PUSH(b) break;
|
case 0x0d: /* JCN */ t=T;n=N; SET(2,-2) pc += !!n * (Sint8)t; break;
|
||||||
case 0x15: /* STA */ POP16(a) POP(b) POKE(a, b) break;
|
case 0x2e: /* JSR2 */ t=T2; SET(2,-2) PUSH2(u->rst, pc) pc = t; break;
|
||||||
case 0x16: /* DEI */ POP8(a) DEVR(b, a) PUSH(b) break;
|
case 0x0e: /* JSR */ t=T; SET(1,-1) PUSH2(u->rst, pc) pc += (Sint8)t; break;
|
||||||
case 0x17: /* DEO */ POP8(a) POP(b) DEVW(a, b) break;
|
case 0x2f: /* STH2 */ t=T2; SET(2,-2) PUSH2((ins & 0x40 ? u->wst : u->rst), t) break;
|
||||||
case 0x18: /* ADD */ POP(a) POP(b) PUSH(b + a) break;
|
case 0x0f: /* STH */ t=T; SET(1,-1) PUSH((ins & 0x40 ? u->wst : u->rst), t) break;
|
||||||
case 0x19: /* SUB */ POP(a) POP(b) PUSH(b - a) break;
|
case 0x30: /* LDZ2 */ t=T; SET(1, 1) PUT2(0, PEEK16(u->ram + t)) break;
|
||||||
case 0x1a: /* MUL */ POP(a) POP(b) PUSH((Uint32)b * a) break;
|
case 0x10: /* LDZ */ t=T; SET(1, 0) PUT(0, u->ram[t]) break;
|
||||||
case 0x1b: /* DIV */ POP(a) POP(b) if(!a) HALT(3) PUSH(b / a) break;
|
case 0x31: /* STZ2 */ t=T;n=H2; SET(3,-3) POKE16(u->ram + t, n) break;
|
||||||
case 0x1c: /* AND */ POP(a) POP(b) PUSH(b & a) break;
|
case 0x11: /* STZ */ t=T;n=N; SET(2,-2) u->ram[t] = n; break;
|
||||||
case 0x1d: /* ORA */ POP(a) POP(b) PUSH(b | a) break;
|
case 0x32: /* LDR2 */ t=T; SET(1, 1) PUT2(0, PEEK16(u->ram + pc + (Sint8)t)) break;
|
||||||
case 0x1e: /* EOR */ POP(a) POP(b) PUSH(b ^ a) break;
|
case 0x12: /* LDR */ t=T; SET(1, 0) PUT(0, u->ram[pc + (Sint8)t]) break;
|
||||||
case 0x1f: /* SFT */ POP8(a) POP(b) PUSH(b >> (a & 0x0f) << ((a & 0xf0) >> 4)) break;
|
case 0x33: /* STR2 */ t=T;n=H2; SET(3,-3) POKE16(u->ram + pc + (Sint8)t, n) break;
|
||||||
|
case 0x13: /* STR */ t=T;n=N; SET(2,-2) u->ram[pc + (Sint8)t] = n; break;
|
||||||
|
case 0x34: /* LDA2 */ t=T2; SET(2, 0) PUT2(0, PEEK16(u->ram + t)) break;
|
||||||
|
case 0x14: /* LDA */ t=T2; SET(2,-1) PUT(0, u->ram[t]) break;
|
||||||
|
case 0x35: /* STA2 */ t=T2;n=N2; SET(4,-4) POKE16(u->ram + t, n) break;
|
||||||
|
case 0x15: /* STA */ t=T2;n=L; SET(3,-3) u->ram[t] = n; break;
|
||||||
|
case 0x36: /* DEI2 */ t=T; SET(1, 1) DEI(1, t) DEI(0, t + 1) break;
|
||||||
|
case 0x16: /* DEI */ t=T; SET(1, 0) DEI(0, t) break;
|
||||||
|
case 0x37: /* DEO2 */ t=T;n=N;l=L; SET(3,-3) DEO(t, l) DEO(t + 1, n) break;
|
||||||
|
case 0x17: /* DEO */ t=T;n=N; SET(2,-2) DEO(t, n) break;
|
||||||
|
case 0x38: /* ADD2 */ t=T2;n=N2; SET(4,-2) PUT2(0, n + t) break;
|
||||||
|
case 0x18: /* ADD */ t=T;n=N; SET(2,-1) PUT(0, n + t) break;
|
||||||
|
case 0x39: /* SUB2 */ t=T2;n=N2; SET(4,-2) PUT2(0, n - t) break;
|
||||||
|
case 0x19: /* SUB */ t=T;n=N; SET(2,-1) PUT(0, n - t) break;
|
||||||
|
case 0x3a: /* MUL2 */ t=T2;n=N2; SET(4,-2) PUT2(0, n * t) break;
|
||||||
|
case 0x1a: /* MUL */ t=T;n=N; SET(2,-1) PUT(0, n * t) break;
|
||||||
|
case 0x3b: /* DIV2 */ t=T2;n=N2; SET(4,-2) PUT2(0, n / t) break;
|
||||||
|
case 0x1b: /* DIV */ t=T;n=N; SET(2,-1) PUT(0, n / t) break;
|
||||||
|
case 0x3c: /* AND2 */ t=T2;n=N2; SET(4,-2) PUT2(0, n & t) break;
|
||||||
|
case 0x1c: /* AND */ t=T;n=N; SET(2,-1) PUT(0, n & t) break;
|
||||||
|
case 0x3d: /* ORA2 */ t=T2;n=N2; SET(4,-2) PUT2(0, n | t) break;
|
||||||
|
case 0x1d: /* ORA */ t=T;n=N; SET(2,-1) PUT(0, n | t) break;
|
||||||
|
case 0x3e: /* EOR2 */ t=T2;n=N2; SET(4,-2) PUT2(0, n ^ t) break;
|
||||||
|
case 0x1e: /* EOR */ t=T;n=N; SET(2,-1) PUT(0, n ^ t) break;
|
||||||
|
case 0x3f: /* SFT2 */ t=T;n=H2; SET(3,-1) PUT2(0, n >> (t & 0x0f) << (t >> 4)) break;
|
||||||
|
case 0x1f: /* SFT */ t=T;n=N; SET(2,-1) PUT(0, n >> (t & 0x0f) << (t >> 4)) break;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
int
|
int
|
||||||
uxn_boot(Uxn *u, Uint8 *ram, Dei *dei, Deo *deo)
|
uxn_boot(Uxn *u, Uint8 *ram)
|
||||||
{
|
{
|
||||||
Uint32 i;
|
Uint32 i;
|
||||||
char *cptr = (char *)u;
|
char *cptr = (char *)u;
|
||||||
|
|
@ -103,7 +136,5 @@ uxn_boot(Uxn *u, Uint8 *ram, Dei *dei, Deo *deo)
|
||||||
u->rst = (Stack *)(ram + 0xf0100);
|
u->rst = (Stack *)(ram + 0xf0100);
|
||||||
u->dev = (Uint8 *)(ram + 0xf0200);
|
u->dev = (Uint8 *)(ram + 0xf0200);
|
||||||
u->ram = ram;
|
u->ram = ram;
|
||||||
u->dei = dei;
|
|
||||||
u->deo = deo;
|
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue