X-Git-Url: https://git.ucc.asn.au/?a=blobdiff_plain;ds=sidebyside;f=ROM2%2Fhelpers.c;h=f336ae103f20722be300430f9957b8662f8fd504;hb=a1106ee52492a26f91897578c0761d1aedf6b44c;hp=5f0da09c9770b2706e9f61bec11213d25cd47900;hpb=080c85d87da93ba2472b0c90d17527838d668db2;p=uccvend-snackrom.git diff --git a/ROM2/helpers.c b/ROM2/helpers.c index 5f0da09..f336ae1 100644 --- a/ROM2/helpers.c +++ b/ROM2/helpers.c @@ -10,32 +10,54 @@ void delay(u16 ms) { * parsing C -> asm, but before asm -> machine code. */ //asm volatile ("pshx\npsha\npshb\n"); /* save registers */ - asm volatile ("ldx %0\n" :: "m" (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 #327\n" /* 3 */ + " ldd #150\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" + " dex\n" /* 3 */ + " beq delay_out\n" /* 3 */ " bra delay_loop\n" /* 3 */ - "delay_out:\n"); + "delay_out:\n" ::: "x", "d"); /*" pulb\n" " pula\n" " 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]; if (src[i] == 0 && i < max_size) dst[i] = 0; /* null terminator */ } +bool my_strncmp(char* a, char* b, u8 len) { + u8 i; + for (i = 0; i < len; i++) { + if (*a != *b) return 0; + a++; + b++; + } + return 1; +} + 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; +}