X-Git-Url: https://git.ucc.asn.au/?a=blobdiff_plain;f=ROM2%2Fhelpers.c;h=f336ae103f20722be300430f9957b8662f8fd504;hb=dc87be12e6cb8428ab33c0984c5f871e6e1c5587;hp=ad52123b97a39a1eed528036a861948c5344c75a;hpb=f5bc521c83d95d35e852747402a44d1411252c2b;p=uccvend-snackrom.git diff --git a/ROM2/helpers.c b/ROM2/helpers.c index ad52123..f336ae1 100644 --- a/ROM2/helpers.c +++ b/ROM2/helpers.c @@ -13,8 +13,6 @@ void delay(u16 ms) { asm volatile ("ldx %0\n" :: "m" (ms) : "x"); asm volatile ( "delay_loop:\n" - " dex\n" /* 3 */ - " beq delay_out\n" /* 3 */ //" ldd #327\n" /* 3 */ " ldd #150\n" /* 3 */ "delay_inner_loop:\n" /* 15 cycles each */ @@ -23,6 +21,8 @@ void delay(u16 ms) { " subd #0x0001\n" /* 4 */ " bra delay_inner_loop\n" /* 3 */ "delay_inner_loop_end:\n" + " dex\n" /* 3 */ + " beq delay_out\n" /* 3 */ " bra delay_loop\n" /* 3 */ "delay_out:\n" ::: "x", "d"); /*" pulb\n" @@ -30,6 +30,12 @@ void delay(u16 ms) { " pulx\n");*/ } +u8 my_strlen(char* s) { + char *p = s; + while (*p) p++; + return p-s; +} + void my_strncpy(char* dst, char* src, u8 max_size) { u8 i; for (i = 0; src[i] && i < max_size; i++) dst[i] = src[i]; @@ -50,3 +56,8 @@ void my_memcpy(char* dst, char* src, u8 size) { u8 i = 0; for (i = 0; i < size; i++) dst[i] = src[i]; } + +void my_memset(char* dst, u8 val, u16 count) { + char* c; + for (c = dst; c < dst+count; c++) *c = val; +}