X-Git-Url: https://git.ucc.asn.au/?a=blobdiff_plain;f=ROM2%2Fhelpers.c;h=f336ae103f20722be300430f9957b8662f8fd504;hb=a1106ee52492a26f91897578c0761d1aedf6b44c;hp=b66f5ee60dd8cad3f08c05cc9a30423b9c721e6f;hpb=8436ed0d04bf12d2478bffbe3ea45531fa954686;p=uccvend-snackrom.git

diff --git a/ROM2/helpers.c b/ROM2/helpers.c
index b66f5ee..f336ae1 100644
--- a/ROM2/helpers.c
+++ b/ROM2/helpers.c
@@ -9,24 +9,31 @@ 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 ("ldx %0\n" :: "m" (ms));
+	//asm volatile ("pshx\npsha\npshb\n"); /* save registers */
+	asm volatile ("ldx %0\n" :: "m" (ms) : "x");
 	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"
+		//"	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" ::: "x", "d");
+		/*"	pulb\n"
 		"	pula\n"
-		"	pulx\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) {
@@ -35,7 +42,22 @@ void my_strncpy(char* dst, char* src, u8 max_size) {
 	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;
+}