Add jsr/jsr2 instructions

2 files changed, 36 insertions, 22 deletions

diff --git a/src/main.c b/src/main.c
index 93a6187..7468b50 100644
--- a/src/main.c
+++ b/src/main.c
@@ -141,10 +141,14 @@ init_uxn() {
         // JMP
         // 0x80, 0x01, 0x0c, 0x00, 0x80, 0xaa,
         // 0xa0, 0x01, 0x05, 0x2c, 0x00, 0x80, 0xbb,
+        // JCN
         // 0xa0, 0xab, 0xcd, 0x80, 0x01, 0x80, 0x01, 0x0d, 0x04, 0x02,
         // 0xa0, 0xab, 0xcd, 0x80, 0x00, 0x80, 0x01, 0x0d, 0x04, 0x02,
-        0xa0, 0xab, 0xcd, 0x80, 0x01, 0xa0, 0x01, 0x0a, 0x2d, 0x04, 0x02,
-        0xa0, 0xab, 0xcd, 0x80, 0x00, 0xa0, 0x01, 0x15, 0x2d, 0x04, 0x02,
+        // 0xa0, 0xab, 0xcd, 0x80, 0x01, 0xa0, 0x01, 0x0a, 0x2d, 0x04, 0x02,
+        // 0xa0, 0xab, 0xcd, 0x80, 0x00, 0xa0, 0x01, 0x15, 0x2d, 0x04, 0x02,
+        // JSR
+        // 0x80, 0x03, 0x0e, 0x80, 0x01, 0x00, 0x80, 0x02, 0x6c,
+        0x80, 0x03, 0x0e, 0x80, 0x01, 0x00, 0x80, 0x02, 0x6c,
     };
     memcpy(uxn_ram + PAGE_PROGRAM, uxn_rom, sizeof(uxn_rom));
 }
@@ -200,41 +204,41 @@ main(void) {
 
     uxn_eval_asm(PAGE_PROGRAM);
 
-    txt_printf("ROM");
+    // txt_printf("ROM");
+    // for (size_t i = 0; i < 64; i++) {
+    //     if (i % 8 == 0) {
+    //         txt_printf("\n");
+    //     }
+    //     txt_printf("%02x ", uxn_ram[i + PAGE_PROGRAM]);
+    // }
+    // txt_printf("\n\n");
+
+    txt_printf("WST (");
+    txt_printf("SIZE: %d)", wst_ptr - (uintptr_t)wst);
     for (size_t i = 0; i < 64; i++) {
         if (i % 8 == 0) {
             txt_printf("\n");
         }
-        txt_printf("%02x ", uxn_ram[i + PAGE_PROGRAM]);
+        if (i >= (wst_ptr - (uintptr_t)wst)) {
+            txt_printf("%02x ", 0);
+        } else {
+            txt_printf("%02x ", wst[i]);
+        }
     }
     txt_printf("\n\n");
-
-    txt_printf("WST (");
-    txt_printf("SIZE: %d)", wst_ptr - (uintptr_t)wst);
+    txt_printf("RST (");
+    txt_printf("SIZE: %d)", rst_ptr - (uintptr_t)rst);
     for (size_t i = 0; i < 64; i++) {
         if (i % 8 == 0) {
             txt_printf("\n");
         }
-        if (i >= (wst_ptr - (uintptr_t)wst)) {
+        if (i >= (rst_ptr - (uintptr_t)rst)) {
             txt_printf("%02x ", 0);
         } else {
-            txt_printf("%02x ", wst[i]);
+            txt_printf("%02x ", rst[i]);
         }
     }
     // txt_printf("\n\n");
-    // txt_printf("RST (");
-    // txt_printf("SIZE: %d)", rst_ptr - (uintptr_t)rst);
-    // for (size_t i = 0; i < 64; i++) {
-    //     if (i % 8 == 0) {
-    //         txt_printf("\n");
-    //     }
-    //     if (i >= (rst_ptr - (uintptr_t)rst)) {
-    //         txt_printf("%02x ", 0);
-    //     } else {
-    //         txt_printf("%02x ", rst[i]);
-    //     }
-    // }
-    // txt_printf("\n\n");
     // txt_printf("RAM (ZP)\n");
     // for (size_t i = 0; i < 64; i++) {
     //     if (i % 8 == 0) {
diff --git a/src/uxn-core.s b/src/uxn-core.s
index 71f7c5e..99c5b1c 100644
--- a/src/uxn-core.s
+++ b/src/uxn-core.s
@@ -625,9 +625,19 @@ jcn2:
     b       uxn_decode
 
 jsr:
+    mov     r3, r0
+    sub     r3, r3, r7
+    rpush16 r3
+    wpop8s  r3
+    add     r0, r3
     b       uxn_decode
 
 jsr2:
+    mov     r3, r0
+    sub     r3, r3, r7
+    wpop16  r3, r5
+    mov     r0, r7
+    add     r0, r0, r3
     b       uxn_decode
 
 sth: