Add memcpyx for DS390 port

git-svn-id: https://sdcc.svn.sourceforge.net/svnroot/sdcc/trunk/sdcc@403 4a8a32a2-be11-0410-ad9d-d568d2c75423

diff --git a/device/include/string.h b/device/include/string.h
index 2b3062fd48a7abffeae3de458c12e40d810202d2..3f3f5021d14040df5e392595320819e0af64dd21 100644 (file)
--- a/device/include/string.h
+++ b/device/include/string.h
@@ -76,6 +76,10 @@ extern void _generic *memcpy (void _generic *, void _generic *, int )  ;
 extern int            memcmp (void _generic *, void _generic *, int )  ;
 extern void _generic *memset (void _generic *, unsigned char  , int )  ;
 
+#if SDCC_ds390
+extern void _xdata *memcpyx(void _xdata *, void _xdata *, int);
+#endif
+
 #endif
 
 #endif

diff --git a/device/lib/ds390/Makefile b/device/lib/ds390/Makefile
index e33674bf23f2b550a231326145aeb6d4713a0a55..21c9b2bb1eac9cb06692d40cb6747d86aa4b736e 100755 (executable)
--- a/device/lib/ds390/Makefile
+++ b/device/lib/ds390/Makefile
@@ -2,7 +2,7 @@ CC = ../../../bin/sdcc
 
 #VERBOSE = --verbose
 
-OBJECTS = startup390.rel serial390.rel 
+OBJECTS = startup390.rel serial390.rel memcpyx.rel
 
 SOURCES = $(patsubst %.rel,%.c,$(OBJECTS))
 

diff --git a/device/lib/ds390/memcpyx.c b/device/lib/ds390/memcpyx.c
new file mode 100644 (file)
index 0000000..c298997
--- /dev/null
+++ b/device/lib/ds390/memcpyx.c
@@ -0,0 +1,92 @@
+#include <string.h>
+
+void _xdata * memcpyx (
+       void _xdata * dst,
+       void _xdata * src,
+       int count
+       ) 
+{
+    /* Shut compiler up about unused parameters. */
+    dst; src; count;
+    
+/* AUTO_TOGGLE uses the '390 DPTS toggle bit. */    
+#define AUTO_TOGGLE    
+_asm
+    ; Destination is in DPTR. Save it on stack so we can return it at end.
+    
+    push dpx
+    push dph
+    push dpl
+    
+    mov  dps, #1        ; Alternate DPTR.
+    
+    ; count  is in _memcpyx_PARM_3
+    mov  dptr, #_memcpyx_PARM_3
+    movx a, @dptr
+    inc dptr
+    mov r2, a
+    movx a, @dptr
+    mov r3, a
+
+    ; src is in _memcpyx_PARM_2
+    mov  dptr, #_memcpyx_PARM_2
+    movx a, @dptr
+    inc  dptr
+    push acc
+    movx a, @dptr
+    inc  dptr
+    push acc
+    movx a, @dptr
+    mov  dpx1, a
+    pop  dph1
+    pop  dpl1
+
+#ifdef AUTO_TOGGLE
+    mov        dps, #21        ; Current DPTR is alt DPTR, toggle after each op.
+#else
+    mov dps, #0                ; Current DPTR is normal DPTR, no toggle.
+#endif    
+    
+    ; src is in alt DPTR, dst is in normal DPTR, count is in r2/r3.
+    
+    ; If we have zero bytes to copy, quick out.
+    mov         a, r2
+    orl  a, r3
+    jz   _memcpy_done
+
+    ; increment r3 if r2 != 0 (makes djnz end-of-loop sequence possible).
+    inc r3
+    cjne r2, #0, _memcpyx_loopTop
+    dec r3
+
+_memcpyx_loopTop:
+
+#ifdef AUTO_TOGGLE
+    movx a, @dptr
+    movx @dptr, a
+    inc dptr
+    inc dptr
+#else
+    inc dps
+    movx a, @dptr
+    inc dptr
+    dec dps 
+    movx @dptr, a
+    inc dptr
+#endif    
+
+    djnz r2, _memcpyx_loopTop
+    djnz r3, _memcpyx_loopTop
+    
+_memcpy_done:
+
+#ifdef AUTO_TOGGLE
+    mov dps, #0
+#endif    
+
+    pop dpl
+    pop dph
+    pop dpx
+_endasm;    
+    
+}