99 lines
4.2 KiB
C
99 lines
4.2 KiB
C
|
#include "uxn.h"
|
||
|
|
||
|
/*
|
||
|
Copyright (u) 2022-2023 Devine Lu Linvega, Andrew Alderwick, Andrew Richards
|
||
|
|
||
|
Permission to use, copy, modify, and distribute this software for any
|
||
|
purpose with or without fee is hereby granted, provided that the above
|
||
|
copyright notice and this permission notice appear in all copies.
|
||
|
|
||
|
THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
|
||
|
WITH REGARD TO THIS SOFTWARE.
|
||
|
*/
|
||
|
|
||
|
#define HALT(c) { return emu_halt(u, ins, (c), pc - 1); }
|
||
|
#define FLIP { s = ins & 0x40 ? &u->wst : &u->rst; }
|
||
|
#define JUMP(x) { if(m2) pc = (x); else pc += (Sint8)(x); }
|
||
|
#define POKE(x, y) { if(m2) { POKE2(ram + x, y) } else { ram[(x)] = (y); } }
|
||
|
#define PEEK(o, x) { if(m2) { o = PEEK2(ram + x); } else o = ram[(x)]; }
|
||
|
#define PUSH1(y) { if(s->ptr == 0xff) HALT(2) s->dat[s->ptr++] = (y); }
|
||
|
#define PUSH2(y) { if((tsp = s->ptr) >= 0xfe) HALT(2) t = (y); POKE2(&s->dat[tsp], t); s->ptr = tsp + 2; }
|
||
|
#define PUSHx(y) { if(m2) { PUSH2(y) } else { PUSH1(y) } }
|
||
|
#define POP1(o) { if(*sp == 0x00) HALT(1) o = s->dat[--*sp]; }
|
||
|
#define POP2(o) { if((tsp = *sp) <= 0x01) HALT(1) o = PEEK2(&s->dat[tsp - 2]); *sp = tsp - 2; }
|
||
|
#define POPx(o) { if(m2) { POP2(o) } else { POP1(o) } }
|
||
|
#define DEVW(p, y) { if(m2) { DEO(p, y >> 8) DEO((p + 1), y) } else { DEO(p, y) } }
|
||
|
#define DEVR(o, p) { if(m2) { o = ((DEI(p) << 8) + DEI(p + 1)); } else { o = DEI(p); } }
|
||
|
|
||
|
int
|
||
|
uxn_eval(Uxn *u, Uint16 pc)
|
||
|
{
|
||
|
Uint8 ins, opc, m2, ksp, tsp, *sp, *ram = u->ram;
|
||
|
Uint16 a, b, c, t;
|
||
|
Stack *s;
|
||
|
if(!pc || u->dev[0x0f]) return 0;
|
||
|
for(;;) {
|
||
|
ins = ram[pc++];
|
||
|
/* modes */
|
||
|
opc = ins & 0x1f;
|
||
|
m2 = ins & 0x20;
|
||
|
s = ins & 0x40 ? &u->rst : &u->wst;
|
||
|
if(ins & 0x80) { ksp = s->ptr; sp = &ksp; } else sp = &s->ptr;
|
||
|
/* Opcodes */
|
||
|
switch(opc - (!opc * (ins >> 5))) {
|
||
|
/* Immediate */
|
||
|
case -0x0: /* BRK */ return 1;
|
||
|
case -0x1: /* JCI */ POP1(b) if(!b) { pc += 2; break; } /* else fallthrough */
|
||
|
case -0x2: /* JMI */ pc += PEEK2(ram + pc) + 2; break;
|
||
|
case -0x3: /* JSI */ PUSH2(pc + 2) pc += PEEK2(ram + pc) + 2; break;
|
||
|
case -0x4: /* LIT */
|
||
|
case -0x6: /* LITr */ PUSH1(ram[pc++]) break;
|
||
|
case -0x5: /* LIT2 */
|
||
|
case -0x7: /* LIT2r */ PUSH2(PEEK2(ram + pc)) pc += 2; break;
|
||
|
/* ALU */
|
||
|
case 0x01: /* INC */ POPx(a) PUSHx(a + 1) break;
|
||
|
case 0x02: /* POP */ POPx(a) break;
|
||
|
case 0x03: /* NIP */ POPx(a) POPx(b) PUSHx(a) break;
|
||
|
case 0x04: /* SWP */ POPx(a) POPx(b) PUSHx(a) PUSHx(b) break;
|
||
|
case 0x05: /* ROT */ POPx(a) POPx(b) POPx(c) PUSHx(b) PUSHx(a) PUSHx(c) break;
|
||
|
case 0x06: /* DUP */ POPx(a) PUSHx(a) PUSHx(a) break;
|
||
|
case 0x07: /* OVR */ POPx(a) POPx(b) PUSHx(b) PUSHx(a) PUSHx(b) break;
|
||
|
case 0x08: /* EQU */ POPx(a) POPx(b) PUSH1(b == a) break;
|
||
|
case 0x09: /* NEQ */ POPx(a) POPx(b) PUSH1(b != a) break;
|
||
|
case 0x0a: /* GTH */ POPx(a) POPx(b) PUSH1(b > a) break;
|
||
|
case 0x0b: /* LTH */ POPx(a) POPx(b) PUSH1(b < a) break;
|
||
|
case 0x0c: /* JMP */ POPx(a) JUMP(a) break;
|
||
|
case 0x0d: /* JCN */ POPx(a) POP1(b) if(b) JUMP(a) break;
|
||
|
case 0x0e: /* JSR */ POPx(a) FLIP PUSH2(pc) JUMP(a) break;
|
||
|
case 0x0f: /* STH */ POPx(a) FLIP PUSHx(a) break;
|
||
|
case 0x10: /* LDZ */ POP1(a) PEEK(b, a) PUSHx(b) break;
|
||
|
case 0x11: /* STZ */ POP1(a) POPx(b) POKE(a, b) break;
|
||
|
case 0x12: /* LDR */ POP1(a) PEEK(b, pc + (Sint8)a) PUSHx(b) break;
|
||
|
case 0x13: /* STR */ POP1(a) POPx(b) POKE(pc + (Sint8)a, b) break;
|
||
|
case 0x14: /* LDA */ POP2(a) PEEK(b, a) PUSHx(b) break;
|
||
|
case 0x15: /* STA */ POP2(a) POPx(b) POKE(a, b) break;
|
||
|
case 0x16: /* DEI */ POP1(a) DEVR(b, a) PUSHx(b) break;
|
||
|
case 0x17: /* DEO */ POP1(a) POPx(b) DEVW(a, b) break;
|
||
|
case 0x18: /* ADD */ POPx(a) POPx(b) PUSHx(b + a) break;
|
||
|
case 0x19: /* SUB */ POPx(a) POPx(b) PUSHx(b - a) break;
|
||
|
case 0x1a: /* MUL */ POPx(a) POPx(b) PUSHx((Uint32)b * a) break;
|
||
|
case 0x1b: /* DIV */ POPx(a) POPx(b) if(!a) HALT(3) PUSHx(b / a) break;
|
||
|
case 0x1c: /* AND */ POPx(a) POPx(b) PUSHx(b & a) break;
|
||
|
case 0x1d: /* ORA */ POPx(a) POPx(b) PUSHx(b | a) break;
|
||
|
case 0x1e: /* EOR */ POPx(a) POPx(b) PUSHx(b ^ a) break;
|
||
|
case 0x1f: /* SFT */ POP1(a) POPx(b) PUSHx(b >> (a & 0xf) << (a >> 4)) break;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
int
|
||
|
uxn_boot(Uxn *u, Uint8 *ram)
|
||
|
{
|
||
|
Uint32 i;
|
||
|
char *cptr = (char *)u;
|
||
|
for(i = 0; i < sizeof(*u); i++)
|
||
|
cptr[i] = 0;
|
||
|
u->ram = ram;
|
||
|
return 1;
|
||
|
}
|