1 files changed, 176 insertions, 0 deletions

diff --git a/firmware/asm/arm/memcpy.S b/firmware/asm/arm/memcpy.S
new file mode 100644
index 0000000000..2a55fb5656
--- /dev/null
+++ b/firmware/asm/arm/memcpy.S
@@ -0,0 +1,176 @@
+/***************************************************************************
+ *             __________               __   ___.
+ *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
+ *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
+ *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
+ *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
+ *                     \/            \/     \/    \/            \/
+ * $Id$
+ *
+ * Copyright (C) 2006 Free Software Foundation, Inc.
+ * This file was originally part of the GNU C Library
+ * Contributed to glibc by MontaVista Software, Inc. (written by Nicolas Pitre)
+ * Adapted for Rockbox by Daniel Ankers
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License
+ * as published by the Free Software Foundation; either version 2
+ * of the License, or (at your option) any later version.
+ *
+ * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
+ * KIND, either express or implied.
+ *
+ ****************************************************************************/
+
+#include "config.h"
+
+/*
+ * Endian independent macros for shifting bytes within registers.
+ */
+#ifndef __ARMEB__
+#define pull            lsr
+#define push            lsl
+#else
+#define pull            lsl
+#define push            lsr
+#endif
+
+/* Prototype: void *memcpy(void *dest, const void *src, size_t n); */
+
+    .section    .icode,"ax",%progbits
+
+    .align      2
+    .global     memcpy
+    .type       memcpy,%function
+
+memcpy:
+        stmfd   sp!, {r0, r4, lr}
+
+        subs    r2, r2, #4
+        blt 8f
+        ands    ip, r0, #3
+        bne 9f
+        ands    ip, r1, #3
+        bne 10f
+
+1:      subs    r2, r2, #(28)
+        stmfd   sp!, {r5 - r8}
+        blt 5f
+
+2:
+3:
+4:      ldmia   r1!, {r3, r4, r5, r6, r7, r8, ip, lr}
+        subs    r2, r2, #32
+        stmia   r0!, {r3, r4, r5, r6, r7, r8, ip, lr}
+        bge 3b
+
+5:      ands    ip, r2, #28
+        rsb ip, ip, #32
+        addne   pc, pc, ip      @ C is always clear here
+        b   7f
+6:      nop
+        ldr r3, [r1], #4
+        ldr r4, [r1], #4
+        ldr r5, [r1], #4
+        ldr r6, [r1], #4
+        ldr r7, [r1], #4
+        ldr r8, [r1], #4
+        ldr lr, [r1], #4
+
+        add pc, pc, ip
+        nop
+        nop
+        str r3, [r0], #4
+        str r4, [r0], #4
+        str r5, [r0], #4
+        str r6, [r0], #4
+        str r7, [r0], #4
+        str r8, [r0], #4
+        str lr, [r0], #4
+
+7:      ldmfd   sp!, {r5 - r8}
+
+8:      movs    r2, r2, lsl #31
+        ldrneb  r3, [r1], #1
+        ldrcsb  r4, [r1], #1
+        ldrcsb  ip, [r1]
+        strneb  r3, [r0], #1
+        strcsb  r4, [r0], #1
+        strcsb  ip, [r0]
+
+        ldmpc   regs="r0, r4"
+
+9:      rsb ip, ip, #4
+        cmp ip, #2
+        ldrgtb  r3, [r1], #1
+        ldrgeb  r4, [r1], #1
+        ldrb    lr, [r1], #1
+        strgtb  r3, [r0], #1
+        strgeb  r4, [r0], #1
+        subs    r2, r2, ip
+        strb    lr, [r0], #1
+        blt 8b
+        ands    ip, r1, #3
+        beq 1b
+
+10:     bic r1, r1, #3
+        cmp ip, #2
+        ldr lr, [r1], #4
+        beq 17f
+        bgt 18f
+
+
+        .macro  forward_copy_shift pull push
+
+        subs    r2, r2, #28
+        blt 14f
+
+11:     stmfd   sp!, {r5 - r9}
+
+12:
+13:     ldmia   r1!, {r4, r5, r6, r7}
+        mov r3, lr, pull #\pull
+        subs    r2, r2, #32
+        ldmia   r1!, {r8, r9, ip, lr}
+        orr r3, r3, r4, push #\push
+        mov r4, r4, pull #\pull
+        orr r4, r4, r5, push #\push
+        mov r5, r5, pull #\pull
+        orr r5, r5, r6, push #\push
+        mov r6, r6, pull #\pull
+        orr r6, r6, r7, push #\push
+        mov r7, r7, pull #\pull
+        orr r7, r7, r8, push #\push
+        mov r8, r8, pull #\pull
+        orr r8, r8, r9, push #\push
+        mov r9, r9, pull #\pull
+        orr r9, r9, ip, push #\push
+        mov ip, ip, pull #\pull
+        orr ip, ip, lr, push #\push
+        stmia   r0!, {r3, r4, r5, r6, r7, r8, r9, ip}
+        bge 12b
+
+        ldmfd   sp!, {r5 - r9}
+
+14:     ands    ip, r2, #28
+        beq 16f
+
+15:     mov r3, lr, pull #\pull
+        ldr lr, [r1], #4
+        subs    ip, ip, #4
+        orr r3, r3, lr, push #\push
+        str r3, [r0], #4
+        bgt 15b
+
+16:     sub r1, r1, #(\push / 8)
+        b   8b
+
+        .endm
+
+
+        forward_copy_shift  pull=8  push=24
+
+17:     forward_copy_shift  pull=16 push=16
+
+18:     forward_copy_shift  pull=24 push=8
+