diff options
author | nick <nick@b3059339-0415-0410-9bf9-f77b7e298cf2> | 2002-02-03 10:27:26 +0000 |
---|---|---|
committer | nick <nick@b3059339-0415-0410-9bf9-f77b7e298cf2> | 2002-02-03 10:27:26 +0000 |
commit | 2fe888069c1b2a2036376f7ec734c04b6a0202e0 (patch) | |
tree | a4dd048287b476170dcdc88eb797488366646d2d /liba52 | |
parent | f6720f6a824dd0819a026eb358944936f6c46e83 (diff) |
Restore K7 support
git-svn-id: svn://svn.mplayerhq.hu/mplayer/trunk@4498 b3059339-0415-0410-9bf9-f77b7e298cf2
Diffstat (limited to 'liba52')
-rw-r--r-- | liba52/imdct.c | 583 | ||||
-rw-r--r-- | liba52/imdct_3dnow.h | 572 |
2 files changed, 600 insertions, 555 deletions
diff --git a/liba52/imdct.c b/liba52/imdct.c index 2553ca8cba..61a337fec4 100644 --- a/liba52/imdct.c +++ b/liba52/imdct.c @@ -54,7 +54,6 @@ typedef struct complex_s { } complex_t; static void fft_128p(complex_t *a); -static void fft_128p_3dnow(complex_t *a); static const int pm128[128] __attribute__((aligned(16))) = { @@ -382,259 +381,22 @@ imdct_do_512(sample_t data[],sample_t delay[], sample_t bias) } } +// Stuff below this line is borrowed from libac3 +#include "srfftp.h" #ifdef ARCH_X86 +#ifndef HAVE_3DNOW +#define HAVE_3DNOW 1 +#endif #include "srfftp_3dnow.h" const i_cmplx_t x_plus_minus_3dnow __attribute__ ((aligned (8))) = { 0x00000000UL, 0x80000000UL }; const i_cmplx_t x_minus_plus_3dnow __attribute__ ((aligned (8))) = { 0x80000000UL, 0x00000000UL }; const complex_t HSQRT2_3DNOW __attribute__ ((aligned (8))) = { 0.707106781188, 0.707106781188 }; -void -imdct_do_512_3dnow(sample_t data[],sample_t delay[], sample_t bias) -{ - int i,k; - int p,q; - int m; - int two_m; - int two_m_plus_one; - - sample_t tmp_a_i; - sample_t tmp_a_r; - sample_t tmp_b_i; - sample_t tmp_b_r; - - sample_t *data_ptr; - sample_t *delay_ptr; - sample_t *window_ptr; - - /* 512 IMDCT with source and dest data in 'data' */ - - /* Pre IFFT complex multiply plus IFFT cmplx conjugate & reordering*/ -#if 1 - __asm__ __volatile__ ( - "movq %0, %%mm7\n\t" - ::"m"(x_plus_minus_3dnow) - :"memory"); - for( i=0; i < 128; i++) { - int j = pm128[i]; - __asm__ __volatile__ ( - "movd %1, %%mm0\n\t" - "movd %3, %%mm1\n\t" - "punpckldq %2, %%mm0\n\t" /* mm0 = data[256-2*j-1] | data[2*j]*/ - "punpckldq %4, %%mm1\n\t" /* mm1 = xcos[j] | xsin[j] */ - "movq %%mm0, %%mm2\n\t" - "pfmul %%mm1, %%mm0\n\t" -#ifdef HAVE_3DNOWEX - "pswapd %%mm1, %%mm1\n\t" -#else - "movq %%mm1, %%mm5\n\t" - "psrlq $32, %%mm1\n\t" - "punpckldq %%mm5, %%mm1\n\t" -#endif - "pfmul %%mm1, %%mm2\n\t" -#ifdef HAVE_3DNOWEX - "pfpnacc %%mm2, %%mm0\n\t" -#else - "pxor %%mm7, %%mm0\n\t" - "pfacc %%mm2, %%mm0\n\t" -#endif - "pxor %%mm7, %%mm0\n\t" - "movq %%mm0, %0" - :"=m"(buf[i]) - :"m"(data[256-2*j-1]), "m"(data[2*j]), "m"(xcos1[j]), "m"(xsin1[j]) - :"memory" - ); -/* buf[i].re = (data[256-2*j-1] * xcos1[j] - data[2*j] * xsin1[j]); - buf[i].im = (data[256-2*j-1] * xsin1[j] + data[2*j] * xcos1[j])*(-1.0);*/ - } -#else - __asm__ __volatile__ ("femms":::"memory"); - for( i=0; i < 128; i++) { - /* z[i] = (X[256-2*i-1] + j * X[2*i]) * (xcos1[i] + j * xsin1[i]) ; */ - int j= pm128[i]; - buf[i].real = (data[256-2*j-1] * xcos1[j]) - (data[2*j] * xsin1[j]); - buf[i].imag = -1.0 * ((data[2*j] * xcos1[j]) + (data[256-2*j-1] * xsin1[j])); - } -#endif - - /* FFT Merge */ -/* unoptimized variant - for (m=1; m < 7; m++) { - if(m) - two_m = (1 << m); - else - two_m = 1; - - two_m_plus_one = (1 << (m+1)); - - for(i = 0; i < 128; i += two_m_plus_one) { - for(k = 0; k < two_m; k++) { - p = k + i; - q = p + two_m; - tmp_a_r = buf[p].real; - tmp_a_i = buf[p].imag; - tmp_b_r = buf[q].real * w[m][k].real - buf[q].imag * w[m][k].imag; - tmp_b_i = buf[q].imag * w[m][k].real + buf[q].real * w[m][k].imag; - buf[p].real = tmp_a_r + tmp_b_r; - buf[p].imag = tmp_a_i + tmp_b_i; - buf[q].real = tmp_a_r - tmp_b_r; - buf[q].imag = tmp_a_i - tmp_b_i; - } - } - } -*/ - - fft_128p_3dnow (&buf[0]); -// asm volatile ("femms \n\t":::"memory"); - - /* Post IFFT complex multiply plus IFFT complex conjugate*/ -#if 1 - __asm__ __volatile__ ( - "movq %0, %%mm7\n\t" - "movq %1, %%mm6\n\t" - ::"m"(x_plus_minus_3dnow), - "m"(x_minus_plus_3dnow) - :"eax","memory"); - for (i=0; i < 128; i++) { - __asm__ __volatile__ ( - "movq %1, %%mm0\n\t" /* ac3_buf[i].re | ac3_buf[i].im */ - "movq %%mm0, %%mm1\n\t" /* ac3_buf[i].re | ac3_buf[i].im */ -#ifndef HAVE_3DNOWEX - "movq %%mm1, %%mm2\n\t" - "psrlq $32, %%mm1\n\t" - "punpckldq %%mm2, %%mm1\n\t" -#else - "pswapd %%mm1, %%mm1\n\t" /* ac3_buf[i].re | ac3_buf[i].im */ -#endif - "movd %3, %%mm3\n\t" /* ac3_xsin[i] */ - "punpckldq %2, %%mm3\n\t" /* ac3_xsin[i] | ac3_xcos[i] */ - "pfmul %%mm3, %%mm0\n\t" - "pfmul %%mm3, %%mm1\n\t" -#ifndef HAVE_3DNOWEX - "pxor %%mm7, %%mm0\n\t" - "pfacc %%mm1, %%mm0\n\t" - "movd %%mm0, 4%0\n\t" - "psrlq $32, %%mm0\n\t" - "movd %%mm0, %0\n\t" -#else - "pfpnacc %%mm1, %%mm0\n\t" /* mm0 = mm0[0] - mm0[1] | mm1[0] + mm1[1] */ - "pswapd %%mm0, %%mm0\n\t" - "movq %%mm0, %0" -#endif - :"=m"(buf[i]) - :"m"(buf[i]),"m"(xcos1[i]),"m"(xsin1[i]) - :"memory"); -/* ac3_buf[i].re =(tmp_a_r * ac3_xcos1[i]) + (tmp_a_i * ac3_xsin1[i]); - ac3_buf[i].im =(tmp_a_r * ac3_xsin1[i]) - (tmp_a_i * ac3_xcos1[i]);*/ - } -#else - __asm__ __volatile__ ("femms":::"memory"); - for( i=0; i < 128; i++) { - /* y[n] = z[n] * (xcos1[n] + j * xsin1[n]) ; */ - tmp_a_r = buf[i].real; - tmp_a_i = -1.0 * buf[i].imag; - buf[i].real =(tmp_a_r * xcos1[i]) - (tmp_a_i * xsin1[i]); - buf[i].imag =(tmp_a_r * xsin1[i]) + (tmp_a_i * xcos1[i]); - } -#endif - - data_ptr = data; - delay_ptr = delay; - window_ptr = imdct_window; - - /* Window and convert to real valued signal */ -#if 1 - asm volatile ( - "movd (%0), %%mm3 \n\t" - "punpckldq %%mm3, %%mm3 \n\t" - :: "r" (&bias) - ); - for (i=0; i< 64; i++) { -/* merge two loops in one to enable working of 2 decoders */ - __asm__ __volatile__ ( - "movd 516(%1), %%mm0\n\t" - "movd (%1), %%mm1\n\t" /**data_ptr++=-buf[64+i].im**window_ptr+++*delay_ptr++;*/ - "punpckldq (%2), %%mm0\n\t"/*data_ptr[128]=-buf[i].re*window_ptr[128]+delay_ptr[128];*/ - "punpckldq 516(%2), %%mm1\n\t" - "pfmul (%3), %%mm0\n\t"/**data_ptr++=buf[64-i-1].re**window_ptr+++*delay_ptr++;*/ - "pfmul 512(%3), %%mm1\n\t" - "pxor %%mm6, %%mm0\n\t"/*data_ptr[128]=buf[128-i-1].im*window_ptr[128]+delay_ptr[128];*/ - "pxor %%mm6, %%mm1\n\t" - "pfadd (%4), %%mm0\n\t" - "pfadd 512(%4), %%mm1\n\t" - "pfadd %%mm3, %%mm0\n\t" - "pfadd %%mm3, %%mm1\n\t" - "movq %%mm0, (%0)\n\t" - "movq %%mm1, 512(%0)" - :"=r"(data_ptr) - :"r"(&buf[i].real), "r"(&buf[64-i-1].real), "r"(window_ptr), "r"(delay_ptr), "0"(data_ptr) - :"memory"); - data_ptr += 2; - window_ptr += 2; - delay_ptr += 2; - } - window_ptr += 128; -#else - __asm__ __volatile__ ("femms":::"memory"); - for(i=0; i< 64; i++) { - *data_ptr++ = -buf[64+i].imag * *window_ptr++ + *delay_ptr++ + bias; - *data_ptr++ = buf[64-i-1].real * *window_ptr++ + *delay_ptr++ + bias; - } - - for(i=0; i< 64; i++) { - *data_ptr++ = -buf[i].real * *window_ptr++ + *delay_ptr++ + bias; - *data_ptr++ = buf[128-i-1].imag * *window_ptr++ + *delay_ptr++ + bias; - } -#endif - - /* The trailing edge of the window goes into the delay line */ - delay_ptr = delay; -#if 1 - for(i=0; i< 64; i++) { -/* merge two loops in one to enable working of 2 decoders */ - window_ptr -=2; - __asm__ __volatile__( - "movd 508(%1), %%mm0\n\t" - "movd (%1), %%mm1\n\t" - "punpckldq (%2), %%mm0\n\t" - "punpckldq 508(%2), %%mm1\n\t" -#ifdef HAVE_3DNOWEX - "pswapd (%3), %%mm3\n\t" - "pswapd -512(%3), %%mm4\n\t" -#else - "movq (%3), %%mm3\n\t"/**delay_ptr++=-buf[64+i].re**--window_ptr;*/ - "movq -512(%3), %%mm4\n\t" - "psrlq $32, %%mm3\n\t"/*delay_ptr[128]=buf[i].im**window_ptr[-512];*/ - "psrlq $32, %%mm4\n\t"/**delay_ptr++=buf[64-i-1].im**--window_ptr;*/ - "punpckldq (%3), %%mm3\n\t"/*delay_ptr[128]=-buf[128-i-1].re**window_ptr[-512];*/ - "punpckldq -512(%3), %%mm4\n\t" -#endif - "pfmul %%mm3, %%mm0\n\t" - "pfmul %%mm4, %%mm1\n\t" - "pxor %%mm6, %%mm0\n\t" - "pxor %%mm7, %%mm1\n\t" - "movq %%mm0, (%0)\n\t" - "movq %%mm1, 512(%0)" - :"=r"(delay_ptr) - :"r"(&buf[i].imag), "r"(&buf[64-i-1].imag), "r"(window_ptr), "0"(delay_ptr) - :"memory"); - delay_ptr += 2; - } - __asm__ __volatile__ ("femms":::"memory"); -#else - __asm__ __volatile__ ("femms":::"memory"); - for(i=0; i< 64; i++) { - *delay_ptr++ = -buf[64+i].real * *--window_ptr; - *delay_ptr++ = buf[64-i-1].imag * *--window_ptr; - } - - for(i=0; i<64; i++) { - *delay_ptr++ = buf[i].imag * *--window_ptr; - *delay_ptr++ = -buf[128-i-1].real * *--window_ptr; - } -#endif -} - +#undef HAVE_3DNOWEX +#include "imdct_3dnow.h" +#define HAVE_3DNOWEX +#include "imdct_3dnow.h" void imdct_do_512_sse(sample_t data[],sample_t delay[], sample_t bias) @@ -1107,10 +869,6 @@ void imdct_init (uint32_t mm_accel) { int i, j, k; - if(mm_accel & MM_ACCEL_X86_SSE) fprintf (stderr, "Using SSE optimized IMDCT transform\n"); - else if(mm_accel & MM_ACCEL_X86_3DNOW) fprintf (stderr, "Using 3DNow optimized IMDCT transform\n"); - else fprintf (stderr, "No accelerated IMDCT transform found\n"); - /* Twiddle factors to turn IFFT into IMDCT */ for (i = 0; i < 128; i++) { xcos1[i] = -cos ((M_PI / 2048) * (8 * i + 1)); @@ -1185,315 +943,30 @@ void imdct_init (uint32_t mm_accel) imdct_512 = imdct_do_512; #ifdef ARCH_X86 - if(mm_accel & MM_ACCEL_X86_SSE) imdct_512 = imdct_do_512_sse; - else if(mm_accel & MM_ACCEL_X86_3DNOW) imdct_512 = imdct_do_512_3dnow; + if(mm_accel & MM_ACCEL_X86_SSE) + { + fprintf (stderr, "Using SSE optimized IMDCT transform\n"); + imdct_512 = imdct_do_512_sse; + } + else + if(mm_accel & MM_ACCEL_X86_3DNOWEXT) + { + fprintf (stderr, "Using 3DNowEx optimized IMDCT transform\n"); + imdct_512 = imdct_do_512_3dnowex; + } + else + if(mm_accel & MM_ACCEL_X86_3DNOW) + { + fprintf (stderr, "Using 3DNow optimized IMDCT transform\n"); + imdct_512 = imdct_do_512_3dnow; + } + else #endif // arch_x86 + fprintf (stderr, "No accelerated IMDCT transform found\n"); imdct_256 = imdct_do_256; } } -// Stuff below this line is borrowed from libac3 -#include "srfftp.h" - -#ifdef ARCH_X86 - -static void fft_4_3dnow(complex_t *x) -{ - /* delta_p = 1 here */ - /* x[k] = sum_{i=0..3} x[i] * w^{i*k}, w=e^{-2*pi/4} - */ - __asm__ __volatile__( - "movq 24(%1), %%mm3\n\t" - "movq 8(%1), %%mm1\n\t" - "pxor %2, %%mm3\n\t" /* mm3.re | -mm3.im */ - "pxor %3, %%mm1\n\t" /* -mm1.re | mm1.im */ - "pfadd %%mm1, %%mm3\n\t" /* vi.im = x[3].re - x[1].re; */ - "movq %%mm3, %%mm4\n\t" /* vi.re =-x[3].im + x[1].im; mm4 = vi */ -#ifdef HAVE_3DNOWEX - "pswapd %%mm4, %%mm4\n\t" -#else - "movq %%mm4, %%mm5\n\t" - "psrlq $32, %%mm4\n\t" - "punpckldq %%mm5, %%mm4\n\t" -#endif - "movq (%1), %%mm5\n\t" /* yb.re = x[0].re - x[2].re; */ - "movq (%1), %%mm6\n\t" /* yt.re = x[0].re + x[2].re; */ - "movq 24(%1), %%mm7\n\t" /* u.re = x[3].re + x[1].re; */ - "pfsub 16(%1), %%mm5\n\t" /* yb.im = x[0].im - x[2].im; mm5 = yb */ - "pfadd 16(%1), %%mm6\n\t" /* yt.im = x[0].im + x[2].im; mm6 = yt */ - "pfadd 8(%1), %%mm7\n\t" /* u.im = x[3].im + x[1].im; mm7 = u */ - - "movq %%mm6, %%mm0\n\t" /* x[0].re = yt.re + u.re; */ - "movq %%mm5, %%mm1\n\t" /* x[1].re = yb.re + vi.re; */ - "pfadd %%mm7, %%mm0\n\t" /*x[0].im = yt.im + u.im; */ - "pfadd %%mm4, %%mm1\n\t" /* x[1].im = yb.im + vi.im; */ - "movq %%mm0, (%0)\n\t" - "movq %%mm1, 8(%0)\n\t" - - "pfsub %%mm7, %%mm6\n\t" /* x[2].re = yt.re - u.re; */ - "pfsub %%mm4, %%mm5\n\t" /* x[3].re = yb.re - vi.re; */ - "movq %%mm6, 16(%0)\n\t" /* x[2].im = yt.im - u.im; */ - "movq %%mm5, 24(%0)" /* x[3].im = yb.im - vi.im; */ - :"=r"(x) - :"0"(x), - "m"(x_plus_minus_3dnow), - "m"(x_minus_plus_3dnow) - :"memory"); -} - -static void fft_8_3dnow(complex_t *x) -{ - /* delta_p = diag{1, sqrt(i)} here */ - /* x[k] = sum_{i=0..7} x[i] * w^{i*k}, w=e^{-2*pi/8} - */ - complex_t wT1, wB1, wB2; - - __asm__ __volatile__( - "movq 8(%2), %%mm0\n\t" - "movq 24(%2), %%mm1\n\t" - "movq %%mm0, %0\n\t" /* wT1 = x[1]; */ - "movq %%mm1, %1\n\t" /* wB1 = x[3]; */ - :"=m"(wT1), "=m"(wB1) - :"r"(x) - :"memory"); - - __asm__ __volatile__( - "movq 16(%0), %%mm2\n\t" - "movq 32(%0), %%mm3\n\t" - "movq %%mm2, 8(%0)\n\t" /* x[1] = x[2]; */ - "movq 48(%0), %%mm4\n\t" - "movq %%mm3, 16(%0)\n\t" /* x[2] = x[4]; */ - "movq %%mm4, 24(%0)\n\t" /* x[3] = x[6]; */ - :"=r"(x) - :"0"(x) - :"memory"); - - fft_4_3dnow(&x[0]); - - /* x[0] x[4] x[2] x[6] */ - - __asm__ __volatile__( - "movq 40(%1), %%mm0\n\t" - "movq %%mm0, %%mm3\n\t" - "movq 56(%1), %%mm1\n\t" - "pfadd %%mm1, %%mm0\n\t" - "pfsub %%mm1, %%mm3\n\t" - "movq (%2), %%mm2\n\t" - "pfadd %%mm2, %%mm0\n\t" - "pfadd %%mm2, %%mm3\n\t" - "movq (%3), %%mm1\n\t" - "pfadd %%mm1, %%mm0\n\t" - "pfsub %%mm1, %%mm3\n\t" - "movq (%1), %%mm1\n\t" - "movq 16(%1), %%mm4\n\t" - "movq %%mm1, %%mm2\n\t" -#ifdef HAVE_3DNOWEX - "pswapd %%mm3, %%mm3\n\t" -#else - "movq %%mm3, %%mm6\n\t" - "psrlq $32, %%mm3\n\t" - "punpckldq %%mm6, %%mm3\n\t" -#endif - "pfadd %%mm0, %%mm1\n\t" - "movq %%mm4, %%mm5\n\t" - "pfsub %%mm0, %%mm2\n\t" - "pfadd %%mm3, %%mm4\n\t" - "movq %%mm1, (%0)\n\t" - "pfsub %%mm3, %%mm5\n\t" - "movq %%mm2, 32(%0)\n\t" - "movd %%mm4, 16(%0)\n\t" - "movd %%mm5, 48(%0)\n\t" - "psrlq $32, %%mm4\n\t" - "psrlq $32, %%mm5\n\t" - "movd %%mm4, 52(%0)\n\t" - "movd %%mm5, 20(%0)" - :"=r"(x) - :"0"(x), "r"(&wT1), "r"(&wB1) - :"memory"); - - /* x[1] x[5] */ - __asm__ __volatile__ ( - "movq %6, %%mm6\n\t" - "movq %5, %%mm7\n\t" - "movq %1, %%mm0\n\t" - "movq %2, %%mm1\n\t" - "movq 56(%3), %%mm3\n\t" - "pfsub 40(%3), %%mm0\n\t" -#ifdef HAVE_3DNOWEX - "pswapd %%mm1, %%mm1\n\t" -#else - "movq %%mm1, %%mm2\n\t" - "psrlq $32, %%mm1\n\t" - "punpckldq %%mm2,%%mm1\n\t" -#endif - "pxor %%mm7, %%mm1\n\t" - "pfadd %%mm1, %%mm0\n\t" -#ifdef HAVE_3DNOWEX - "pswapd %%mm3, %%mm3\n\t" -#else - "movq %%mm3, %%mm2\n\t" - "psrlq $32, %%mm3\n\t" - "punpckldq %%mm2,%%mm3\n\t" -#endif - "pxor %%mm6, %%mm3\n\t" - "pfadd %%mm3, %%mm0\n\t" - "movq %%mm0, %%mm1\n\t" - "pxor %%mm6, %%mm1\n\t" - "pfacc %%mm1, %%mm0\n\t" - "pfmul %4, %%mm0\n\t" - - "movq 40(%3), %%mm5\n\t" -#ifdef HAVE_3DNOWEX - "pswapd %%mm5, %%mm5\n\t" -#else - "movq %%mm5, %%mm1\n\t" - "psrlq $32, %%mm5\n\t" - "punpckldq %%mm1,%%mm5\n\t" -#endif - "movq %%mm5, %0\n\t" - - "movq 8(%3), %%mm1\n\t" - "movq %%mm1, %%mm2\n\t" - "pfsub %%mm0, %%mm1\n\t" - "pfadd %%mm0, %%mm2\n\t" - "movq %%mm1, 40(%3)\n\t" - "movq %%mm2, 8(%3)\n\t" - :"=m"(wB2) - :"m"(wT1), "m"(wB1), "r"(x), "m"(HSQRT2_3DNOW), - "m"(x_plus_minus_3dnow), "m"(x_minus_plus_3dnow) - :"memory"); - - - /* x[3] x[7] */ - __asm__ __volatile__( - "movq %1, %%mm0\n\t" -#ifdef HAVE_3DNOWEX - "pswapd %3, %%mm1\n\t" -#else - "movq %3, %%mm1\n\t" - "psrlq $32, %%mm1\n\t" - "punpckldq %3, %%mm1\n\t" -#endif - "pxor %%mm6, %%mm1\n\t" - "pfadd %%mm1, %%mm0\n\t" - "movq %2, %%mm2\n\t" - "movq 56(%4), %%mm3\n\t" - "pxor %%mm7, %%mm3\n\t" - "pfadd %%mm3, %%mm2\n\t" -#ifdef HAVE_3DNOWEX - "pswapd %%mm2, %%mm2\n\t" -#else - "movq %%mm2, %%mm5\n\t" - "psrlq $32, %%mm2\n\t" - "punpckldq %%mm5,%%mm2\n\t" -#endif - "movq 24(%4), %%mm3\n\t" - "pfsub %%mm2, %%mm0\n\t" - "movq %%mm3, %%mm4\n\t" - "movq %%mm0, %%mm1\n\t" - "pxor %%mm6, %%mm0\n\t" - "pfacc %%mm1, %%mm0\n\t" - "pfmul %5, %%mm0\n\t" - "movq %%mm0, %%mm1\n\t" - "pxor %%mm6, %%mm1\n\t" - "pxor %%mm7, %%mm0\n\t" - "pfadd %%mm1, %%mm3\n\t" - "pfadd %%mm0, %%mm4\n\t" - "movq %%mm4, 24(%0)\n\t" - "movq %%mm3, 56(%0)\n\t" - :"=r"(x) - :"m"(wT1), "m"(wB2), "m"(wB1), "0"(x), "m"(HSQRT2_3DNOW) - :"memory"); -} - -static void fft_asmb_3dnow(int k, complex_t *x, complex_t *wTB, - const complex_t *d, const complex_t *d_3) -{ - register complex_t *x2k, *x3k, *x4k, *wB; - - TRANS_FILL_MM6_MM7_3DNOW(); - x2k = x + 2 * k; - x3k = x2k + 2 * k; - x4k = x3k + 2 * k; - wB = wTB + 2 * k; - - TRANSZERO_3DNOW(x[0],x2k[0],x3k[0],x4k[0]); - TRANS_3DNOW(x[1],x2k[1],x3k[1],x4k[1],wTB[1],wB[1],d[1],d_3[1]); - - --k; - for(;;) { - TRANS_3DNOW(x[2],x2k[2],x3k[2],x4k[2],wTB[2],wB[2],d[2],d_3[2]); - TRANS_3DNOW(x[3],x2k[3],x3k[3],x4k[3],wTB[3],wB[3],d[3],d_3[3]); - if (!--k) break; - x += 2; - x2k += 2; - x3k += 2; - x4k += 2; - d += 2; - d_3 += 2; - wTB += 2; - wB += 2; - } - -} - -void fft_asmb16_3dnow(complex_t *x, complex_t *wTB) -{ - int k = 2; - - TRANS_FILL_MM6_MM7_3DNOW(); - /* transform x[0], x[8], x[4], x[12] */ - TRANSZERO_3DNOW(x[0],x[4],x[8],x[12]); - - /* transform x[1], x[9], x[5], x[13] */ - TRANS_3DNOW(x[1],x[5],x[9],x[13],wTB[1],wTB[5],delta16[1],delta16_3[1]); - - /* transform x[2], x[10], x[6], x[14] */ - TRANSHALF_16_3DNOW(x[2],x[6],x[10],x[14]); - - /* transform x[3], x[11], x[7], x[15] */ - TRANS_3DNOW(x[3],x[7],x[11],x[15],wTB[3],wTB[7],delta16[3],delta16_3[3]); - -} - -static void fft_128p_3dnow(complex_t *a) -{ - fft_8_3dnow(&a[0]); fft_4_3dnow(&a[8]); fft_4_3dnow(&a[12]); - fft_asmb16_3dnow(&a[0], &a[8]); - - fft_8_3dnow(&a[16]), fft_8_3dnow(&a[24]); - fft_asmb_3dnow(4, &a[0], &a[16],&delta32[0], &delta32_3[0]); - - fft_8_3dnow(&a[32]); fft_4_3dnow(&a[40]); fft_4_3dnow(&a[44]); - fft_asmb16_3dnow(&a[32], &a[40]); - - fft_8_3dnow(&a[48]); fft_4_3dnow(&a[56]); fft_4_3dnow(&a[60]); - fft_asmb16_3dnow(&a[48], &a[56]); - - fft_asmb_3dnow(8, &a[0], &a[32],&delta64[0], &delta64_3[0]); - - fft_8_3dnow(&a[64]); fft_4_3dnow(&a[72]); fft_4_3dnow(&a[76]); - /* fft_16(&a[64]); */ - fft_asmb16_3dnow(&a[64], &a[72]); - - fft_8_3dnow(&a[80]); fft_8_3dnow(&a[88]); - - /* fft_32(&a[64]); */ - fft_asmb_3dnow(4, &a[64], &a[80],&delta32[0], &delta32_3[0]); - - fft_8_3dnow(&a[96]); fft_4_3dnow(&a[104]), fft_4_3dnow(&a[108]); - /* fft_16(&a[96]); */ - fft_asmb16_3dnow(&a[96], &a[104]); - - fft_8_3dnow(&a[112]), fft_8_3dnow(&a[120]); - /* fft_32(&a[96]); */ - fft_asmb_3dnow(4, &a[96], &a[112], &delta32[0], &delta32_3[0]); - - /* fft_128(&a[0]); */ - fft_asmb_3dnow(16, &a[0], &a[64], &delta128[0], &delta128_3[0]); -} -#endif //ARCH_X86 - static void fft_asmb(int k, complex_t *x, complex_t *wTB, const complex_t *d, const complex_t *d_3) { diff --git a/liba52/imdct_3dnow.h b/liba52/imdct_3dnow.h new file mode 100644 index 0000000000..04f076cc09 --- /dev/null +++ b/liba52/imdct_3dnow.h @@ -0,0 +1,572 @@ +/* + 3DNOW and 3DNOWEX optimized IMDCT + Licence: GPL v2 + Copyrights: Nick Kurshev +*/ + +#undef FFT_4_3DNOW +#undef FFT_8_3DNOW +#undef FFT_ASMB_3DNOW +#undef FFT_ASMB16_3DNOW +#undef FFT_128P_3DNOW + +#ifdef HAVE_3DNOWEX +#define FFT_4_3DNOW fft_4_3dnowex +#define FFT_8_3DNOW fft_8_3dnowex +#define FFT_ASMB_3DNOW fft_asmb_3dnowex +#define FFT_ASMB16_3DNOW fft_asmb16_3dnowex +#define FFT_128P_3DNOW fft_128p_3dnowex +#else +#define FFT_4_3DNOW fft_4_3dnow +#define FFT_8_3DNOW fft_8_3dnow +#define FFT_ASMB_3DNOW fft_asmb_3dnow +#define FFT_ASMB16_3DNOW fft_asmb16_3dnow +#define FFT_128P_3DNOW fft_128p_3dnow +#endif + +static void FFT_4_3DNOW(complex_t *x) +{ + /* delta_p = 1 here */ + /* x[k] = sum_{i=0..3} x[i] * w^{i*k}, w=e^{-2*pi/4} + */ + __asm__ __volatile__( + "movq 24(%1), %%mm3\n\t" + "movq 8(%1), %%mm1\n\t" + "pxor %2, %%mm3\n\t" /* mm3.re | -mm3.im */ + "pxor %3, %%mm1\n\t" /* -mm1.re | mm1.im */ + "pfadd %%mm1, %%mm3\n\t" /* vi.im = x[3].re - x[1].re; */ + "movq %%mm3, %%mm4\n\t" /* vi.re =-x[3].im + x[1].im; mm4 = vi */ +#ifdef HAVE_3DNOWEX + "pswapd %%mm4, %%mm4\n\t" +#else + "movq %%mm4, %%mm5\n\t" + "psrlq $32, %%mm4\n\t" + "punpckldq %%mm5, %%mm4\n\t" +#endif + "movq (%1), %%mm5\n\t" /* yb.re = x[0].re - x[2].re; */ + "movq (%1), %%mm6\n\t" /* yt.re = x[0].re + x[2].re; */ + "movq 24(%1), %%mm7\n\t" /* u.re = x[3].re + x[1].re; */ + "pfsub 16(%1), %%mm5\n\t" /* yb.im = x[0].im - x[2].im; mm5 = yb */ + "pfadd 16(%1), %%mm6\n\t" /* yt.im = x[0].im + x[2].im; mm6 = yt */ + "pfadd 8(%1), %%mm7\n\t" /* u.im = x[3].im + x[1].im; mm7 = u */ + + "movq %%mm6, %%mm0\n\t" /* x[0].re = yt.re + u.re; */ + "movq %%mm5, %%mm1\n\t" /* x[1].re = yb.re + vi.re; */ + "pfadd %%mm7, %%mm0\n\t" /*x[0].im = yt.im + u.im; */ + "pfadd %%mm4, %%mm1\n\t" /* x[1].im = yb.im + vi.im; */ + "movq %%mm0, (%0)\n\t" + "movq %%mm1, 8(%0)\n\t" + + "pfsub %%mm7, %%mm6\n\t" /* x[2].re = yt.re - u.re; */ + "pfsub %%mm4, %%mm5\n\t" /* x[3].re = yb.re - vi.re; */ + "movq %%mm6, 16(%0)\n\t" /* x[2].im = yt.im - u.im; */ + "movq %%mm5, 24(%0)" /* x[3].im = yb.im - vi.im; */ + :"=r"(x) + :"0"(x), + "m"(x_plus_minus_3dnow), + "m"(x_minus_plus_3dnow) + :"memory"); +} + +static void FFT_8_3DNOW(complex_t *x) +{ + /* delta_p = diag{1, sqrt(i)} here */ + /* x[k] = sum_{i=0..7} x[i] * w^{i*k}, w=e^{-2*pi/8} + */ + complex_t wT1, wB1, wB2; + + __asm__ __volatile__( + "movq 8(%2), %%mm0\n\t" + "movq 24(%2), %%mm1\n\t" + "movq %%mm0, %0\n\t" /* wT1 = x[1]; */ + "movq %%mm1, %1\n\t" /* wB1 = x[3]; */ + :"=m"(wT1), "=m"(wB1) + :"r"(x) + :"memory"); + + __asm__ __volatile__( + "movq 16(%0), %%mm2\n\t" + "movq 32(%0), %%mm3\n\t" + "movq %%mm2, 8(%0)\n\t" /* x[1] = x[2]; */ + "movq 48(%0), %%mm4\n\t" + "movq %%mm3, 16(%0)\n\t" /* x[2] = x[4]; */ + "movq %%mm4, 24(%0)\n\t" /* x[3] = x[6]; */ + :"=r"(x) + :"0"(x) + :"memory"); + + fft_4_3dnow(&x[0]); + + /* x[0] x[4] x[2] x[6] */ + + __asm__ __volatile__( + "movq 40(%1), %%mm0\n\t" + "movq %%mm0, %%mm3\n\t" + "movq 56(%1), %%mm1\n\t" + "pfadd %%mm1, %%mm0\n\t" + "pfsub %%mm1, %%mm3\n\t" + "movq (%2), %%mm2\n\t" + "pfadd %%mm2, %%mm0\n\t" + "pfadd %%mm2, %%mm3\n\t" + "movq (%3), %%mm1\n\t" + "pfadd %%mm1, %%mm0\n\t" + "pfsub %%mm1, %%mm3\n\t" + "movq (%1), %%mm1\n\t" + "movq 16(%1), %%mm4\n\t" + "movq %%mm1, %%mm2\n\t" +#ifdef HAVE_3DNOWEX + "pswapd %%mm3, %%mm3\n\t" +#else + "movq %%mm3, %%mm6\n\t" + "psrlq $32, %%mm3\n\t" + "punpckldq %%mm6, %%mm3\n\t" +#endif + "pfadd %%mm0, %%mm1\n\t" + "movq %%mm4, %%mm5\n\t" + "pfsub %%mm0, %%mm2\n\t" + "pfadd %%mm3, %%mm4\n\t" + "movq %%mm1, (%0)\n\t" + "pfsub %%mm3, %%mm5\n\t" + "movq %%mm2, 32(%0)\n\t" + "movd %%mm4, 16(%0)\n\t" + "movd %%mm5, 48(%0)\n\t" + "psrlq $32, %%mm4\n\t" + "psrlq $32, %%mm5\n\t" + "movd %%mm4, 52(%0)\n\t" + "movd %%mm5, 20(%0)" + :"=r"(x) + :"0"(x), "r"(&wT1), "r"(&wB1) + :"memory"); + + /* x[1] x[5] */ + __asm__ __volatile__ ( + "movq %6, %%mm6\n\t" + "movq %5, %%mm7\n\t" + "movq %1, %%mm0\n\t" + "movq %2, %%mm1\n\t" + "movq 56(%3), %%mm3\n\t" + "pfsub 40(%3), %%mm0\n\t" +#ifdef HAVE_3DNOWEX + "pswapd %%mm1, %%mm1\n\t" +#else + "movq %%mm1, %%mm2\n\t" + "psrlq $32, %%mm1\n\t" + "punpckldq %%mm2,%%mm1\n\t" +#endif + "pxor %%mm7, %%mm1\n\t" + "pfadd %%mm1, %%mm0\n\t" +#ifdef HAVE_3DNOWEX + "pswapd %%mm3, %%mm3\n\t" +#else + "movq %%mm3, %%mm2\n\t" + "psrlq $32, %%mm3\n\t" + "punpckldq %%mm2,%%mm3\n\t" +#endif + "pxor %%mm6, %%mm3\n\t" + "pfadd %%mm3, %%mm0\n\t" + "movq %%mm0, %%mm1\n\t" + "pxor %%mm6, %%mm1\n\t" + "pfacc %%mm1, %%mm0\n\t" + "pfmul %4, %%mm0\n\t" + + "movq 40(%3), %%mm5\n\t" +#ifdef HAVE_3DNOWEX + "pswapd %%mm5, %%mm5\n\t" +#else + "movq %%mm5, %%mm1\n\t" + "psrlq $32, %%mm5\n\t" + "punpckldq %%mm1,%%mm5\n\t" +#endif + "movq %%mm5, %0\n\t" + + "movq 8(%3), %%mm1\n\t" + "movq %%mm1, %%mm2\n\t" + "pfsub %%mm0, %%mm1\n\t" + "pfadd %%mm0, %%mm2\n\t" + "movq %%mm1, 40(%3)\n\t" + "movq %%mm2, 8(%3)\n\t" + :"=m"(wB2) + :"m"(wT1), "m"(wB1), "r"(x), "m"(HSQRT2_3DNOW), + "m"(x_plus_minus_3dnow), "m"(x_minus_plus_3dnow) + :"memory"); + + + /* x[3] x[7] */ + __asm__ __volatile__( + "movq %1, %%mm0\n\t" +#ifdef HAVE_3DNOWEX + "pswapd %3, %%mm1\n\t" +#else + "movq %3, %%mm1\n\t" + "psrlq $32, %%mm1\n\t" + "punpckldq %3, %%mm1\n\t" +#endif + "pxor %%mm6, %%mm1\n\t" + "pfadd %%mm1, %%mm0\n\t" + "movq %2, %%mm2\n\t" + "movq 56(%4), %%mm3\n\t" + "pxor %%mm7, %%mm3\n\t" + "pfadd %%mm3, %%mm2\n\t" +#ifdef HAVE_3DNOWEX + "pswapd %%mm2, %%mm2\n\t" +#else + "movq %%mm2, %%mm5\n\t" + "psrlq $32, %%mm2\n\t" + "punpckldq %%mm5,%%mm2\n\t" +#endif + "movq 24(%4), %%mm3\n\t" + "pfsub %%mm2, %%mm0\n\t" + "movq %%mm3, %%mm4\n\t" + "movq %%mm0, %%mm1\n\t" + "pxor %%mm6, %%mm0\n\t" + "pfacc %%mm1, %%mm0\n\t" + "pfmul %5, %%mm0\n\t" + "movq %%mm0, %%mm1\n\t" + "pxor %%mm6, %%mm1\n\t" + "pxor %%mm7, %%mm0\n\t" + "pfadd %%mm1, %%mm3\n\t" + "pfadd %%mm0, %%mm4\n\t" + "movq %%mm4, 24(%0)\n\t" + "movq %%mm3, 56(%0)\n\t" + :"=r"(x) + :"m"(wT1), "m"(wB2), "m"(wB1), "0"(x), "m"(HSQRT2_3DNOW) + :"memory"); +} + +static void FFT_ASMB_3DNOW(int k, complex_t *x, complex_t *wTB, + const complex_t *d, const complex_t *d_3) +{ + register complex_t *x2k, *x3k, *x4k, *wB; + + TRANS_FILL_MM6_MM7_3DNOW(); + x2k = x + 2 * k; + x3k = x2k + 2 * k; + x4k = x3k + 2 * k; + wB = wTB + 2 * k; + + TRANSZERO_3DNOW(x[0],x2k[0],x3k[0],x4k[0]); + TRANS_3DNOW(x[1],x2k[1],x3k[1],x4k[1],wTB[1],wB[1],d[1],d_3[1]); + + --k; + for(;;) { + TRANS_3DNOW(x[2],x2k[2],x3k[2],x4k[2],wTB[2],wB[2],d[2],d_3[2]); + TRANS_3DNOW(x[3],x2k[3],x3k[3],x4k[3],wTB[3],wB[3],d[3],d_3[3]); + if (!--k) break; + x += 2; + x2k += 2; + x3k += 2; + x4k += 2; + d += 2; + d_3 += 2; + wTB += 2; + wB += 2; + } + +} + +void FFT_ASMB16_3DNOW(complex_t *x, complex_t *wTB) +{ + int k = 2; + + TRANS_FILL_MM6_MM7_3DNOW(); + /* transform x[0], x[8], x[4], x[12] */ + TRANSZERO_3DNOW(x[0],x[4],x[8],x[12]); + + /* transform x[1], x[9], x[5], x[13] */ + TRANS_3DNOW(x[1],x[5],x[9],x[13],wTB[1],wTB[5],delta16[1],delta16_3[1]); + + /* transform x[2], x[10], x[6], x[14] */ + TRANSHALF_16_3DNOW(x[2],x[6],x[10],x[14]); + + /* transform x[3], x[11], x[7], x[15] */ + TRANS_3DNOW(x[3],x[7],x[11],x[15],wTB[3],wTB[7],delta16[3],delta16_3[3]); + +} + +static void FFT_128P_3DNOW(complex_t *a) +{ + FFT_8_3DNOW(&a[0]); FFT_4_3DNOW(&a[8]); FFT_4_3DNOW(&a[12]); + FFT_ASMB16_3DNOW(&a[0], &a[8]); + + FFT_8_3DNOW(&a[16]), FFT_8_3DNOW(&a[24]); + FFT_ASMB_3DNOW(4, &a[0], &a[16],&delta32[0], &delta32_3[0]); + + FFT_8_3DNOW(&a[32]); FFT_4_3DNOW(&a[40]); FFT_4_3DNOW(&a[44]); + FFT_ASMB16_3DNOW(&a[32], &a[40]); + + FFT_8_3DNOW(&a[48]); FFT_4_3DNOW(&a[56]); FFT_4_3DNOW(&a[60]); + FFT_ASMB16_3DNOW(&a[48], &a[56]); + + FFT_ASMB_3DNOW(8, &a[0], &a[32],&delta64[0], &delta64_3[0]); + + FFT_8_3DNOW(&a[64]); FFT_4_3DNOW(&a[72]); FFT_4_3DNOW(&a[76]); + /* FFT_16(&a[64]); */ + FFT_ASMB16_3DNOW(&a[64], &a[72]); + + FFT_8_3DNOW(&a[80]); FFT_8_3DNOW(&a[88]); + + /* FFT_32(&a[64]); */ + FFT_ASMB_3DNOW(4, &a[64], &a[80],&delta32[0], &delta32_3[0]); + + FFT_8_3DNOW(&a[96]); FFT_4_3DNOW(&a[104]), FFT_4_3DNOW(&a[108]); + /* FFT_16(&a[96]); */ + FFT_ASMB16_3DNOW(&a[96], &a[104]); + + FFT_8_3DNOW(&a[112]), FFT_8_3DNOW(&a[120]); + /* FFT_32(&a[96]); */ + FFT_ASMB_3DNOW(4, &a[96], &a[112], &delta32[0], &delta32_3[0]); + + /* FFT_128(&a[0]); */ + FFT_ASMB_3DNOW(16, &a[0], &a[64], &delta128[0], &delta128_3[0]); +} + +static void +#ifdef HAVE_3DNOWEX +imdct_do_512_3dnowex +#else +imdct_do_512_3dnow +#endif +(sample_t data[],sample_t delay[], sample_t bias) +{ + int i,k; + int p,q; + int m; + int two_m; + int two_m_plus_one; + + sample_t tmp_a_i; + sample_t tmp_a_r; + sample_t tmp_b_i; + sample_t tmp_b_r; + + sample_t *data_ptr; + sample_t *delay_ptr; + sample_t *window_ptr; + + /* 512 IMDCT with source and dest data in 'data' */ + + /* Pre IFFT complex multiply plus IFFT cmplx conjugate & reordering*/ +#if 1 + __asm__ __volatile__ ( + "movq %0, %%mm7\n\t" + ::"m"(x_plus_minus_3dnow) + :"memory"); + for( i=0; i < 128; i++) { + int j = pm128[i]; + __asm__ __volatile__ ( + "movd %1, %%mm0\n\t" + "movd %3, %%mm1\n\t" + "punpckldq %2, %%mm0\n\t" /* mm0 = data[256-2*j-1] | data[2*j]*/ + "punpckldq %4, %%mm1\n\t" /* mm1 = xcos[j] | xsin[j] */ + "movq %%mm0, %%mm2\n\t" + "pfmul %%mm1, %%mm0\n\t" +#ifdef HAVE_3DNOWEX + "pswapd %%mm1, %%mm1\n\t" +#else + "movq %%mm1, %%mm5\n\t" + "psrlq $32, %%mm1\n\t" + "punpckldq %%mm5, %%mm1\n\t" +#endif + "pfmul %%mm1, %%mm2\n\t" +#ifdef HAVE_3DNOWEX + "pfpnacc %%mm2, %%mm0\n\t" +#else + "pxor %%mm7, %%mm0\n\t" + "pfacc %%mm2, %%mm0\n\t" +#endif + "pxor %%mm7, %%mm0\n\t" + "movq %%mm0, %0" + :"=m"(buf[i]) + :"m"(data[256-2*j-1]), "m"(data[2*j]), "m"(xcos1[j]), "m"(xsin1[j]) + :"memory" + ); +/* buf[i].re = (data[256-2*j-1] * xcos1[j] - data[2*j] * xsin1[j]); + buf[i].im = (data[256-2*j-1] * xsin1[j] + data[2*j] * xcos1[j])*(-1.0);*/ + } +#else + __asm__ __volatile__ ("femms":::"memory"); + for( i=0; i < 128; i++) { + /* z[i] = (X[256-2*i-1] + j * X[2*i]) * (xcos1[i] + j * xsin1[i]) ; */ + int j= pm128[i]; + buf[i].real = (data[256-2*j-1] * xcos1[j]) - (data[2*j] * xsin1[j]); + buf[i].imag = -1.0 * ((data[2*j] * xcos1[j]) + (data[256-2*j-1] * xsin1[j])); + } +#endif + + /* FFT Merge */ +/* unoptimized variant + for (m=1; m < 7; m++) { + if(m) + two_m = (1 << m); + else + two_m = 1; + + two_m_plus_one = (1 << (m+1)); + + for(i = 0; i < 128; i += two_m_plus_one) { + for(k = 0; k < two_m; k++) { + p = k + i; + q = p + two_m; + tmp_a_r = buf[p].real; + tmp_a_i = buf[p].imag; + tmp_b_r = buf[q].real * w[m][k].real - buf[q].imag * w[m][k].imag; + tmp_b_i = buf[q].imag * w[m][k].real + buf[q].real * w[m][k].imag; + buf[p].real = tmp_a_r + tmp_b_r; + buf[p].imag = tmp_a_i + tmp_b_i; + buf[q].real = tmp_a_r - tmp_b_r; + buf[q].imag = tmp_a_i - tmp_b_i; + } + } + } +*/ + + FFT_128P_3DNOW (&buf[0]); +// asm volatile ("femms \n\t":::"memory"); + + /* Post IFFT complex multiply plus IFFT complex conjugate*/ +#if 1 + __asm__ __volatile__ ( + "movq %0, %%mm7\n\t" + "movq %1, %%mm6\n\t" + ::"m"(x_plus_minus_3dnow), + "m"(x_minus_plus_3dnow) + :"eax","memory"); + for (i=0; i < 128; i++) { + __asm__ __volatile__ ( + "movq %1, %%mm0\n\t" /* ac3_buf[i].re | ac3_buf[i].im */ + "movq %%mm0, %%mm1\n\t" /* ac3_buf[i].re | ac3_buf[i].im */ +#ifndef HAVE_3DNOWEX + "movq %%mm1, %%mm2\n\t" + "psrlq $32, %%mm1\n\t" + "punpckldq %%mm2, %%mm1\n\t" +#else + "pswapd %%mm1, %%mm1\n\t" /* ac3_buf[i].re | ac3_buf[i].im */ +#endif + "movd %3, %%mm3\n\t" /* ac3_xsin[i] */ + "punpckldq %2, %%mm3\n\t" /* ac3_xsin[i] | ac3_xcos[i] */ + "pfmul %%mm3, %%mm0\n\t" + "pfmul %%mm3, %%mm1\n\t" +#ifndef HAVE_3DNOWEX + "pxor %%mm7, %%mm0\n\t" + "pfacc %%mm1, %%mm0\n\t" + "movd %%mm0, 4%0\n\t" + "psrlq $32, %%mm0\n\t" + "movd %%mm0, %0\n\t" +#else + "pfpnacc %%mm1, %%mm0\n\t" /* mm0 = mm0[0] - mm0[1] | mm1[0] + mm1[1] */ + "pswapd %%mm0, %%mm0\n\t" + "movq %%mm0, %0" +#endif + :"=m"(buf[i]) + :"m"(buf[i]),"m"(xcos1[i]),"m"(xsin1[i]) + :"memory"); +/* ac3_buf[i].re =(tmp_a_r * ac3_xcos1[i]) + (tmp_a_i * ac3_xsin1[i]); + ac3_buf[i].im =(tmp_a_r * ac3_xsin1[i]) - (tmp_a_i * ac3_xcos1[i]);*/ + } +#else + __asm__ __volatile__ ("femms":::"memory"); + for( i=0; i < 128; i++) { + /* y[n] = z[n] * (xcos1[n] + j * xsin1[n]) ; */ + tmp_a_r = buf[i].real; + tmp_a_i = -1.0 * buf[i].imag; + buf[i].real =(tmp_a_r * xcos1[i]) - (tmp_a_i * xsin1[i]); + buf[i].imag =(tmp_a_r * xsin1[i]) + (tmp_a_i * xcos1[i]); + } +#endif + + data_ptr = data; + delay_ptr = delay; + window_ptr = imdct_window; + + /* Window and convert to real valued signal */ +#if 1 + asm volatile ( + "movd (%0), %%mm3 \n\t" + "punpckldq %%mm3, %%mm3 \n\t" + :: "r" (&bias) + ); + for (i=0; i< 64; i++) { +/* merge two loops in one to enable working of 2 decoders */ + __asm__ __volatile__ ( + "movd 516(%1), %%mm0\n\t" + "movd (%1), %%mm1\n\t" /**data_ptr++=-buf[64+i].im**window_ptr+++*delay_ptr++;*/ + "punpckldq (%2), %%mm0\n\t"/*data_ptr[128]=-buf[i].re*window_ptr[128]+delay_ptr[128];*/ + "punpckldq 516(%2), %%mm1\n\t" + "pfmul (%3), %%mm0\n\t"/**data_ptr++=buf[64-i-1].re**window_ptr+++*delay_ptr++;*/ + "pfmul 512(%3), %%mm1\n\t" + "pxor %%mm6, %%mm0\n\t"/*data_ptr[128]=buf[128-i-1].im*window_ptr[128]+delay_ptr[128];*/ + "pxor %%mm6, %%mm1\n\t" + "pfadd (%4), %%mm0\n\t" + "pfadd 512(%4), %%mm1\n\t" + "pfadd %%mm3, %%mm0\n\t" + "pfadd %%mm3, %%mm1\n\t" + "movq %%mm0, (%0)\n\t" + "movq %%mm1, 512(%0)" + :"=r"(data_ptr) + :"r"(&buf[i].real), "r"(&buf[64-i-1].real), "r"(window_ptr), "r"(delay_ptr), "0"(data_ptr) + :"memory"); + data_ptr += 2; + window_ptr += 2; + delay_ptr += 2; + } + window_ptr += 128; +#else + __asm__ __volatile__ ("femms":::"memory"); + for(i=0; i< 64; i++) { + *data_ptr++ = -buf[64+i].imag * *window_ptr++ + *delay_ptr++ + bias; + *data_ptr++ = buf[64-i-1].real * *window_ptr++ + *delay_ptr++ + bias; + } + + for(i=0; i< 64; i++) { + *data_ptr++ = -buf[i].real * *window_ptr++ + *delay_ptr++ + bias; + *data_ptr++ = buf[128-i-1].imag * *window_ptr++ + *delay_ptr++ + bias; + } +#endif + + /* The trailing edge of the window goes into the delay line */ + delay_ptr = delay; +#if 1 + for(i=0; i< 64; i++) { +/* merge two loops in one to enable working of 2 decoders */ + window_ptr -=2; + __asm__ __volatile__( + "movd 508(%1), %%mm0\n\t" + "movd (%1), %%mm1\n\t" + "punpckldq (%2), %%mm0\n\t" + "punpckldq 508(%2), %%mm1\n\t" +#ifdef HAVE_3DNOWEX + "pswapd (%3), %%mm3\n\t" + "pswapd -512(%3), %%mm4\n\t" +#else + "movq (%3), %%mm3\n\t"/**delay_ptr++=-buf[64+i].re**--window_ptr;*/ + "movq -512(%3), %%mm4\n\t" + "psrlq $32, %%mm3\n\t"/*delay_ptr[128]=buf[i].im**window_ptr[-512];*/ + "psrlq $32, %%mm4\n\t"/**delay_ptr++=buf[64-i-1].im**--window_ptr;*/ + "punpckldq (%3), %%mm3\n\t"/*delay_ptr[128]=-buf[128-i-1].re**window_ptr[-512];*/ + "punpckldq -512(%3), %%mm4\n\t" +#endif + "pfmul %%mm3, %%mm0\n\t" + "pfmul %%mm4, %%mm1\n\t" + "pxor %%mm6, %%mm0\n\t" + "pxor %%mm7, %%mm1\n\t" + "movq %%mm0, (%0)\n\t" + "movq %%mm1, 512(%0)" + :"=r"(delay_ptr) + :"r"(&buf[i].imag), "r"(&buf[64-i-1].imag), "r"(window_ptr), "0"(delay_ptr) + :"memory"); + delay_ptr += 2; + } + __asm__ __volatile__ ("femms":::"memory"); +#else + __asm__ __volatile__ ("femms":::"memory"); + for(i=0; i< 64; i++) { + *delay_ptr++ = -buf[64+i].real * *--window_ptr; + *delay_ptr++ = buf[64-i-1].imag * *--window_ptr; + } + + for(i=0; i<64; i++) { + *delay_ptr++ = buf[i].imag * *--window_ptr; + *delay_ptr++ = -buf[128-i-1].real * *--window_ptr; + } +#endif +} |