Add swp, rot, dup, ovr instructions

1 files changed, 52 insertions, 0 deletions

diff --git a/src/uxn-core.s b/src/uxn-core.s
index 730da32..7e6ad8a 100644
--- a/src/uxn-core.s
+++ b/src/uxn-core.s
@@ -117,27 +117,79 @@ nip2:
     b       uxn_decode
 
 swp:
+    ldrb    r3, [r1, #-1]!
+    ldrb    r4, [r1, #-1]!
+    strb    r3, [r1], #1
+    strb    r4, [r1], #1
     b       uxn_decode
 
 swp2:
+    ldrb    r3, [r1, #-1]!
+    ldrb    r5, [r1, #-1]!
+    orr     r3, r3, r5, lsl #8
+    ldrb    r4, [r1, #-1]!
+    ldrb    r5, [r1, #-1]!
+    orr     r4, r4, r5, lsl #8
+    strb    r3, [r1, #1]
+    lsr     r3, #8
+    strb    r3, [r1], #2
+    strb    r4, [r1, #1]
+    lsr     r4, #8
+    strb    r4, [r1], #2
     b       uxn_decode
 
 rot:
+    ldrb    r5, [r1, #-1]!
+    ldrb    r4, [r1, #-1]!
+    ldrb    r3, [r1, #-1]!
+    strb    r4, [r1], #1
+    strb    r5, [r1], #1
+    strb    r3, [r1], #1
     b       uxn_decode
 
 rot2:
+    ldrb    r5, [r1, #-1]!
+    ldrb    r6, [r1, #-1]!
+    orr     r5, r5, r6, lsl #8
+    ldrb    r4, [r1, #-1]!
+    ldrb    r6, [r1, #-1]!
+    orr     r4, r4, r6, lsl #8
+    ldrb    r3, [r1, #-1]!
+    ldrb    r6, [r1, #-1]!
+    orr     r3, r3, r6, lsl #8
+    strb    r4, [r1, #1]
+    lsr     r4, #8
+    strb    r4, [r1], #2
+    strb    r5, [r1, #1]
+    lsr     r5, #8
+    strb    r5, [r1], #2
+    strb    r3, [r1, #1]
+    lsr     r3, #8
+    strb    r3, [r1], #2
     b       uxn_decode
 
 dup:
+    ldrb    r3, [r1, #-1]
+    strb    r3, [r1], #1
     b       uxn_decode
 
 dup2:
+    ldrb    r3, [r1, #-2]
+    ldrb    r4, [r1, #-1]
+    strb    r3, [r1], #1
+    strb    r4, [r1], #1
     b       uxn_decode
 
 ovr:
+    ldrb    r3, [r1, #-2]
+    strb    r3, [r1], #1
     b       uxn_decode
 
 ovr2:
+    ldrb    r3, [r1, #-4]
+    ldrb    r4, [r1, #-3]
+    strb    r3, [r1], #1
+    strb    r4, [r1], #1
     b       uxn_decode
 
 equ: