Enough wacky little fixes to get motors turning and keypad functional.

[uccvend-snackrom.git] / ROM2 / helpers.c

diff --git a/ROM2/helpers.c b/ROM2/helpers.c
index b66f5ee..5f0da09 100644 (file)
--- a/ROM2/helpers.c
+++ b/ROM2/helpers.c
@@ -9,24 +9,24 @@ void delay(u16 ms) {
         * XXX - how do we know gcc isn't optimising this? it seems to optimise after
         * parsing C -> asm, but before asm -> machine code.
         */
-       asm volatile ("pshx\npsha\npshb\n"); /* save registers */
+       //asm volatile ("pshx\npsha\npshb\n"); /* save registers */
        asm volatile ("ldx %0\n" :: "m" (ms));
        asm volatile (
-               "loop:\n"
-               "       dex\n"                  /* 3 */
-               "       beq out\n"              /* 3 */
-               "       ldd #327\n"             /* 3 */
-               "inner_loop:\n" /* 15 cycles each */
-               "       cpd #0x0000\n"          /* 5 */
-               "       beq inner_loop_end\n"   /* 3 */
-               "       subd #0x0001\n"         /* 4 */
-               "       bra inner_loop\n"       /* 3 */
-               "inner_loop_end:\n"
-               "       bra loop\n"             /* 3 */
-               "out:\n"
-               "       pulb\n"
+               "delay_loop:\n"
+               "       dex\n"                        /* 3 */
+               "       beq delay_out\n"              /* 3 */
+               "       ldd #327\n"                   /* 3 */
+               "delay_inner_loop:\n" /* 15 cycles each */
+               "       cpd #0x0000\n"                /* 5 */
+               "       beq delay_inner_loop_end\n"   /* 3 */
+               "       subd #0x0001\n"               /* 4 */
+               "       bra delay_inner_loop\n"       /* 3 */
+               "delay_inner_loop_end:\n"
+               "       bra delay_loop\n"             /* 3 */
+               "delay_out:\n");
+               /*"     pulb\n"
                "       pula\n"
-               "       pulx\n");
+               "       pulx\n");*/
 }
 
 void my_strncpy(char* dst, char* src, u8 max_size) {