aac_imdct.c
上传用户:wstnjxml
上传日期:2014-04-03
资源大小:7248k
文件大小:13k
源码类别:

Windows CE

开发平台:

C/C++

  1. /*****************************************************************************  *  * 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 program is distributed in the hope that it will be useful,  * but WITHOUT ANY WARRANTY; without even the implied warranty of  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the  * GNU General Public License for more details.  *  * You should have received a copy of the GNU General Public License  * along with this program; if not, write to the Free Software  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA  *  * $Id: aac_imdct.c 271 2005-08-09 08:31:35Z picard $  *  * The Core Pocket Media Player  * Copyright (c) 2004-2005 Gabor Kovacs  *  ****************************************************************************/ #include "../faad2/libfaad/common.h"
  2. #ifdef LIBPAAC
  3. #include "aac_imdct.h" #include "../faad2/libfaad/mdct_tab.h" #include "../faad2/libfaad/cfft_tab.h" #include "../faad2/libfaad/kbd_win.h" #include "../faad2/libfaad/sine_win.h" /*
  4. void AAC_Pre(real_t* Dst,const real_t* Src,const real_t* Table,int n); void AAC_Post(real_t* Dst,const real_t* Src,const real_t* Table,int n); void AAC_Pass2_N(real_t* Dst,const real_t* Src,const real_t* Table,int n,int m); void AAC_Pass4_N(real_t* Dst,const real_t* Src,const real_t* Table,int n,int m); void AAC_Pass4_1(real_t* Dst,const real_t* Src,int n); void AAC_SubR(real_t* Dst,const real_t* a,const real_t* b,int n); // da=1, db=-1 void AAC_Mul(real_t* Dst,const real_t* a,const real_t* b,int n); // da=1, db=-1 void AAC_MulR(real_t* Dst,const real_t* a,const real_t* b,int n); // da=-1, db=-1 void AAC_AddMul(real_t* Dst,const real_t* a,const real_t* b,const real_t* c,int n); //da=1,db=1,dc=1 void AAC_AddNMul(real_t* Dst,const real_t* a,const real_t* b,const real_t* c,int n); //da=1,db=-1,dc=1 void AAC_AddMulMul(real_t* Dst,const real_t* a,const real_t* b1,const real_t* c1,const real_t* b2,const real_t* c2,int n); // da=1,db=1,dc=1 void AAC_AddMulNMul(real_t* Dst,const real_t* a,const real_t* b1,const real_t* c1,const real_t* b2,const real_t* c2,int n); // da=1,db=-1,dc=1 void AAC_MulMul(real_t* Dst,const real_t* b1,const real_t* c1,const real_t* b2,const real_t* c2,int n); void AAC_MulNMul(real_t* Dst,const real_t* b1,const real_t* c1,const real_t* b2,const real_t* c2,int n); void AAC_Copy(real_t* Dst,const real_t* Src,int n); void AAC_Zero(real_t* Dst,int n); */
  5. static void AAC_Pass4_1(real_t* Dst, const real_t* Src, int n)
  6. {
  7. int i;
  8.     for (i=0;i<n;++i)
  9.     {
  10.         real_t t1r, t1i, t2r, t2i, t3r, t3i, t4r, t4i;
  11.         t2r = Src[0] + Src[4];
  12.         t1r = Src[0] - Src[4];
  13.         t2i = Src[1] + Src[5];
  14.         t1i = Src[1] - Src[5];
  15.         t3r = Src[2] + Src[6];
  16.         t4i = Src[2] - Src[6];
  17.         t3i = Src[7] + Src[3];
  18.         t4r = Src[7] - Src[3];
  19.         Dst[0+0*n] = t2r + t3r;
  20.         Dst[0+4*n] = t2r - t3r;
  21.         Dst[1+0*n] = t2i + t3i;
  22.         Dst[1+4*n] = t2i - t3i;
  23.         Dst[0+2*n] = t1r + t4r;
  24.         Dst[0+6*n] = t1r - t4r;
  25.         Dst[1+2*n] = t1i + t4i;
  26.         Dst[1+6*n] = t1i - t4i;
  27. Src += 8;
  28. Dst += 2;
  29.     }
  30. }
  31. static void AAC_Pass2_N(real_t* Dst, const real_t* Src, const real_t* Table, int n,int m)
  32. {
  33. int i,j,o = n*m*2;
  34. for (i=0;i<n;++i)
  35. {
  36. for (j=0;j<m;++j)
  37. {
  38. real_t t2r, t2i;
  39.             Dst[0] = Src[0+0*m] + Src[0+2*m];
  40.             Dst[1] = Src[1+0*m] + Src[1+2*m];
  41.             t2r = Src[0+0*m] - Src[0+2*m];
  42.             t2i = Src[1+0*m] - Src[1+2*m];
  43.             ComplexMult(Dst+1+o, Dst+0+o, t2i, t2r, Table[0], Table[1]);
  44. Table += 2;
  45. Dst += 2;
  46. Src += 2;
  47. }
  48. Src += 2*m;
  49. Table -= 2*m;
  50. }
  51. }
  52. static void AAC_Pass4_N(real_t* Dst, const real_t* Src, const real_t* Table, int n,int m)
  53. {
  54. int i,j,o = n*m*2;
  55. for (i=0;i<n;++i)
  56. {
  57. for (j=0;j<m;++j)
  58. {
  59. real_t t1r, t1i, t2r, t2i, t3r, t3i, t4r, t4i;
  60. t2r = Src[0+0*m] + Src[0+4*m];
  61. t1r = Src[0+0*m] - Src[0+4*m];
  62. t2i = Src[1+0*m] + Src[1+4*m];
  63. t1i = Src[1+0*m] - Src[1+4*m];
  64. t3r = Src[0+2*m] + Src[0+6*m];
  65. t4i = Src[0+2*m] - Src[0+6*m];
  66. t3i = Src[1+6*m] + Src[1+2*m];
  67. t4r = Src[1+6*m] - Src[1+2*m];
  68.             Dst[0] = t2r + t3r;
  69.             Dst[1] = t2i + t3i;
  70.             ComplexMult(Dst+1+o, Dst+0+o, 
  71. t1i + t4i, t1r + t4r, 
  72. Table[0], Table[1]);
  73.             ComplexMult(Dst+1+2*o, Dst+0+2*o,
  74.                 t2i - t3i, t2r - t3r, 
  75. Table[m*2], Table[1+m*2]);
  76.             ComplexMult(Dst+1+3*o, Dst+0+3*o,
  77.                 t1i - t4i, t1r - t4r, 
  78. Table[m*4], Table[1+m*4]);
  79. Dst += 2;
  80. Src += 2;
  81. Table += 2;
  82.         }
  83. Src += 6*m;
  84. Table -= 2*m;
  85.     }
  86. }
  87. static void AAC_Pre(real_t* Dst,const real_t* Src,const real_t* Table,int n) { const real_t* Src2 = Src + n*2 - 1;     do     {         ComplexMult(Dst+1,Dst+0,Src[0],Src2[0],Table[0],Table[1]); Dst += 2; Src += 2; Src2 -= 2; Table += 2; --n;     } while (n>0); }
  88. static void AAC_Post(real_t* Dst,const real_t* Src,const real_t* Table,int n) {
  89. int i;
  90. real_t* Dst2;
  91. Dst += n;
  92. Dst2 = Dst+n;
  93. n >>= 1;
  94. for (i=0;i<n;++i)
  95. {
  96. ComplexMult(Dst2-1,Dst-1,Src[1],Src[0],-Table[0],-Table[1]);
  97. //     ComplexMult(Dst2-1,Dst-1,Src[1],Src[0],Table[0],Table[1]); Dst2[-1] = -Dst2[-1]; Dst[-1] = -Dst[-1];
  98. Dst -= 2;  Dst2 -= 2; Src += 2; Table += 2;
  99. }
  100. for (i=0;i<n;++i)
  101. {
  102.     ComplexMult(Dst,Dst2,Src[1],Src[0],Table[0],Table[1]);
  103. Dst += 2;  Dst2 += 2; Src += 2; Table += 2;
  104. }
  105. }
  106. static void AAC_Zero(real_t* Dst,int n) { memset(Dst,0,sizeof(real_t)*n); } static void AAC_Copy(real_t* Dst,const real_t* Src,int n) { memcpy(Dst,Src,sizeof(real_t)*n); } static void AAC_Mul(real_t* Dst,const real_t* a,const real_t* b,int n) { do { Dst[0] = MUL_F(a[0],b[-1]); Dst[1] = MUL_F(a[1],b[-2]); Dst[2] = MUL_F(a[2],b[-3]); Dst[3] = MUL_F(a[3],b[-4]); a += 4; b -= 4; Dst += 4; n -= 4; } while (n>0); } static void AAC_MulR(real_t* Dst,const real_t* a,const real_t* b,int n) { do { Dst[0] = MUL_F(a[-1],b[-1]); Dst[1] = MUL_F(a[-2],b[-2]); Dst[2] = MUL_F(a[-3],b[-3]); Dst[3] = MUL_F(a[-4],b[-4]); a -= 4; b -= 4; Dst += 4; n -= 4; } while (n>0); } static void AAC_SubR(real_t* Dst,const real_t* a,const real_t* b,int n) { do { Dst[0] = a[0]-b[-1]; Dst[1] = a[1]-b[-2]; Dst[2] = a[2]-b[-3]; Dst[3] = a[3]-b[-4]; a += 4; b -= 4; Dst += 4; n -= 4; } while (n>0); } static void AAC_AddMul(real_t* Dst,const real_t* a,const real_t* b,const real_t* c,int n) { do { Dst[0] = a[0]+MUL_F(b[0],c[0]); Dst[1] = a[1]+MUL_F(b[1],c[1]); Dst[2] = a[2]+MUL_F(b[2],c[2]); Dst[3] = a[3]+MUL_F(b[3],c[3]); a += 4; b += 4; c += 4; Dst += 4; n -= 4; } while (n>0); } static void AAC_AddMulMul(real_t* Dst,const real_t* a,const real_t* b1,const real_t* c1,const real_t* b2,const real_t* c2,int n) { do { Dst[0] = a[0]+MUL_F(b1[0],c1[-1])+MUL_F(b2[0],c2[0]); Dst[1] = a[1]+MUL_F(b1[1],c1[-2])+MUL_F(b2[1],c2[1]); Dst[2] = a[2]+MUL_F(b1[2],c1[-3])+MUL_F(b2[2],c2[2]); Dst[3] = a[3]+MUL_F(b1[3],c1[-4])+MUL_F(b2[3],c2[3]); a += 4; b1 += 4; b2 += 4; c1 -= 4; c2 += 4; Dst += 4; n -= 4; } while (n>0); } static void AAC_MulMul(real_t* Dst,const real_t* b1,const real_t* c1,const real_t* b2,const real_t* c2,int n) { do { Dst[0] = MUL_F(b1[0],c1[-1])+MUL_F(b2[0],c2[0]); Dst[1] = MUL_F(b1[1],c1[-2])+MUL_F(b2[1],c2[1]); Dst[2] = MUL_F(b1[2],c1[-3])+MUL_F(b2[2],c2[2]); Dst[3] = MUL_F(b1[3],c1[-4])+MUL_F(b2[3],c2[3]); b1 += 4; b2 += 4; c1 -= 4; c2 += 4; Dst += 4; n -= 4; } while (n>0); } static void AAC_AddNMul(real_t* Dst,const real_t* a,const real_t* b,const real_t* c,int n) { do { Dst[0] = a[0]+MUL_F(-b[-1],c[0]); Dst[1] = a[1]+MUL_F(-b[-2],c[1]); Dst[2] = a[2]+MUL_F(-b[-3],c[2]); Dst[3] = a[3]+MUL_F(-b[-4],c[3]); a += 4; b -= 4; c += 4; Dst += 4; n -= 4; } while (n>0); } static void AAC_AddMulNMul(real_t* Dst,const real_t* a,const real_t* b1,const real_t* c1,const real_t* b2,const real_t* c2,int n) { do { Dst[0] = a[0]+MUL_F(b1[-1],c1[-1])+MUL_F(-b2[-1],c2[0]); Dst[1] = a[1]+MUL_F(b1[-2],c1[-2])+MUL_F(-b2[-2],c2[1]); Dst[2] = a[2]+MUL_F(b1[-3],c1[-3])+MUL_F(-b2[-3],c2[2]); Dst[3] = a[3]+MUL_F(b1[-4],c1[-4])+MUL_F(-b2[-4],c2[3]); a += 4; b1 -= 4; b2 -= 4; c1 -= 4; c2 += 4; Dst += 4; n -= 4; } while (n>0); } static void AAC_MulNMul(real_t* Dst,const real_t* b1,const real_t* c1,const real_t* b2,const real_t* c2,int n) { do { Dst[0] = MUL_F(b1[-1],c1[-1])+MUL_F(-b2[-1],c2[0]); Dst[1] = MUL_F(b1[-2],c1[-2])+MUL_F(-b2[-2],c2[1]); Dst[2] = MUL_F(b1[-3],c1[-3])+MUL_F(-b2[-3],c2[2]); Dst[3] = MUL_F(b1[-4],c1[-4])+MUL_F(-b2[-4],c2[3]); b1 -= 4; b2 -= 4; c1 -= 4; c2 += 4; Dst += 4; n -= 4; } while (n>0); } static void AAC_IMDCT_2048(libpaac* p,real_t *Dst, real_t *Src) { AAC_Pre(Dst,Src,mdct_tab_2048[0],512); AAC_Pass2_N(Src,Dst,cfft_tab_512[0],1,256); AAC_Pass4_N(Dst,Src,cfft_tab_512[0]+256*2,2,64); AAC_Pass4_N(Src,Dst,cfft_tab_512[0]+256*2+3*64*2,8,16); AAC_Pass4_N(Dst,Src,cfft_tab_512[0]+256*2+3*64*2+3*16*2,32,4); AAC_Pass4_1(Src,Dst,128); AAC_Post(Dst,Src,mdct_tab_2048[0],512); } static void AAC_IMDCT_256(libpaac* p,real_t *Dst, real_t *Src) { AAC_Pre(Dst,Src,mdct_tab_256[0],64); AAC_Pass4_N(Src,Dst,cfft_tab_64[0],1,16); AAC_Pass4_N(Dst,Src,cfft_tab_64[0]+3*16*2,4,4); AAC_Pass4_1(Src,Dst,16); AAC_Post(Dst,Src,mdct_tab_256[0],64); } void AAC_Filter1024(libpaac* p, int Sequence, int Shape, int PrevShape, real_t *Data, real_t *Overlap, real_t *Tmp) { const real_t *Window;     switch (Sequence)     {     case 0: AAC_IMDCT_2048(p,Tmp,Data); Window = p->LongWindow[PrevShape]; AAC_AddMul(Data,Overlap,Tmp,Window,512); AAC_AddNMul(Data+512,Overlap+512,Tmp+512,Window+512,512); Window = p->LongWindow[Shape]; AAC_Mul(Overlap,Tmp+512,Window+1024,512); AAC_MulR(Overlap+512,Tmp+1024,Window+512,512);         break;     case 1: AAC_IMDCT_2048(p,Tmp,Data); Window = p->LongWindow[PrevShape]; AAC_AddMul(Data,Overlap,Tmp,Window,512); AAC_AddNMul(Data+512,Overlap+512,Tmp+512,Window+512,512); Window = p->ShortWindow[Shape]; AAC_Copy(Overlap,Tmp+512,448);   AAC_Mul(Overlap+512-64,Tmp+1024-64,Window+128,64);   AAC_MulR(Overlap+512,Tmp+1024,Window+64,64); AAC_Zero(Overlap+512+64,448);         break;     case 2: AAC_IMDCT_256(p,Tmp+0*128,Data+0*128); AAC_IMDCT_256(p,Tmp+1*128,Data+1*128); AAC_IMDCT_256(p,Tmp+2*128,Data+2*128); AAC_IMDCT_256(p,Tmp+3*128,Data+3*128); AAC_IMDCT_256(p,Tmp+4*128,Data+4*128); AAC_IMDCT_256(p,Tmp+5*128,Data+5*128); AAC_IMDCT_256(p,Tmp+6*128,Data+6*128); AAC_IMDCT_256(p,Tmp+7*128,Data+7*128); AAC_Copy(Data,Overlap,448); Window = p->ShortWindow[PrevShape]; AAC_AddMul(Data+448+64*0,Overlap+448+64*0,Tmp+0*64,Window,64); AAC_AddNMul(Data+448+64*1,Overlap+448+64*1,Tmp+0*64+64,Window+64,64); Window = p->ShortWindow[Shape]; AAC_AddMulMul(Data+448+64*2,Overlap+448+64*2,Tmp+1*64,Window+128,Tmp+2*64,Window,64); AAC_AddMulNMul(Data+448+64*3,Overlap+448+64*3,Tmp+1*64+64,Window+64,Tmp+2*64+64,Window+64,64); AAC_AddMulMul(Data+448+64*4,Overlap+448+64*4,Tmp+3*64,Window+128,Tmp+4*64,Window,64); AAC_AddMulNMul(Data+448+64*5,Overlap+448+64*5,Tmp+3*64+64,Window+64,Tmp+4*64+64,Window+64,64); AAC_AddMulMul(Data+448+64*6,Overlap+448+64*6,Tmp+5*64,Window+128,Tmp+6*64,Window,64); AAC_AddMulNMul(Data+448+64*7,Overlap+448+64*7,Tmp+5*64+64,Window+64,Tmp+6*64+64,Window+64,64); AAC_AddMulMul(Data+448+64*8,Overlap+448+64*8,Tmp+7*64,Window+128,Tmp+8*64,Window,64); AAC_MulNMul(Overlap+64*0,Tmp+7*64+64,Window+64,Tmp+8*64+64,Window+64,64); AAC_MulMul(Overlap+64*1,Tmp+9*64,Window+128,Tmp+10*64,Window,64); AAC_MulNMul(Overlap+64*2,Tmp+9*64+64,Window+64,Tmp+10*64+64,Window+64,64); AAC_MulMul(Overlap+64*3,Tmp+11*64,Window+128,Tmp+12*64,Window,64); AAC_MulNMul(Overlap+64*4,Tmp+11*64+64,Window+64,Tmp+12*64+64,Window+64,64); AAC_MulMul(Overlap+64*5,Tmp+13*64,Window+128,Tmp+14*64,Window,64); AAC_MulNMul(Overlap+64*6,Tmp+13*64+64,Window+64,Tmp+14*64+64,Window+64,64); AAC_Mul(Overlap+64*7,Tmp+15*64,Window+128,64); AAC_MulR(Overlap+64*8,Tmp+15*64+64,Window+64,64); AAC_Zero(Overlap+448+128,448);
  107.         break;     case 3: AAC_IMDCT_2048(p,Tmp,Data); Window = p->ShortWindow[PrevShape]; AAC_Copy(Data,Overlap,448); AAC_AddMul(Data+512-64,Overlap+448,Tmp+512-64,Window,64); AAC_AddNMul(Data+512,Overlap+512,Tmp+512,Window+64,64); AAC_SubR(Data+512+64,Overlap+512+64,Tmp+448,448); Window = p->LongWindow[Shape]; AAC_Mul(Overlap,Tmp+512,Window+1024,512); AAC_MulR(Overlap+512,Tmp+1024,Window+512,512); break;     }
  108. // DebugMessage("FRAME %d",Sequence);
  109. // { int i; for (i=0;i<1024;++i) DebugMessage("%d %d",Data[i],Overlap[i]); }
  110. } void AAC_Filter_Init(libpaac* p, int FrameLength) { p->LongWindow[0] = sine_long_1024; p->ShortWindow[0] = sine_short_128; p->LongWindow[1] = kbd_long_1024; p->ShortWindow[1] = kbd_short_128; p->Filter = (aac_filter) AAC_Filter1024; } #endif