207 lines
8.8 KiB
C
207 lines
8.8 KiB
C
|
/***************************************************************************
|
||
|
|
* __________ __ ___.
|
||
|
|
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
||
|
|
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
||
|
|
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
||
|
|
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
||
|
|
* \/ \/ \/ \/ \/
|
||
|
|
* $Id$
|
||
|
|
*
|
||
|
|
* Copyright (C) 2010 Nils Wallménius
|
||
|
|
*
|
||
|
|
* Coldfire v2 optimisations for ffmpeg's fft (used in fft-ffmpeg.c)
|
||
|
|
*
|
||
|
|
* 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.
|
||
|
|
*
|
||
|
|
****************************************************************************/
|
||
|
|
|
||
|
|
#ifdef CPU_COLDFIRE
|
||
|
|
#define FFT_FFMPEG_INCL_OPTIMISED_FFT4
|
||
|
|
static inline void fft4(FFTComplex * z)
|
||
|
|
{
|
||
|
|
asm volatile ("movem.l (%[z]), %%d0-%%d7\n\t"
|
||
|
|
"move.l %%d0, %%a0\n\t"
|
||
|
|
"add.l %%d2, %%d0\n\t" /* d0 == t1 */
|
||
|
|
"neg.l %%d2\n\t"
|
||
|
|
"add.l %%a0, %%d2\n\t" /* d2 == t3, a0 free */
|
||
|
|
"move.l %%d6, %%a0\n\t"
|
||
|
|
"sub.l %%d4, %%d6\n\t" /* d6 == t8 */
|
||
|
|
"add.l %%d4, %%a0\n\t" /* a0 == t6 */
|
||
|
|
|
||
|
|
"move.l %%d0, %%d4\n\t"
|
||
|
|
"sub.l %%a0, %%d4\n\t" /* z[2].re done */
|
||
|
|
"add.l %%a0, %%d0\n\t" /* z[0].re done, a0 free */
|
||
|
|
|
||
|
|
"move.l %%d5, %%a0\n\t"
|
||
|
|
"sub.l %%d7, %%d5\n\t" /* d5 == t7 */
|
||
|
|
"add.l %%d7, %%a0\n\t" /* a0 == t5 */
|
||
|
|
|
||
|
|
"move.l %%d1, %%d7\n\t"
|
||
|
|
"sub.l %%d3, %%d7\n\t" /* d7 == t4 */
|
||
|
|
"add.l %%d3, %%d1\n\t" /* d1 == t2 */
|
||
|
|
|
||
|
|
"move.l %%d7, %%d3\n\t"
|
||
|
|
"sub.l %%d6, %%d7\n\t" /* z[3].im done */
|
||
|
|
"add.l %%d6, %%d3\n\t" /* z[1].im done */
|
||
|
|
|
||
|
|
"move.l %%d2, %%d6\n\t"
|
||
|
|
"sub.l %%d5, %%d6\n\t" /* z[3].re done */
|
||
|
|
"add.l %%d5, %%d2\n\t" /* z[1].re done */
|
||
|
|
|
||
|
|
"move.l %%d1, %%d5\n\t"
|
||
|
|
"sub.l %%a0, %%d5\n\t" /* z[2].im done */
|
||
|
|
"add.l %%a0, %%d1\n\t" /* z[0].im done */
|
||
|
|
|
||
|
|
"movem.l %%d0-%%d7, (%[z])\n\t"
|
||
|
|
: :[z] "a" (z)
|
||
|
|
: "d0", "d1", "d2", "d3", "d4", "d5", "d6", "d7",
|
||
|
|
"a0", "cc", "memory");
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
#define FFT_FFMPEG_INCL_OPTIMISED_FFT8
|
||
|
|
static inline void fft8(FFTComplex *z)
|
||
|
|
{
|
||
|
|
asm volatile ("movem.l (4*8, %[z]), %%d0-%%d7\n\t"
|
||
|
|
"move.l %%d0, %%a1\n\t"
|
||
|
|
"add.l %%d2, %%a1\n\t" /* a1 == t1 */
|
||
|
|
"sub.l %%d2, %%d0\n\t" /* d0 == z[5].re */
|
||
|
|
|
||
|
|
"move.l %%d1, %%a2\n\t"
|
||
|
|
"add.l %%d3, %%a2\n\t" /* a2 == t2 */
|
||
|
|
"sub.l %%d3, %%d1\n\t" /* d1 == z[5].im */
|
||
|
|
|
||
|
|
"move.l %%d4, %%d2\n\t"
|
||
|
|
"add.l %%d6, %%d2\n\t" /* d2 == t3 */
|
||
|
|
"sub.l %%d6, %%d4\n\t" /* d4 == z[7].re */
|
||
|
|
|
||
|
|
"move.l %%d5, %%d3\n\t"
|
||
|
|
"add.l %%d7, %%d3\n\t" /* d3 == t4 */
|
||
|
|
"sub.l %%d7, %%d5\n\t" /* d5 == z[7].im */
|
||
|
|
|
||
|
|
"move.l %%d2, %%a4\n\t"
|
||
|
|
"sub.l %%a1, %%a4\n\t" /* a4 == t8 */
|
||
|
|
"add.l %%d2, %%a1\n\t" /* a1 == t1, d2 free */
|
||
|
|
|
||
|
|
"move.l %%a2, %%a3\n\t"
|
||
|
|
"sub.l %%d3, %%a3\n\t" /* a3 == t7 */
|
||
|
|
"add.l %%d3, %%a2\n\t" /* a2 == t2, d3 free */
|
||
|
|
|
||
|
|
/* emac block from TRANSFORM_EQUAL, do this now
|
||
|
|
so we don't need to store and load z[5] and z[7] */
|
||
|
|
"move.l %[_cPI2_8], %%d2\n\t"
|
||
|
|
"mac.l %%d2, %%d0, %%acc0\n\t"
|
||
|
|
"mac.l %%d2, %%d1, %%acc1\n\t"
|
||
|
|
"mac.l %%d2, %%d4, %%acc2\n\t"
|
||
|
|
"mac.l %%d2, %%d5, %%acc3\n\t"
|
||
|
|
|
||
|
|
/* fft4, clobbers all d regs and a0 */
|
||
|
|
"movem.l (%[z]), %%d0-%%d7\n\t"
|
||
|
|
"move.l %%d0, %%a0\n\t"
|
||
|
|
"add.l %%d2, %%d0\n\t" /* d0 == t1 */
|
||
|
|
"neg.l %%d2\n\t"
|
||
|
|
"add.l %%a0, %%d2\n\t" /* d2 == t3, a0 free */
|
||
|
|
"move.l %%d6, %%a0\n\t"
|
||
|
|
"sub.l %%d4, %%d6\n\t" /* d6 == t8 */
|
||
|
|
"add.l %%d4, %%a0\n\t" /* a0 == t6 */
|
||
|
|
|
||
|
|
"move.l %%d0, %%d4\n\t"
|
||
|
|
"sub.l %%a0, %%d4\n\t" /* z[2].re done */
|
||
|
|
"add.l %%a0, %%d0\n\t" /* z[0].re done, a0 free */
|
||
|
|
|
||
|
|
"move.l %%d5, %%a0\n\t"
|
||
|
|
"sub.l %%d7, %%d5\n\t" /* d5 == t7 */
|
||
|
|
"add.l %%d7, %%a0\n\t" /* a0 == t5 */
|
||
|
|
|
||
|
|
"move.l %%d1, %%d7\n\t"
|
||
|
|
"sub.l %%d3, %%d7\n\t" /* d7 == t4 */
|
||
|
|
"add.l %%d3, %%d1\n\t" /* d1 == t2 */
|
||
|
|
|
||
|
|
"move.l %%d7, %%d3\n\t"
|
||
|
|
"sub.l %%d6, %%d7\n\t" /* z[3].im done */
|
||
|
|
"add.l %%d6, %%d3\n\t" /* z[1].im done */
|
||
|
|
|
||
|
|
"move.l %%d2, %%d6\n\t"
|
||
|
|
"sub.l %%d5, %%d6\n\t" /* z[3].re done */
|
||
|
|
"add.l %%d5, %%d2\n\t" /* z[1].re done */
|
||
|
|
|
||
|
|
"move.l %%d1, %%d5\n\t"
|
||
|
|
"sub.l %%a0, %%d5\n\t" /* z[2].im done */
|
||
|
|
"add.l %%a0, %%d1\n\t" /* z[0].im done */
|
||
|
|
/* end of fft4, but don't store yet */
|
||
|
|
|
||
|
|
"move.l %%d0, %%a0\n\t"
|
||
|
|
"add.l %%a1, %%d0\n\t"
|
||
|
|
"sub.l %%a1, %%a0\n\t" /* z[4].re, z[0].re done, a1 free */
|
||
|
|
|
||
|
|
"move.l %%d1, %%a1\n\t"
|
||
|
|
"add.l %%a2, %%d1\n\t"
|
||
|
|
"sub.l %%a2, %%a1\n\t" /* z[4].im, z[0].im done, a2 free */
|
||
|
|
|
||
|
|
"move.l %%d4, %%a2\n\t"
|
||
|
|
"add.l %%a3, %%d4\n\t"
|
||
|
|
"sub.l %%a3, %%a2\n\t" /* z[6].re, z[2].re done, a3 free */
|
||
|
|
|
||
|
|
"move.l %%d5, %%a3\n\t"
|
||
|
|
"add.l %%a4, %%d5\n\t"
|
||
|
|
"sub.l %%a4, %%a3\n\t" /* z[6].im, z[2].im done, a4 free */
|
||
|
|
|
||
|
|
"movem.l %%d0-%%d1, (%[z])\n\t" /* save z[0] */
|
||
|
|
"movem.l %%d4-%%d5, (2*8, %[z])\n\t" /* save z[2] */
|
||
|
|
"movem.l %%a0-%%a1, (4*8, %[z])\n\t" /* save z[4] */
|
||
|
|
"movem.l %%a2-%%a3, (6*8, %[z])\n\t" /* save z[6] */
|
||
|
|
|
||
|
|
/* TRANSFORM_EQUAL */
|
||
|
|
"movclr.l %%acc0, %%d0\n\t"
|
||
|
|
"movclr.l %%acc1, %%d1\n\t"
|
||
|
|
"movclr.l %%acc2, %%d4\n\t"
|
||
|
|
"movclr.l %%acc3, %%d5\n\t"
|
||
|
|
|
||
|
|
"move.l %%d1, %%a0\n\t"
|
||
|
|
"add.l %%d0, %%a0\n\t" /* a0 == t1 */
|
||
|
|
"sub.l %%d0, %%d1\n\t" /* d1 == t2 */
|
||
|
|
|
||
|
|
"move.l %%d4, %%d0\n\t"
|
||
|
|
"add.l %%d5, %%d0\n\t" /* d0 == t6 */
|
||
|
|
"sub.l %%d5, %%d4\n\t" /* d4 == t5 */
|
||
|
|
|
||
|
|
"move.l %%d4, %%a1\n\t"
|
||
|
|
"sub.l %%a0, %%a1\n\t" /* a1 == temp1 */
|
||
|
|
"add.l %%a0, %%d4\n\t" /* d4 == temp2 */
|
||
|
|
|
||
|
|
"move.l %%d2, %%a2\n\t"
|
||
|
|
"sub.l %%d4, %%a2\n\t" /* a2 == z[5].re */
|
||
|
|
"add.l %%d4, %%d2\n\t" /* z[1].re done */
|
||
|
|
|
||
|
|
"move.l %%d7, %%d5\n\t"
|
||
|
|
"sub.l %%a1, %%d5\n\t" /* d5 == z[7].im */
|
||
|
|
"add.l %%a1, %%d7\n\t" /* z[3].im done */
|
||
|
|
|
||
|
|
"move.l %%d1, %%a0\n\t"
|
||
|
|
"sub.l %%d0, %%a0\n\t" /* a0 == temp1 */
|
||
|
|
"add.l %%d0, %%d1\n\t" /* d1 == temp2 */
|
||
|
|
|
||
|
|
"move.l %%d6, %%d4\n\t"
|
||
|
|
"sub.l %%a0, %%d4\n\t" /* d4 == z[7].re */
|
||
|
|
"add.l %%a0, %%d6\n\t" /* z[3].re done */
|
||
|
|
|
||
|
|
"move.l %%d3, %%a3\n\t"
|
||
|
|
"sub.l %%d1, %%a3\n\t" /* a3 == z[5].im */
|
||
|
|
"add.l %%d1, %%d3\n\t" /* z[1].im done */
|
||
|
|
|
||
|
|
"movem.l %%d2-%%d3, (1*8, %[z])\n\t" /* save z[1] */
|
||
|
|
"movem.l %%d6-%%d7, (3*8, %[z])\n\t" /* save z[3] */
|
||
|
|
"movem.l %%a2-%%a3, (5*8, %[z])\n\t" /* save z[5] */
|
||
|
|
"movem.l %%d4-%%d5, (7*8, %[z])\n\t" /* save z[7] */
|
||
|
|
: :[z] "a" (z), [_cPI2_8] "i" (cPI2_8)
|
||
|
|
: "d0", "d1", "d2", "d3", "d4", "d5", "d6", "d7",
|
||
|
|
"a0", "a1", "a2", "a3", "a4", "cc", "memory");
|
||
|
|
}
|
||
|
|
#endif /* CPU_COLDIFRE */
|