1 files changed, 74 insertions, 0 deletions
diff --git a/libc/string/bfin/memcpy.S b/libc/string/bfin/memcpy.S
new file mode 100644
index 000000000..e7ba7048e
--- /dev/null
+++ b/libc/string/bfin/memcpy.S
@@ -0,0 +1,74 @@
+/* memcpy.S
+ * Copyright (C) 2003, 2005, 2006 Analog Devices Inc., All Rights Reserved.
+ *
+ * This file is subject to the terms and conditions of the GNU Library General
+ * Public License. See the file "COPYING.LIB" in the main directory of this
+ * archive for more details.
+ *
+ * Non-LGPL License also available as part of VisualDSP++
+ * http://www.analog.com/processors/resources/crosscore/visualDspDevSoftware.html
+ */
+
+/* void *memcpy(void *dest, const void *src, size_t n);
+ * R0 = To Address (dest) (leave unchanged to form result)
+ * R1 = From Address (src)
+ * R2 = count
+ *
+ * Note: Favours word alignment
+ */
+
+.text
+
+.align 2
+
+.global _memcpy
+.type _memcpy, STT_FUNC
+_memcpy:
+	[--SP] = P3;
+	P0 = R0;              // P0 = To address
+	P3 = R1;              // P3 = From Address
+	P2 = R2 ;             // P2 = count
+	CC = R2 <= 7(IU);
+	IF CC JUMP  too_small;
+	I0 = R1;
+	R3 = R1 | R0;         // OR addresses together
+	R3 <<= 30;            // check bottom two bits
+	CC =  AZ;             // AZ set if zero.
+	IF !CC JUMP  bytes ;  // Jump if addrs not aligned.
+	P1 = P2 >> 2;         // count = n/4
+	P1 += -1;
+	R3 =  3;
+	R2 = R2 & R3;         // remainder
+	P2 = R2;              // set remainder
+	R1 = [I0++];
+#if !defined(__WORKAROUND_AVOID_DAG1)
+	LSETUP (quad_loop , quad_loop) LC0=P1;
+quad_loop:		MNOP || [P0++] = R1 || R1 = [I0++];
+#else
+	LSETUP (quad_loop_s , quad_loop_e) LC0=P1;
+quad_loop_s:	[P0++] = R1;
+quad_loop_e:	R1 = [I0++];
+#endif
+	[P0++] = R1;
+
+	CC = P2 == 0;         // any remaining bytes?
+	P3 = I0;	      // Ammend P3 for remaining copy
+	IF !CC JUMP bytes;
+	P3 = [SP++];
+	RTS;
+
+too_small:
+	CC = P2 == 0;           //Check zero count
+	IF CC JUMP finished;    // very unlikely
+
+bytes:
+	LSETUP (byte_loop_s , byte_loop_e) LC0=P2;
+byte_loop_s:	R1 = B[P3++](Z);
+byte_loop_e:	B[P0++] = R1;
+
+finished:
+	P3 = [SP++];
+	RTS;
+.size _memcpy,.-_memcpy
+
+libc_hidden_def (memcpy)