1 files changed, 149 insertions, 4 deletions

diff --git a/src/main.c b/src/main.c
index 22723c0..3ecfa71 100644
--- a/src/main.c
+++ b/src/main.c
@@ -1,14 +1,159 @@
 #include "common.h"
 #include "ppu.c"
+#include "uxn-fast.c"
+#include "rom.c"
 
-void main(void) {
-    // Initialize uart.
-    uart_init();
+static Uxn u;
+static Device *devscreen;
+static Device *devctrl;
+static Device *devmouse;
+static Device *devaudio;
+
+void
+nil_talk(Device *d, u8 b0, u8 w) {
+    (void)d;
+    (void)b0;
+    (void)w;
+}
+
+void
+console_talk(Device *d, u8 b0, u8 w) {
+    char stmp[2];
+    if(!w) {
+        return;
+    }
+    switch(b0) {
+        case 0x8: stmp[0] = d->dat[0x8]; stmp[1] = 0; uart_puts(stmp); break;
+        // case 0x9: txt_printf("0x%02x", d->dat[0x9]); break;
+        // case 0xb: txt_printf("0x%04x", mempeek16(d->dat, 0xa)); break;
+        // case 0xd: txt_printf("%s", &d->mem[mempeek16(d->dat, 0xc)]); break;
+    }
+}
+
+void
+system_talk(Device *d, u8 b0, u8 w) {
+    // uart_puts("system_talk\n");
+    // TODO: Implement...
+        if(!w) { /* read */
+                switch(b0) {
+                case 0x2: d->dat[0x2] = d->u->wst.ptr; break;
+                case 0x3: d->dat[0x3] = d->u->rst.ptr; break;
+                }
+        } else { /* write */
+                switch(b0) {
+                case 0x2: d->u->wst.ptr = d->dat[0x2]; break;
+                case 0x3: d->u->rst.ptr = d->dat[0x3]; break;
+                case 0xf: d->u->ram.ptr = 0x0000; break;
+                }
+                if(b0 > 0x7 && b0 < 0xe) {
+                        // docolors(d); TODO
+        }
+        }
+    (void)b0;
+}
+
+void
+screen_talk(Device *d, u8 b0, u8 w) {
+    // uart_puts("screen_talk\n");
+    // TODO: Implement...
+    // if(w && b0 == 0xe) {
+    //     u16 x = mempeek16(d->dat, 0x8);
+    //     u16 y = mempeek16(d->dat, 0xa);
+    //     u8 *addr = &d->mem[mempeek16(d->dat, 0xc)];
+    //     u8 *layer = d->dat[0xe] >> 4 & 0x1 ? ppu.fg : ppu.bg;
+    //     u8 mode = d->dat[0xe] >> 5;
+    //     u8 color = d->dat[0xf] & 0xf;
+    //     if(!mode) {
+    //         ppu_pixel(layer, x, y, d->dat[0xe] & 0x3);
+    //     } else if(mode-- & 0x1) {
+    //         u8 flipx = mode & 0x2;
+    //         u8 flipy = mode & 0x4;
+    //         ppu_1bpp(layer, x, y, addr, color, flipx, flipy);
+    //     } else {
+    //         u8 flipx = mode & 0x2;
+    //         u8 flipy = mode & 0x4;
+    //         ppu_2bpp(layer, x, y, addr, color, flipx, flipy);
+    //     }
+    // } else if(w && b0 == 0xf) {
+    //     u16 x = mempeek16(d->dat, 0x8);
+    //     u16 y = mempeek16(d->dat, 0xa);
+    //     u8 *addr = &d->mem[mempeek16(d->dat, 0xc)];
+    //     u8 *layer = d->dat[0xf] >> 6 & 0x1 ? ppu.fg : ppu.bg;
+    //     u8 color = d->dat[0xf] & 0xf;
+    //     u8 flipx = (d->dat[0xf] >> 0x4) & 0x1;
+    //     u8 flipy = (d->dat[0xf] >> 0x5) & 0x1;
+    //     if(d->dat[0xf] >> 0x7 & 0x1) {
+    //         ppu_2bpp(layer, x, y, addr, color, flipx, flipy);
+    //     } else {
+    //         ppu_1bpp(layer, x, y, addr, color, flipx, flipy);
+    //     }
+    // }
+}
 
+static void
+audio_talk(Device *d, u8 b0, u8 w) {
+    // TODO: Implement...
+    // uart_puts("audio_talk\n");
+    (void)d;
+    (void)b0;
+    (void)w;
+}
+
+void
+datetime_talk(Device *d, u8 b0, u8 w) {
+    // uart_puts("datetime_talk\n");
+    // TODO: Implement...
+    (void)d;
+    (void)b0;
+    (void)w;
+}
+
+void
+file_talk(Device *d, u8 b0, u8 w) {
+    // uart_puts("file_talk\n");
+    // TODO: Implement...
+    (void)d;
+    (void)b0;
+    (void)w;
+}
+
+void
+init_uxn() {
+    uart_puts("Initializing UXN.\n");
+    uart_init();
     ppu_init();
 
+    // Copy rom to VM.
+    memcpy(u.ram.dat + PAGE_PROGRAM, uxn_rom, sizeof(uxn_rom));
+
+    // Prepare devices.
+    uxn_port(&u, 0x0, "system", system_talk);
+    uxn_port(&u, 0x1, "console", console_talk);
+    devscreen = uxn_port(&u, 0x2, "screen", screen_talk);
+    devaudio = uxn_port(&u, 0x3, "audio0", audio_talk);
+    uxn_port(&u, 0x4, "audio1", audio_talk);
+    uxn_port(&u, 0x5, "audio2", audio_talk);
+    uxn_port(&u, 0x6, "audio3", audio_talk);
+    uxn_port(&u, 0x7, "---", nil_talk);
+    devctrl = uxn_port(&u, 0x8, "controller", nil_talk);
+    devmouse = uxn_port(&u, 0x9, "mouse", nil_talk);
+    uxn_port(&u, 0xa, "file", file_talk);
+    uxn_port(&u, 0xb, "datetime", datetime_talk);
+    uxn_port(&u, 0xc, "---", nil_talk);
+    uxn_port(&u, 0xd, "---", nil_talk);
+    uxn_port(&u, 0xe, "---", nil_talk);
+    uxn_port(&u, 0xf, "---", nil_talk);
+    // mempoke16(devscreen->dat, 2, ppu.hor * 8);
+    // mempoke16(devscreen->dat, 4, ppu.ver * 8);
+}
+
+void main(void) {
+    // Initialize uart.
+    init_uxn();
+
+    uxn_eval(&u, 0x0100);
     while(1) {
         // Echo input to standard output.
-        uart_putc(uart_getc());
+        uxn_eval(&u, mempeek16(devscreen->dat, 0));
     }
 }