filter.cpp
上传用户:sun1608
上传日期:2007-02-02
资源大小:6116k
文件大小:10k
源码类别:

流媒体/Mpeg4/MP4

开发平台:

Visual C++

  1. /* MPEG/WAVE Sound library
  2.    (C) 1997 by Jung woo-jae */
  3. // Filter.cc
  4. // Subbandsynthesis routines from maplay 1.2 for Linux
  5. // I've modified some macros for reducing source code.
  6. #ifdef HAVE_CONFIG_H
  7. #include "config.h"
  8. #endif
  9. #include "MPEGaudio.h"
  10. void MPEGaudio::computebuffer(REAL *fraction,REAL buffer[2][CALCBUFFERSIZE])
  11. {
  12.   REAL p0,p1,p2,p3,p4,p5,p6,p7,p8,p9,pa,pb,pc,pd,pe,pf;
  13.   REAL q0,q1,q2,q3,q4,q5,q6,q7,q8,q9,qa,qb,qc,qd,qe,qf;
  14.   REAL *out1,*out2;
  15.   out1=buffer[currentcalcbuffer]+calcbufferoffset;
  16.   out2=buffer[currentcalcbuffer^1]+calcbufferoffset;
  17. #define OUT1(v,t) out1[(32-(v))*16]   =(-(out1[(v)*16]=t))
  18. #define OUT2(v)   out2[(96-(v)-32)*16]=out2[((v)-32)*16]
  19.   // compute new values via a fast cosine transform:
  20.   {
  21.     register REAL *x=fraction;
  22.     p0=x[ 0]+x[31];p1=x[ 1]+x[30];p2=x[ 2]+x[29];p3=x[ 3]+x[28];
  23.     p4=x[ 4]+x[27];p5=x[ 5]+x[26];p6=x[ 6]+x[25];p7=x[ 7]+x[24];
  24.     p8=x[ 8]+x[23];p9=x[ 9]+x[22];pa=x[10]+x[21];pb=x[11]+x[20];
  25.     pc=x[12]+x[19];pd=x[13]+x[18];pe=x[14]+x[17];pf=x[15]+x[16];
  26.   }
  27.   q0=p0+pf;q1=p1+pe;q2=p2+pd;q3=p3+pc;
  28.   q4=p4+pb;q5=p5+pa;q6=p6+p9;q7=p7+p8;
  29.   q8=hcos_32[0]*(p0-pf);q9=hcos_32[1]*(p1-pe);
  30.   qa=hcos_32[2]*(p2-pd);qb=hcos_32[3]*(p3-pc);
  31.   qc=hcos_32[4]*(p4-pb);qd=hcos_32[5]*(p5-pa);
  32.   qe=hcos_32[6]*(p6-p9);qf=hcos_32[7]*(p7-p8);
  33.   p0=q0+q7;p1=q1+q6;p2=q2+q5;p3=q3+q4;
  34.   p4=hcos_16[0]*(q0-q7);p5=hcos_16[1]*(q1-q6);
  35.   p6=hcos_16[2]*(q2-q5);p7=hcos_16[3]*(q3-q4);
  36.   p8=q8+qf;p9=q9+qe;pa=qa+qd;pb=qb+qc;
  37.   pc=hcos_16[0]*(q8-qf);pd=hcos_16[1]*(q9-qe);
  38.   pe=hcos_16[2]*(qa-qd);pf=hcos_16[3]*(qb-qc);
  39.   q0=p0+p3;q1=p1+p2;q2=hcos_8[0]*(p0-p3);q3=hcos_8[1]*(p1-p2);
  40.   q4=p4+p7;q5=p5+p6;q6=hcos_8[0]*(p4-p7);q7=hcos_8[1]*(p5-p6);
  41.   q8=p8+pb;q9=p9+pa;qa=hcos_8[0]*(p8-pb);qb=hcos_8[1]*(p9-pa);
  42.   qc=pc+pf;qd=pd+pe;qe=hcos_8[0]*(pc-pf);qf=hcos_8[1]*(pd-pe);
  43.   p0=q0+q1;p1=hcos_4*(q0-q1);p2=q2+q3;p3=hcos_4*(q2-q3);
  44.   p4=q4+q5;p5=hcos_4*(q4-q5);p6=q6+q7;p7=hcos_4*(q6-q7);
  45.   p8=q8+q9;p9=hcos_4*(q8-q9);pa=qa+qb;pb=hcos_4*(qa-qb);
  46.   pc=qc+qd;pd=hcos_4*(qc-qd);pe=qe+qf;pf=hcos_4*(qe-qf);
  47.   {
  48.     register REAL tmp;
  49.     tmp=p6+p7;
  50.     OUT2(36)=-(p5+tmp);
  51.     OUT2(44)=-(p4+tmp);
  52.     tmp=pb+pf;
  53.     OUT1(10,tmp);
  54.     OUT1(6,pd+tmp);
  55.     tmp=pe+pf;
  56.     OUT2(46)=-(p8+pc+tmp);
  57.     OUT2(34)=-(p9+pd+tmp);
  58.     tmp+=pa+pb;
  59.     OUT2(38)=-(pd+tmp);
  60.     OUT2(42)=-(pc+tmp);
  61.     OUT1(2,p9+pd+pf);
  62.     OUT1(4,p5+p7);
  63.     OUT2(48)=-p0;
  64.     out2[0]=-(out1[0]=p1);
  65.     OUT1( 8,p3);
  66.     OUT1(12,p7);
  67.     OUT1(14,pf);
  68.     OUT2(40)=-(p2+p3);
  69.   }
  70.   {
  71.     register REAL *x=fraction;
  72.     p0=hcos_64[ 0]*(x[ 0]-x[31]);p1=hcos_64[ 1]*(x[ 1]-x[30]);
  73.     p2=hcos_64[ 2]*(x[ 2]-x[29]);p3=hcos_64[ 3]*(x[ 3]-x[28]);
  74.     p4=hcos_64[ 4]*(x[ 4]-x[27]);p5=hcos_64[ 5]*(x[ 5]-x[26]);
  75.     p6=hcos_64[ 6]*(x[ 6]-x[25]);p7=hcos_64[ 7]*(x[ 7]-x[24]);
  76.     p8=hcos_64[ 8]*(x[ 8]-x[23]);p9=hcos_64[ 9]*(x[ 9]-x[22]);
  77.     pa=hcos_64[10]*(x[10]-x[21]);pb=hcos_64[11]*(x[11]-x[20]);
  78.     pc=hcos_64[12]*(x[12]-x[19]);pd=hcos_64[13]*(x[13]-x[18]);
  79.     pe=hcos_64[14]*(x[14]-x[17]);pf=hcos_64[15]*(x[15]-x[16]);
  80.   }
  81.   q0=p0+pf;q1=p1+pe;q2=p2+pd;q3=p3+pc;
  82.   q4=p4+pb;q5=p5+pa;q6=p6+p9;q7=p7+p8;
  83.   q8=hcos_32[0]*(p0-pf);q9=hcos_32[1]*(p1-pe);
  84.   qa=hcos_32[2]*(p2-pd);qb=hcos_32[3]*(p3-pc);
  85.   qc=hcos_32[4]*(p4-pb);qd=hcos_32[5]*(p5-pa);
  86.   qe=hcos_32[6]*(p6-p9);qf=hcos_32[7]*(p7-p8);
  87.   p0=q0+q7;p1=q1+q6;p2=q2+q5;p3=q3+q4;
  88.   p4=hcos_16[0]*(q0-q7);p5=hcos_16[1]*(q1-q6);
  89.   p6=hcos_16[2]*(q2-q5);p7=hcos_16[3]*(q3-q4);
  90.   p8=q8+qf;p9=q9+qe;pa=qa+qd;pb=qb+qc;
  91.   pc=hcos_16[0]*(q8-qf);pd=hcos_16[1]*(q9-qe);
  92.   pe=hcos_16[2]*(qa-qd);pf=hcos_16[3]*(qb-qc);
  93.   q0=p0+p3;q1=p1+p2;q2=hcos_8[0]*(p0-p3);q3=hcos_8[1]*(p1-p2);
  94.   q4=p4+p7;q5=p5+p6;q6=hcos_8[0]*(p4-p7);q7=hcos_8[1]*(p5-p6);
  95.   q8=p8+pb;q9=p9+pa;qa=hcos_8[0]*(p8-pb);qb=hcos_8[1]*(p9-pa);
  96.   qc=pc+pf;qd=pd+pe;qe=hcos_8[0]*(pc-pf);qf=hcos_8[1]*(pd-pe);
  97.   p0=q0+q1;p1=hcos_4*(q0-q1);
  98.   p2=q2+q3;p3=hcos_4*(q2-q3);
  99.   p4=q4+q5;p5=hcos_4*(q4-q5);
  100.   p6=q6+q7;p7=hcos_4*(q6-q7);
  101.   p8=q8+q9;p9=hcos_4*(q8-q9);
  102.   pa=qa+qb;pb=hcos_4*(qa-qb);
  103.   pc=qc+qd;pd=hcos_4*(qc-qd);
  104.   pe=qe+qf;pf=hcos_4*(qe-qf);
  105.   {
  106.     REAL tmp;
  107.     tmp=pd+pf;
  108.     OUT1(5,p5+p7+pb+tmp);
  109.     tmp+=p9;
  110.     OUT1(1,p1+tmp);
  111.     OUT2(33)=-(p1+pe+tmp);
  112.     tmp+=p5+p7;
  113.     OUT1(3,tmp);
  114.     OUT2(35)=-(p6+pe+tmp);
  115.     tmp=pa+pb+pc+pd+pe+pf;
  116.     OUT2(39)=-(p2+p3+tmp-pc);
  117.     OUT2(43)=-(p4+p6+p7+tmp-pd);
  118.     OUT2(37)=-(p5+p6+p7+tmp-pc);
  119.     OUT2(41)=-(p2+p3+tmp-pd);
  120.     tmp=p8+pc+pe+pf;
  121.     OUT2(47)=-(p0+tmp);
  122.     OUT2(45)=-(p4+p6+p7+tmp);
  123.     tmp=pb+pf;
  124.     OUT1(11,p7+tmp);
  125.     tmp+=p3;
  126.     OUT1( 9,tmp);
  127.     OUT1( 7,pd+tmp);
  128.     OUT1(13,p7+pf);
  129.     OUT1(15,pf);
  130.   }
  131. }
  132. #define SAVE 
  133.         raw=(int)(r*scalefactor); 
  134.         if(raw>MAXSCALE)raw=MAXSCALE;else if(raw<MINSCALE)raw=MINSCALE; 
  135. putraw(raw);
  136. #define OS  r=*vp * *dp++
  137. #define XX  vp+=15;r+=*vp * *dp++
  138. #define OP  r+=*--vp * *dp++
  139. void MPEGaudio::generatesingle(void)
  140. {
  141.   int i;
  142.   register REAL r, *vp;
  143.   register const REAL *dp;
  144.   int raw;
  145.   i=32;
  146.   dp=filter;
  147.   vp=calcbufferL[currentcalcbuffer]+calcbufferoffset; 
  148. // actual_v+actual_write_pos;
  149.   switch (calcbufferoffset)
  150.   {
  151.     case  0:for(;i;i--,vp+=15){
  152.               OS;XX;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;
  153.       SAVE;}break;
  154.     case  1:for(;i;i--,vp+=15){
  155.       OS;OP;XX;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;
  156.       SAVE;}break;
  157.     case  2:for(;i;i--,vp+=15){
  158.               OS;OP;OP;XX;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;
  159.       SAVE;}break;
  160.     case  3:for(;i;i--,vp+=15){
  161.       OS;OP;OP;OP;XX;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;
  162.       SAVE;}break;
  163.     case  4:for(;i;i--,vp+=15){
  164.               OS;OP;OP;OP;OP;XX;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;
  165.       SAVE;}break;
  166.     case  5:for(;i;i--,vp+=15){
  167.       OS;OP;OP;OP;OP;OP;XX;OP;OP;OP;OP;OP;OP;OP;OP;OP;
  168.       SAVE;}break;
  169.     case  6:for(;i;i--,vp+=15){
  170.       OS;OP;OP;OP;OP;OP;OP;XX;OP;OP;OP;OP;OP;OP;OP;OP;
  171.       SAVE;}break;
  172.     case  7:for(;i;i--,vp+=15){
  173.       OS;OP;OP;OP;OP;OP;OP;OP;XX;OP;OP;OP;OP;OP;OP;OP;
  174.       SAVE;}break;
  175.     case  8:for(;i;i--,vp+=15){
  176.               OS;OP;OP;OP;OP;OP;OP;OP;OP;XX;OP;OP;OP;OP;OP;OP;
  177.       SAVE;}break;
  178.     case  9:for(;i;i--,vp+=15){
  179.       OS;OP;OP;OP;OP;OP;OP;OP;OP;OP;XX;OP;OP;OP;OP;OP;
  180.       SAVE;}break;
  181.     case 10:for(;i;i--,vp+=15){
  182.               OS;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;XX;OP;OP;OP;OP;
  183.       SAVE;}break;
  184.     case 11:for(;i;i--,vp+=15){
  185.               OS;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;XX;OP;OP;OP;
  186.       SAVE;}break;
  187.     case 12:for(;i;i--,vp+=15){
  188.       OS;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;XX;OP;OP;
  189.       SAVE;}break;
  190.     case 13:for(;i;i--,vp+=15){
  191.       OS;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;XX;OP;
  192.       SAVE;}break;
  193.     case 14:for(;i;i--,vp+=15){
  194.       OS;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;XX;
  195.       SAVE;}break;
  196.     case 15:for(;i;i--,vp+=31){
  197.               OS;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;
  198.       SAVE;}break;
  199.   }
  200. }
  201. #undef OS
  202. #undef XX
  203. #undef OP
  204. #undef SAVE
  205. #define SAVE 
  206.         raw=(int)(r1*scalefactor);  
  207.         if(raw>MAXSCALE)raw=MAXSCALE;else if(raw<MINSCALE)raw=MINSCALE; 
  208. putraw(raw);  
  209.         raw=(int)(r2*scalefactor);  
  210.         if(raw>MAXSCALE)raw=MAXSCALE;else if(raw<MINSCALE)raw=MINSCALE; 
  211. putraw(raw);
  212. #define OS r1=*vp1 * *dp; 
  213.            r2=*vp2 * *dp++ 
  214. #define XX vp1+=15;r1+=*vp1 * *dp; 
  215.    vp2+=15;r2+=*vp2 * *dp++
  216. #define OP r1+=*--vp1 * *dp; 
  217.    r2+=*--vp2 * *dp++
  218. void MPEGaudio::generate(void)
  219. {
  220.   int i;
  221.   REAL r1,r2;
  222.   register REAL *vp1,*vp2;
  223.   register const REAL *dp;
  224.   int raw;
  225.   dp=filter;
  226.   vp1=calcbufferL[currentcalcbuffer]+calcbufferoffset;
  227.   vp2=calcbufferR[currentcalcbuffer]+calcbufferoffset;
  228. // actual_v+actual_write_pos;
  229.   i=32;
  230.   switch (calcbufferoffset)
  231.   {
  232.     case  0:for(;i;i--,vp1+=15,vp2+=15){
  233.               OS;XX;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;
  234.       SAVE;}break;
  235.     case  1:for(;i;i--,vp1+=15,vp2+=15){
  236.       OS;OP;XX;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;
  237.       SAVE;}break;
  238.     case  2:for(;i;i--,vp1+=15,vp2+=15){
  239.               OS;OP;OP;XX;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;
  240.       SAVE;}break;
  241.     case  3:for(;i;i--,vp1+=15,vp2+=15){
  242.       OS;OP;OP;OP;XX;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;
  243.       SAVE;}break;
  244.     case  4:for(;i;i--,vp1+=15,vp2+=15){
  245.               OS;OP;OP;OP;OP;XX;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;
  246.       SAVE;}break;
  247.     case  5:for(;i;i--,vp1+=15,vp2+=15){
  248.       OS;OP;OP;OP;OP;OP;XX;OP;OP;OP;OP;OP;OP;OP;OP;OP;
  249.       SAVE;}break;
  250.     case  6:for(;i;i--,vp1+=15,vp2+=15){
  251.       OS;OP;OP;OP;OP;OP;OP;XX;OP;OP;OP;OP;OP;OP;OP;OP;
  252.       SAVE;}break;
  253.     case  7:for(;i;i--,vp1+=15,vp2+=15){
  254.       OS;OP;OP;OP;OP;OP;OP;OP;XX;OP;OP;OP;OP;OP;OP;OP;
  255.       SAVE;}break;
  256.     case  8:for(;i;i--,vp1+=15,vp2+=15){
  257.               OS;OP;OP;OP;OP;OP;OP;OP;OP;XX;OP;OP;OP;OP;OP;OP;
  258.       SAVE;}break;
  259.     case  9:for(;i;i--,vp1+=15,vp2+=15){
  260.       OS;OP;OP;OP;OP;OP;OP;OP;OP;OP;XX;OP;OP;OP;OP;OP;
  261.       SAVE;}break;
  262.     case 10:for(;i;i--,vp1+=15,vp2+=15){
  263.               OS;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;XX;OP;OP;OP;OP;
  264.       SAVE;}break;
  265.     case 11:for(;i;i--,vp1+=15,vp2+=15){
  266.               OS;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;XX;OP;OP;OP;
  267.       SAVE;}break;
  268.     case 12:for(;i;i--,vp1+=15,vp2+=15){
  269.       OS;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;XX;OP;OP;
  270.       SAVE;}break;
  271.     case 13:for(;i;i--,vp1+=15,vp2+=15){
  272.       OS;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;XX;OP;
  273.       SAVE;}break;
  274.     case 14:for(;i;i--,vp1+=15,vp2+=15){
  275.       OS;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;XX;
  276.       SAVE;}break;
  277.     case 15:for(;i;i--,vp1+=31,vp2+=31){
  278.               OS;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;OP;
  279.       SAVE;}break;
  280.   }
  281. }
  282. void MPEGaudio::subbandsynthesis(REAL *fractionL,REAL *fractionR)
  283. {
  284.   if(downfrequency)
  285.   {
  286.     subbandsynthesis_2(fractionL,fractionR);
  287.     return;
  288.   }
  289.   computebuffer(fractionL,calcbufferL);
  290.   if(!outputstereo)generatesingle();
  291.   else
  292.   {
  293.     computebuffer(fractionR,calcbufferR);
  294.     generate();
  295.   }
  296.   if(calcbufferoffset<15)calcbufferoffset++;
  297.   else calcbufferoffset=0;
  298.   currentcalcbuffer^=1;
  299. }