Add nip instructions

2 files changed, 35 insertions, 17 deletions

diff --git a/src/main.c b/src/main.c
index f70fbe9..888d0cd 100644
--- a/src/main.c
+++ b/src/main.c
@@ -50,22 +50,30 @@ init_uxn() {
     u8 uxn_rom[] = {
         //
         // ADD test.
-        0x80, 0x04, 0x80, 0x08, 0x18,             // #04 #08 ADD      -> 0c
-        0xa0, 0x00, 0x04, 0xa0, 0x00, 0x08, 0x38, // #0004 #0008 ADD2 -> 000c
-        0xa0, 0x00, 0xff, 0xa0, 0x00, 0x02, 0x38, // #00ff #0002 ADD2 -> 0101
-        // SUB test.
-        0x80, 0x08, 0x80, 0x03, 0x19,             // #08 #03 SUB      -> 05
-        0xa0, 0x00, 0x08, 0xa0, 0x00, 0x03, 0x39, // #0008 #0003 SUB2 -> 0005
-        0xa0, 0x01, 0x01, 0xa0, 0x00, 0x02, 0x39, // #0008 #0003 SUB2 -> 00ff
-        // MUL test.
-        0x80, 0x03, 0x80, 0x04, 0x1a,             // #03 #04 MUL      -> 0c
-        0xa0, 0x00, 0x03, 0xa0, 0x00, 0x04, 0x3a, // #0003 #0004 MUL2 -> 000c
-        0xa0, 0x00, 0xff, 0xa0, 0x00, 0x02, 0x3a, // #00ff #0002 MUL2 -> 01fe
-        // INC test.
-        0x80, 0x09, 0x01,                         // #09 INC          -> 0a
-        0xa0, 0x00, 0x09, 0x21,                   // #0009 INC2       -> 000a
-        0xa0, 0x00, 0xff, 0x21,                   // #0009 INC2       -> 0100
-        0xa0, 0x00, 0xff, 0x21, 0x21              // #0009 INC2 INC2  -> 0101
+        // 0x80, 0x04, 0x80, 0x08, 0x18,             // #04 #08 ADD      -> 0c
+        // 0xa0, 0x00, 0x04, 0xa0, 0x00, 0x08, 0x38, // #0004 #0008 ADD2 -> 000c
+        // 0xa0, 0x00, 0xff, 0xa0, 0x00, 0x02, 0x38, // #00ff #0002 ADD2 -> 0101
+        // // SUB test.
+        // 0x80, 0x08, 0x80, 0x03, 0x19,             // #08 #03 SUB      -> 05
+        // 0xa0, 0x00, 0x08, 0xa0, 0x00, 0x03, 0x39, // #0008 #0003 SUB2 -> 0005
+        // 0xa0, 0x01, 0x01, 0xa0, 0x00, 0x02, 0x39, // #0008 #0003 SUB2 -> 00ff
+        // // MUL test.
+        // 0x80, 0x03, 0x80, 0x04, 0x1a,             // #03 #04 MUL      -> 0c
+        // 0xa0, 0x00, 0x03, 0xa0, 0x00, 0x04, 0x3a, // #0003 #0004 MUL2 -> 000c
+        // 0xa0, 0x00, 0xff, 0xa0, 0x00, 0x02, 0x3a, // #00ff #0002 MUL2 -> 01fe
+        // // INC test.
+        // 0x80, 0x09, 0x01,                         // #09 INC          -> 0a
+        // 0xa0, 0x00, 0x09, 0x21,                   // #0009 INC2       -> 000a
+        // 0xa0, 0x00, 0xff, 0x21,                   // #0009 INC2       -> 0100
+        // 0xa0, 0x00, 0xff, 0x21, 0x21,             // #0009 INC2 INC2  -> 0101
+        // // POP.
+        // 0xa0, 0x12, 0x34, 0x02,
+        // 0xa0, 0x12, 0x34, 0x22,
+        // 0xa0, 0x00, 0x00,
+        // NIP.
+        0xa0, 0x12, 0x34, 0x03, // -> ( 34 )
+        0xa0, 0x12, 0x34, 0xa0, 0x56, 0x78, 0x23, // -> ( 56 78 )
+
     };
     memcpy(uxn_ram + PAGE_PROGRAM, uxn_rom, sizeof(uxn_rom));
 }
diff --git a/src/uxn-core.s b/src/uxn-core.s
index 95afc1a..730da32 100644
--- a/src/uxn-core.s
+++ b/src/uxn-core.s
@@ -95,15 +95,25 @@ inc2:
     b       uxn_decode
 
 pop:
+    sub     r1, #1
     b       uxn_decode
 
 pop2:
+    sub     r1, #2
     b       uxn_decode
 
 nip:
+    ldrb    r3, [r1, #-1]!
+    strb    r3, [r1, #-1]
     b       uxn_decode
 
 nip2:
+    ldrb    r3, [r1, #-1]!
+    ldrb    r5, [r1, #-1]!
+    orr     r3, r3, r5, lsl #8
+    strb    r3, [r1, #-1]
+    lsr     r3, #8
+    strb    r3, [r1, #-2]
     b       uxn_decode
 
 swp:
@@ -280,7 +290,7 @@ mul2:
     ldrb    r4, [r1, #-1]!
     ldrb    r5, [r1, #-1]!
     orr     r4, r4, r5, lsl #8
-    mul     r3, r3, r4
+    mul     r3, r4, r3
     strb    r3, [r1, #1]
     lsr     r3, #8
     strb    r3, [r1], #2