1 files changed, 106 insertions, 0 deletions
diff --git a/firmware/target/arm/pcm-mixer-armv5.c b/firmware/target/arm/pcm-mixer-armv5.c
new file mode 100644
index 0000000000..64f2c86f52
--- /dev/null
+++ b/firmware/target/arm/pcm-mixer-armv5.c
@@ -0,0 +1,106 @@
+/***************************************************************************
+ *             __________               __   ___.
+ *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
+ *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
+ *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
+ *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
+ *                     \/            \/     \/    \/            \/
+ * $Id$
+ *
+ * Copyright (C) 2011 by Michael Sevakis
+ *
+ * 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.
+ *
+ ****************************************************************************/
+#define MIXER_OPTIMIZED_WRITE_SAMPLES
+#define MIXER_OPTIMIZED_MIX_SAMPLES
+/* Mix channels' samples and apply gain factors */
+static FORCE_INLINE void mix_samples(void *out,
+                                     void *src0,
+                                     int32_t src0_amp,
+                                     void *src1,
+                                     int32_t src1_amp,
+                                     size_t size)
+{
+    int32_t s0, s1, tmp;
+    asm volatile (
+    "1:                             \n"
+        "ldr    %4, [%1], #4        \n"
+        "ldr    %5, [%2], #4        \n"
+        "smulwb %6, %7, %4          \n"
+        "smulwt %4, %7, %4          \n"
+        "smlawb %6, %8, %5, %6      \n"
+        "smlawt %4, %8, %5, %4      \n"
+        "mov    %5, %6, asr #15     \n"
+        "teq    %5, %5, asr #31     \n"
+        "eorne  %6, %9, %6, asr #31 \n"
+        "mov    %5, %4, asr #15     \n"
+        "teq    %5, %5, asr #31     \n"
+        "eorne  %4, %9, %4, asr #31 \n"
+        "subs   %3, %3, #4          \n"
+        "and    %6, %6, %9, lsr #16 \n"
+        "orr    %6, %6, %4, lsl #16 \n"
+        "str    %6, [%0], #4        \n"
+        "bhi    1b                  \n"
+        : "+r"(out), "+r"(src0), "+r"(src1), "+r"(size),
+          "=&r"(s0), "=&r"(s1), "=&r"(tmp)
+        : "r"(src0_amp), "r"(src1_amp), "r"(0xffff7fff));
+}
+/* Write channel's samples and apply gain factor */
+static FORCE_INLINE void write_samples(void *out,
+                                       void *src,
+                                       int32_t amp,
+                                       size_t size)
+{
+    if (LIKELY(amp == MIX_AMP_UNITY))
+    {
+        /* Channel is unity amplitude */
+        asm volatile (
+            "ands   r1, %2, #0x1f  \n"
+            "beq    2f             \n"
+        "1:                        \n"
+            "ldr    r0, [%1], #4   \n"
+            "subs   r1, r1, #4     \n"
+            "str    r0, [%0], #4   \n"
+            "bne    1b             \n"
+            "bics   %2, %2, #0x1f  \n"
+            "beq    3f             \n"
+        "2:                        \n"
+            "ldmia  %1!, { r0-r7 } \n"
+            "subs   %2, %2, #32    \n"
+            "stmia  %0!, { r0-r7 } \n"
+            "bhi    2b             \n"
+        "3:                        \n"
+            : "+r"(out), "+r"(src), "+r"(size)
+            :
+            : "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7");
+    }
+    else
+    {
+        /* Channel needs amplitude cut */
+        uint32_t l, h;
+        asm volatile (
+        "1:                             \n"
+            "ldr    %3, [%1], #4        \n"
+            "subs   %2, %2, #4          \n"
+            "smulwt %4, %5, %3          \n"
+            "smulwb %3, %5, %3          \n"
+            "mov    %4, %4, lsl #16     \n"
+            "mov    %3, %3, lsl #16     \n"
+            "orr    %4, %4, %3, lsr #16 \n"
+            "str    %4, [%0], #4        \n"
+            "bhi    1b                  \n"
+            : "+r"(out), "+r"(src), "+r"(size),
+              "=&r"(l), "=&r"(h)
+            : "r"(amp));
+    }     
+}

