altos: Make ao_xmem funcs require __xdata void * instead of casting

Having an explicit cast in the ao_xmem wrapper macros caused the
compiler to generate garbage values for pdata addresses, making the
upper byte 0x00 instead of the required 0xf0. Removing the
casts from the ao_xmem macros exposed this problem, so a new
PDATA_TO_XDATA macros was added, along with a CODE_TO_XDATA macro
which serve to cast pointers, with suitable address modifications, so
that things work again.

Signed-off-by: Keith Packard <keithp@keithp.com>

1 files changed, 15 insertions, 8 deletions

diff --git a/src/cc1111/ao_string.c b/src/cc1111/ao_string.c
index daa5c14b..3a07e47e 100644
--- a/src/cc1111/ao_string.c
+++ b/src/cc1111/ao_string.c
@@ -18,26 +18,33 @@
 #include "ao.h"
 
 void
-_ao_xmemcpy(__xdata uint8_t *dst, __xdata uint8_t *src, uint8_t count)
+_ao_xmemcpy(__xdata void *dst, __xdata void *src, uint8_t count)
 {
-	while (count--)
-		*dst++ = *src++;
+	while (count--) {
+		*(__xdata uint8_t *) dst = *(__xdata uint8_t *) src;
+		dst = (__xdata uint8_t *) dst + 1;
+		src = (__xdata uint8_t *) src + 1;
+	}
 }
 
 void
-_ao_xmemset(__xdata uint8_t *dst, uint8_t v, uint8_t count)
+_ao_xmemset(__xdata void *dst, uint8_t v, uint8_t count)
 {
-	while (count--)
-		*dst++ = v;
+	while (count--) {
+		*(__xdata uint8_t *) dst = v;
+		dst = (__xdata uint8_t *) dst + 1;
+	}
 }
 
 int8_t
-_ao_xmemcmp(__xdata uint8_t *a, __xdata uint8_t *b, uint8_t count)
+_ao_xmemcmp(__xdata void *a, __xdata void *b, uint8_t count)
 {
 	while (count--) {
-		int8_t	d = *a++ - *b++;
+		int8_t	d = *(__xdata int8_t *) a - *(__xdata int8_t *) b;
 		if (d)
 			return d;
+		a = (__xdata int8_t *) a + 1;
+		b = (__xdata int8_t *) b + 1;
 	}
 	return 0;
 }