SWCODEC: Get rid of extra swap buffer and get back 512K of RAM or 100K if the players RAM is <= 1MB. Make any needed changes to things to stabilize and facilitate this including removing flattening out initialization. Comment some things heavily. Fix a few logfs I didn't want to see the compiler complaining about.

git-svn-id: svn://svn.rockbox.org/rockbox/trunk@12843 a1c6a512-1295-4272-9138-f99709370657

5 files changed, 153 insertions, 0 deletions

diff --git a/firmware/SOURCES b/firmware/SOURCES
index 549e4af..9743265 100644
--- a/firmware/SOURCES
+++ b/firmware/SOURCES
@@ -248,6 +248,8 @@ target/coldfire/crt0.S
 target/coldfire/memcpy-coldfire.S
 target/coldfire/memmove-coldfire.S
 target/coldfire/memset-coldfire.S
+target/coldfire/memswap128-coldfire.S
+common/memswap128.c
 #if defined(HAVE_LCD_COLOR) \
  || defined(HAVE_REMOTE_LCD) && (LCD_REMOTE_PIXELFORMAT == VERTICAL_INTERLEAVED)
 target/coldfire/memset16-coldfire.S
@@ -269,6 +271,7 @@ common/strlen.c
 #ifndef SIMULATOR
 target/arm/memset-arm.S
 target/arm/memset16-arm.S
+target/arm/memswap128-arm.S
 #if CONFIG_I2C == I2C_PP5020 || CONFIG_I2C == I2C_PP5002
 target/arm/i2c-pp.c
 #elif CONFIG_I2C == I2C_PNX0101
@@ -295,6 +298,7 @@ common/memcpy.c
 common/memmove.c
 common/memset.c
 common/memset16.c
+common/memswap128.c
 common/strlen.c
 #ifndef SIMULATOR
 crt0.S
diff --git a/firmware/common/memswap128.c b/firmware/common/memswap128.c
new file mode 100644
index 0000000..af1fe15
--- /dev/null
+++ b/firmware/common/memswap128.c
@@ -0,0 +1,44 @@
+/***************************************************************************
+ *             __________               __   ___.
+ *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
+ *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
+ *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
+ *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
+ *                     \/            \/     \/    \/            \/
+ * $Id$
+ *
+ * Copyright (C) 2007 by Michael Sevakis
+ *
+ * All files in this archive are subject to the GNU General Public License.
+ * See the file COPYING in the source tree root for full license agreement.
+ *
+ * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
+ * KIND, either express or implied.
+ *
+ ****************************************************************************/
+#include "config.h"
+#include <string.h>
+#include <inttypes.h>
+
+void memswap128(void *a, void *b, size_t len)
+{
+    for (len >>= 4; len > 0; len--, a += 16, b += 16)
+    {
+        int32_t a0 = *((int32_t *)a + 0);
+        int32_t a1 = *((int32_t *)a + 1);
+        int32_t a2 = *((int32_t *)a + 2);
+        int32_t a3 = *((int32_t *)a + 3);
+        int32_t b0 = *((int32_t *)b + 0);
+        int32_t b1 = *((int32_t *)b + 1);
+        int32_t b2 = *((int32_t *)b + 2);
+        int32_t b3 = *((int32_t *)b + 3);
+        *((int32_t *)b + 0) = a0;
+        *((int32_t *)b + 1) = a1;
+        *((int32_t *)b + 2) = a2;
+        *((int32_t *)b + 3) = a3;
+        *((int32_t *)a + 0) = b0;
+        *((int32_t *)a + 1) = b1;
+        *((int32_t *)a + 2) = b2;
+        *((int32_t *)a + 3) = b3;
+    }
+}
diff --git a/firmware/include/memory.h b/firmware/include/memory.h
index 559c6ed..75bcb98 100644
--- a/firmware/include/memory.h
+++ b/firmware/include/memory.h
@@ -24,4 +24,15 @@
 
 void memset16(void *dst, int val, size_t len);
 
+/**
+ * memswap128
+ *
+ * Exchanges the contents of two buffers.
+ * For maximum efficiency, this function performs no aligning of addresses
+ * and buf1, buf2 and len should be 16 byte (128 bit) aligned. Not being at
+ * least longword aligned will fail on some architechtures. Any len mod 16
+ * at the end is not swapped.
+ */
+void memswap128(void *buf1, void *buf2, size_t len);
+
 #endif /* _MEMORY_H_ */
