diff options
Diffstat (limited to 'firmware/asm/arm/pcm-mixer-armv5.c')
-rw-r--r-- | firmware/asm/arm/pcm-mixer-armv5.c | 106 |
1 files changed, 106 insertions, 0 deletions
diff --git a/firmware/asm/arm/pcm-mixer-armv5.c b/firmware/asm/arm/pcm-mixer-armv5.c new file mode 100644 index 0000000000..64f2c86f52 --- /dev/null +++ b/firmware/asm/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)); + } +} |