Add file device callbacks

1 files changed, 76 insertions, 7 deletions

diff --git a/src/main.c b/src/main.c
index 231d8e7..0cbdc1f 100644
--- a/src/main.c
+++ b/src/main.c
@@ -200,9 +200,8 @@ dei_datetime(u8 *dev, u8 port) {
 
 u16
 dei_audio(u8 *dev, u8 port) {
-    // txt_printf("AUDIO DEI!\n");
-    // TODO: Find proper instance.
-    AudioChannel *c = &channels[0];
+    size_t idx = device_data + 0x30 - dev;
+    AudioChannel *c = &channels[idx];
     switch(port) {
         case 0x0:
         case 0x8:
@@ -214,7 +213,7 @@ dei_audio(u8 *dev, u8 port) {
         //     c->pos <<= 12; // fixed point.
         //     break;
         // }
-        // case 0x4: return apu_get_vu(instance);
+        // case 0x4: return apu_get_vu(idx);
         // TODO: return the current envelope loudness (0x00-0xff).
         default: return dev[port];
     }
@@ -223,9 +222,8 @@ dei_audio(u8 *dev, u8 port) {
 
 void
 deo_audio(u8 *dev, u8 port) {
-    // txt_printf("AUDIO DEO!\n");
-    // TODO: Find proper instance.
-    AudioChannel *c = &channels[0];
+    size_t idx = device_data + 0x30 - dev;
+    AudioChannel *c = &channels[idx];
     if (port == 0xf) {
         u16 length = 0;
         u16 adsr = 0;
@@ -241,6 +239,73 @@ deo_audio(u8 *dev, u8 port) {
     }
 }
 
+u16
+dei_file(u8 *dev, u8 port) {
+    size_t idx = device_data + 0xa0 - dev;
+    UxnFile *c = &uxn_file[idx];
+    switch(port) {
+        case 0x0:
+        case 0x2:
+        case 0x4:
+        case 0x8:
+        case 0xa:
+        case 0xe: return PEEK2(dev + port);
+        case 0xc:
+        case 0xd: {
+            u16 res = file_read(c, &dev[port], 1);
+            POKE2(dev + 0x2, res);
+            return res;
+        }
+    }
+    return dev[port];
+}
+
+void
+deo_file(u8 *dev, u8 port) {
+    size_t idx = device_data + 0xa0 - dev;
+    u16 a, b, res;
+    UxnFile *f = &uxn_file[idx];
+    switch(port) {
+        case 0x5: {
+            a = PEEK2(dev + 0x4);
+            b = PEEK2(dev + 0xa);
+            if(b > 0x10000 - a) {
+                b = 0x10000 - a;
+            }
+            res = file_stat(f, &uxn_ram[a], b);
+            POKE2(dev + 0x2, res);
+        } break;
+        case 0x6: {
+            // TODO: no file deletion for now
+            // res = file_delete();
+            // POKE2(dev + 0x2, res);
+        } break;
+        case 0x9: {
+            a = PEEK2(dev + 0x8);
+            res = file_init(f, &uxn_ram[a]);
+            POKE2(dev + 0x2, res);
+        } break;
+        case 0xd: {
+            a = PEEK2(dev + 0xc);
+            b = PEEK2(dev + 0xa);
+            if(b > 0x10000 - a) {
+                b = 0x10000 - a;
+            }
+            res = file_read(f, &uxn_ram[a], b);
+            POKE2(dev + 0x2, res);
+        } break;
+        case 0xf: {
+            a = PEEK2(dev + 0xe);
+            b = PEEK2(dev + 0xa);
+            if(b > 0x10000 - a) {
+                b = 0x10000 - a;
+            }
+            res = file_write(f, &uxn_ram[a], b, dev[0x7]);
+            POKE2(dev + 0x2, res);
+        } break;
+    }
+}
+
 void
 deo_stub(u8 *dev, u8 port) {
     (void)dev;
@@ -289,6 +354,10 @@ init_uxn() {
     dei_map[0x5] = dei_audio;
     deo_map[0x6] = deo_audio;
     dei_map[0x6] = dei_audio;
+    deo_map[0xa] = deo_file;
+    dei_map[0xa] = dei_file;
+    deo_map[0xb] = deo_file;
+    dei_map[0xb] = dei_file;
     dei_map[0xc] = dei_datetime;
     dei_map[0x9] = dei_mouse;
 }