diff --git a/firmware/target/arm/memswap128-arm.S b/firmware/target/arm/memswap128-arm.S
new file mode 100644
index 0000000..f5276ef
--- /dev/null
+++ b/firmware/target/arm/memswap128-arm.S
@@ -0,0 +1,44 @@
+/***************************************************************************

+ *             __________               __   ___.

+ *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___

+ *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /

+ *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <

+ *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \

+ *                     \/            \/     \/    \/            \/

+ * $Id$

+ *

+ * Copyright (C) 2007 by Michael Sevakis

+ *

+ * All files in this archive are subject to the GNU General Public License.

+ * See the file COPYING in the source tree root for full license agreement.

+ *

+ * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY

+ * KIND, either express or implied.

+ *

+ ****************************************************************************/

+

+/****************************************************************************

+ * void memswap128(void *buf1, void *buf2, size_t len)

+ */

+    .section    .icode, "ax", %progbits

+    .align      2

+    .global     memswap128

+    .type       memswap128, %function

+memswap128:

+                                        @ r0 = buf1

+                                        @ r1 = buf2

+                                        @ r2 = len

+    movs        r2, r2, lsr #4          @ bytes => lines, len == 0?

+    moveq       pc, lr                  @ not at least a line? leave

+    stmdb       sp!, { r4-r10, lr }     @ save registers and return address

+.loop:                                  @

+    ldmia       r0, { r3-r6 }           @ read four longwords from buf1

+    ldmia       r1, { r7-r10 }          @ read four longwords from buf2

+    stmia       r0!, { r7-r10 }         @ write buf2 data to buf1, buf1 += 16

+    stmia       r1!, { r3-r6 }          @ write buf1 data to buf2, buf2 += 16

+    subs        r2, r2, #1              @ len -= 1, len > 0 ?

+    bhi         .loop                   @ yes? keep exchanging

+    ldmia       sp!, { r4-r10, pc }     @ restore registers and return

+.end:

+    .size       memswap128, .end-memswap128

+

diff --git a/firmware/target/coldfire/memswap128-coldfire.S b/firmware/target/coldfire/memswap128-coldfire.S
new file mode 100644
index 0000000..2509fd0
--- /dev/null
+++ b/firmware/target/coldfire/memswap128-coldfire.S
@@ -0,0 +1,50 @@
+/***************************************************************************

+ *             __________               __   ___.

+ *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___

+ *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /

+ *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <

+ *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \

+ *                     \/            \/     \/    \/            \/

+ * $Id$

+ *

+ * Copyright (C) 2007 by Michael Sevakis

+ *

+ * All files in this archive are subject to the GNU General Public License.

+ * See the file COPYING in the source tree root for full license agreement.

+ *

+ * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY

+ * KIND, either express or implied.

+ *

+ ****************************************************************************/

+

+/****************************************************************************

+ * void memswap128(void *buf1, void *buf2, size_t len)

+ */

+    .section    .icode, "ax", @progbits

+    .align      2

+    .global     memswap128

+    .type       memswap128, @function

+memswap128:

+    lea.l       -28(%sp), %sp           | save registers

+    movem.l     %d2-%d7/%a2, (%sp)      |

+    movem.l 	32(%sp), %a0-%a2        | %a0 = buf1

+                                        | %a1 = buf2

+                                        | %a2 = len

+    lea.l       -15(%a0, %a2.l), %a2    | %a2 = end address - 15

+    cmp.l       %a0, %a2                | end address <= buf1?

+    bls.b       .no_lines               | not at least a line? leave

+.loop:                                  |

+    movem.l	    (%a0), %d0-%d3          | read four longwords from buf1

+    movem.l	    (%a1), %d4-%d7          | read four longwords from buf2

+    movem.l	    %d4-%d7, (%a0)          | write buf2 data to buf1

+    movem.l	    %d0-%d3, (%a1)          | write buf1 data to buf2

+    lea.l       16(%a0), %a0            | buf1 += 16

+    lea.l       16(%a1), %a1            | buf2 += 16

+    cmp.l       %a0, %a2                | %a0 < %d0?

+    bhi.b       .loop                   | yes? keep exchanging

+.no_lines:                              |

+    movem.l  	(%sp), %d2-%d7/%a2      | restore registers

+    lea.l       28(%sp), %sp            |

+    rts                                 |

+.end:

+	.size       memswap128, .end-memswap128