diff --git a/firmware/target/arm/pcm-mixer-armv5.c b/firmware/target/arm/pcm-mixer-armv5.c new file mode 100644 index 0000000000..64f2c86f52 --- /dev/null +++ b/firmware/target/arm/pcm-mixer-armv5.c
@@ -0,0 +1,106 @@
	1	/***************************************************************************
	2	* __________ __ ___.
	3	* Open \______ \ ____ ____ \| \| _\_ \|__ _______ ___
	4	* Source \| _// _ \_/ ___\\| \|/ /\| __ \ / _ \ \/ /
	5	* Jukebox \| \| ( <_> ) \___\| < \| \_\ ( <_> > < <
	6	* Firmware \|____\|_ /\____/ \___ >__\|_ \\|___ /\____/__/\_ \
	7	* \/ \/ \/ \/ \/
	8	* $Id$
	9	*
	10	* Copyright (C) 2011 by Michael Sevakis
	11	*
	12	* This program is free software; you can redistribute it and/or
	13	* modify it under the terms of the GNU General Public License
	14	* as published by the Free Software Foundation; either version 2
	15	* of the License, or (at your option) any later version.
	16	*
	17	* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
	18	* KIND, either express or implied.
	19	*
	20	****************************************************************************/
	21
	22	#define MIXER_OPTIMIZED_WRITE_SAMPLES
	23	#define MIXER_OPTIMIZED_MIX_SAMPLES
	24
	25	/* Mix channels' samples and apply gain factors */
	26	static FORCE_INLINE void mix_samples(void *out,
	27	void *src0,
	28	int32_t src0_amp,
	29	void *src1,
	30	int32_t src1_amp,
	31	size_t size)
	32	{
	33	int32_t s0, s1, tmp;
	34	asm volatile (
	35	"1: \n"
	36	"ldr %4, [%1], #4 \n"
	37	"ldr %5, [%2], #4 \n"
	38	"smulwb %6, %7, %4 \n"
	39	"smulwt %4, %7, %4 \n"
	40	"smlawb %6, %8, %5, %6 \n"
	41	"smlawt %4, %8, %5, %4 \n"
	42	"mov %5, %6, asr #15 \n"
	43	"teq %5, %5, asr #31 \n"
	44	"eorne %6, %9, %6, asr #31 \n"
	45	"mov %5, %4, asr #15 \n"
	46	"teq %5, %5, asr #31 \n"
	47	"eorne %4, %9, %4, asr #31 \n"
	48	"subs %3, %3, #4 \n"
	49	"and %6, %6, %9, lsr #16 \n"
	50	"orr %6, %6, %4, lsl #16 \n"
	51	"str %6, [%0], #4 \n"
	52	"bhi 1b \n"
	53	: "+r"(out), "+r"(src0), "+r"(src1), "+r"(size),
	54	"=&r"(s0), "=&r"(s1), "=&r"(tmp)
	55	: "r"(src0_amp), "r"(src1_amp), "r"(0xffff7fff));
	56	}
	57
	58	/* Write channel's samples and apply gain factor */
	59	static FORCE_INLINE void write_samples(void *out,
	60	void *src,
	61	int32_t amp,
	62	size_t size)
	63	{
	64	if (LIKELY(amp == MIX_AMP_UNITY))
	65	{
	66	/* Channel is unity amplitude */
	67	asm volatile (
	68	"ands r1, %2, #0x1f \n"
	69	"beq 2f \n"
	70	"1: \n"
	71	"ldr r0, [%1], #4 \n"
	72	"subs r1, r1, #4 \n"
	73	"str r0, [%0], #4 \n"
	74	"bne 1b \n"
	75	"bics %2, %2, #0x1f \n"
	76	"beq 3f \n"
	77	"2: \n"
	78	"ldmia %1!, { r0-r7 } \n"
	79	"subs %2, %2, #32 \n"
	80	"stmia %0!, { r0-r7 } \n"
	81	"bhi 2b \n"
	82	"3: \n"
	83	: "+r"(out), "+r"(src), "+r"(size)
	84	:
	85	: "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7");
	86	}
	87	else
	88	{
	89	/* Channel needs amplitude cut */
	90	uint32_t l, h;
	91	asm volatile (
	92	"1: \n"
	93	"ldr %3, [%1], #4 \n"
	94	"subs %2, %2, #4 \n"
	95	"smulwt %4, %5, %3 \n"
	96	"smulwb %3, %5, %3 \n"
	97	"mov %4, %4, lsl #16 \n"
	98	"mov %3, %3, lsl #16 \n"
	99	"orr %4, %4, %3, lsr #16 \n"
	100	"str %4, [%0], #4 \n"
	101	"bhi 1b \n"
	102	: "+r"(out), "+r"(src), "+r"(size),
	103	"=&r"(l), "=&r"(h)
	104	: "r"(amp));
	105	}
	106	}