X-Git-Url: https://git.ucc.asn.au/?a=blobdiff_plain;f=ROM2%2Fhelpers.c;h=13c2d36360a8484317a94f087db8e39e3678ec90;hb=553a00f8973a9009bc1f409b1e0d0d6424e8c873;hp=283ca30a37531b355a050157cfa5b261c9fe87f8;hpb=4f35424978e202fff48c2331eee9fd01e3da244f;p=uccvend-snackrom.git

diff --git a/ROM2/helpers.c b/ROM2/helpers.c
index 283ca30..13c2d36 100644
--- a/ROM2/helpers.c
+++ b/ROM2/helpers.c
@@ -1,45 +1,84 @@
+#include "display_basic.h"
 #include "vend.h"
 
-/* some IO addresses require buffering, so we create some generic buffering
- * functions here
- */
+void delay(u16 ms) {
+	asm volatile ("ldx %0\n" :: "m" (ms) : "x");
+	asm volatile (
+		"delay_loop:\n"
+		"	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");
+}
 
-/* create port-specific #defines: */
-#define buffered_port(p) \
-	u8   addr_##p##_buffer = 0; \
-	\
-	void __inline__ outb_##p(u8 b) { \
-		addr_##p##_buffer = b; \
-		outb(p, b); \
-	} \
-	\
-	void __inline__ bset_##p(u8 mask) { \
-		bset((addr_t)&addr_##p##_buffer, mask); \
-		outb(p, addr_##p##_buffer); \
-	} \
-	\
-	void __inline__ bclr_##p(u8 mask) { \
-		bclr((addr_t)&addr_##p##_buffer, mask); \
-		outb(p, addr_##p##_buffer); \
-	} 
+u8 my_strlen(char* s) {
+	char *p = s;
+	while (*p) p++;
+	return p-s;
+}
 
-void __inline__ outb(addr_t addr, u8 byte) {
-	/* FIXME hmmm */
-	/* asm? */
+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 */
 }
 
-void __inline__ bset(addr_t addr, u8 mask) {
-	/* FIXME again. asm? */
+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 __inline__ bclr(addr_t addr, u8 mask) {
-	/* FIXME again. asm? */
+void my_memcpy(char* dst, char* src, u8 size) {
+	u8 i = 0;
+	for (i = 0; i < size; i++) dst[i] = src[i];
 }
 
-void delay(u16 ms) {
-	/* FIXME fill me in */
+void my_memset(char* dst, u8 val, u16 count) {
+	char* c;
+	for (c = dst; c < dst+count; c++) *c = val;
 }
 
-/* ports declared here must be defined with buffered_port_h() in vend.h too */
-buffered_port(3800);
+u8 hexchar2u8(char b) {
+	if (b >= '0' && b <= '9') return b-'0';
+	if (b >= 'a' && b <= 'f') return b-'a'+0x0a;
+	if (b >= 'A' && b <= 'F') return b-'A'+0x0a;
+	return 0;
+}
+
+char nibble2hexchar(u8 b) {
+	if (b <= 9) return b+'0';
+	if (b >= 10 && b <= 15) return b+'A'-10;
+	return 'X';
+}
+
+u8 hex2u8(char msb, char lsb) {
+	return (hexchar2u8(msb) << 4) + hexchar2u8(lsb);
+}
+
+static char hexconv_buf[3];
+char* u82hex(u8 a) {
+	hexconv_buf[0] = nibble2hexchar((a&0xf0) >> 4);
+	hexconv_buf[1] = nibble2hexchar(a&0x0f);
+	hexconv_buf[2] = '\0';
+	return hexconv_buf;
+}
+
+bool ishex(char b) {
+	if (b >= '0' && b <= '9') return 1;
+	if (b >= 'a' && b <= 'f') return 1;
+	if (b >= 'A' && b <= 'F') return 1;
+	return 0;
+}