开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 多媒体 > 流媒体/Mpeg4/MP4 > 查看源码
mpeglayer3.cpp
资源名称：NETVIDEO.rar　[点击查看]
上传用户：sun1608
上传日期：2007-02-02
资源大小：6116k
文件大小：48k
源码类别：

流媒体/Mpeg4/MP4

开发平台：

Visual C++

mpeglayer3.cpp：源码内容
  1. /* MPEG/WAVE Sound library
  3.    (C) 1997 by Jung woo-jae */
  5. // Mpeglayer3.cc
  6. // It's for MPEG Layer 3
  7. // I've made array of superior functions for speed.
  8. // Extend TO_FOUR_THIRDS to negative.
  9. // Bug fix : maplay 1.2+ have wrong TO_FOUR_THIRDS ranges.
  10. // Force to mono!!
  11. // MPEG-2 is implemented
  12. // Speed up in fixstereo (maybe buggy) 
  14. #ifdef HAVE_CONFIG_H
  15. #include "config.h"
  16. #endif
  18. #include <math.h>
  19. #include <stdlib.h>
  20. #include <stdio.h>
  21. #include "MPEGaudio.h"
  22. #if defined(_WIN32) && defined(_MSC_VER)
  23. // disable warnings about double to float conversions
  24. #pragma warning(disable: 4244 4305)
  25. #endif
  27. inline void Mpegbitwindow::wrap(void)
  28. {
  29.   int p=bitindex>>3;
  30.   point&=(WINDOWSIZE-1);
  32.   if(p>=point)
  33.   {
  34.     for(register int i=4;i<point;i++)
  35.       buffer[WINDOWSIZE+i]=buffer[i];
  36.   }
  37.   *((int *)(buffer+WINDOWSIZE))=*((int *)buffer);
  38. }
  40. #define MUL3(a) (((a)<<1)+(a))
  42. #define REAL0 0
  44. #define ARRAYSIZE (SBLIMIT*SSLIMIT)
  45. #define REALSIZE (sizeof(REAL))
  47. #ifdef PI
  48. #undef PI
  49. #endif
  50. #define PI     3.141593
  51. #define PI_12  (PI/12.0)
  52. #define PI_18  (PI/18.0)
  53. #define PI_24  (PI/24.0)
  54. #define PI_36  (PI/36.0)
  55. #define PI_72  (PI/72.0)
  57. #ifdef NATIVE_ASSEMBLY
  58. inline void long_memset(void * s,unsigned int c,int count)
  59. {
  60. __asm__ __volatile__(
  61.   "cldnt"
  62.   "rep ; stoslnt"
  63.   : /* no output */
  64.   :"a" (c), "c" (count/4), "D" ((long) s)
  65.   :"cx","di","memory");
  66. }
  67. #endif
  69. #define FOURTHIRDSTABLENUMBER (1<<13)
  71. static REAL two_to_negative_half_pow[40];
  72. static REAL TO_FOUR_THIRDSTABLE[FOURTHIRDSTABLENUMBER*2];
  73. static REAL POW2[256];
  74. static REAL POW2_1[8][2][16];
  75. static REAL ca[8],cs[8];
  79. static REAL cos1_6=cos(PI/6.0*1.0);
  80. static REAL cos2_6=cos(PI/6.0*2.0);
  81. static REAL win[4][36];
  82. static REAL cos_18[9];
  83. static REAL hsec_36[9],hsec_12[3];
  85. typedef struct
  86. {
  87.   REAL l,r;
  88. }RATIOS;
  90. static RATIOS rat_1[16],rat_2[2][64];
  92. void MPEGaudio::layer3initialize(void)
  93. {
  94.   static bool initializedlayer3=false;
  95.   register int i;
  96.   int j,k,l;
  97. #if 0
  98. double td = 0.0;
  99. printf( "%fn", td );
  100.     //pow( 0.0, 1.333333 );
  101. printf( "An" );
  102.     pow( td, 1.333333 );
  103. printf( "Bn" );
  104. #endif
  106.   layer3framestart=0;
  107.   currentprevblock=0;
  109.   {
  110.     for(l=0;l<2;l++)
  111.       for(i=0;i<2;i++)
  112. for(j=0;j<SBLIMIT;j++)
  113.   for(k=0;k<SSLIMIT;k++)
  114.     prevblck[l][i][j][k]=0.0f;
  115.   }
  117.   bitwindow.initialize();
  119.   if(initializedlayer3)return;
  121.   // Calculate win
  122.   {
  123.     for(i=0;i<18;i++)
  124.       win[0][i]=win[1][i]=0.5*sin(PI_72*(double)(2*i+1))/cos(PI_72*(double)(2*i+19));
  125.     for(;i<36;i++)
  126.       win[0][i]=win[3][i]=0.5*sin(PI_72*(double)(2*i+1))/cos(PI_72*(double)(2*i+19));
  128.     for(i=0;i<6;i++)
  129.     {
  130.       win[1][i+18]=0.5/cos(PI_72*(double)(2*(i+18)+19));
  131.       win[3][i+12]=0.5/cos(PI_72*(double)(2*(i+12)+19));
  132.       win[1][i+24]=0.5*sin(PI_24*(double)(2*i+13))/cos(PI_72*(double)(2*(i+24)+19));
  133.       win[1][i+30]=win[3][i]=0.0;
  134.       win[3][i+6 ]=0.5*sin(PI_24*(double)(2*i+1))/cos(PI_72*(double)(2*(i+6)+19));
  135.     }
  136.     for(i=0;i<12;i++)
  137.       win[2][i]=0.5*sin(PI_24*(double)(2*i+1))/cos(PI_24*(double)(2*i+7));
  138.   }
  140.   for(i=0;i<9;i++)
  141.     cos_18[i]=cos(PI_18*double(i));
  142.   for(i=0;i<9;i++)
  143.     hsec_36[i]=0.5/cos(PI_36*double(i*2+1));
  144.   for(i=0;i<3;i++)
  145.     hsec_12[i]=0.5/cos(PI_12*double(i*2+1));
  147.   for(i=0;i<40;i++)
  148.     two_to_negative_half_pow[i]=(REAL)pow(2.0,-0.5*(double)i);
  150.   {
  151.     REAL *TO_FOUR_THIRDS=TO_FOUR_THIRDSTABLE+FOURTHIRDSTABLENUMBER;
  153. //KR
  154.     for( i = 0; i < FOURTHIRDSTABLENUMBER; i++ )
  155. {
  156.       TO_FOUR_THIRDS[-i]= -(TO_FOUR_THIRDS[i] = (REAL)pow((double)i,4.0/3.0));
  157. }
  158.   }
  160.   for(i=0;i<256;i++)POW2[i]=(REAL)pow(2.0,(0.25*(i-210.0)));
  161.   for(i=0;i<8;i++)
  162.     for(j=0;j<2;j++)
  163.       for(k=0;k<16;k++)POW2_1[i][j][k]=pow(2.0,(-2.0*i)-(0.5*(1.0+j)*k));
  165.   {
  166.     static REAL TAN12[16]=
  167.     { 0.0,        0.26794919, 0.57735027  , 1.0,
  168.       1.73205081, 3.73205081, 9.9999999e10,-3.73205081,
  169.       -1.73205081,-1.01,      -0.57735027,  -0.26794919,
  170.       0.0,        0.26794919, 0.57735027,   1.0};
  172.     for(i=0;i<16;i++)
  173.     {
  174.       rat_1[i].l=TAN12[i]/(1.0+TAN12[i]);
  175.       rat_1[i].r=1.0/(1.0+TAN12[i]);
  176.     }
  177.   }
  179. #define IO0 ((double)0.840896415256)
  180. #define IO1 ((double)0.707106781188)
  181.   rat_2[0][0].l=rat_2[0][0].r=
  182.   rat_2[1][0].l=rat_2[1][0].r=1.;
  184.   for(i=1;i<64;i++)
  185.     if((i%2)==1)
  186.     {
  187.       rat_2[0][i].l=pow(IO0,(i+1)/2);
  188.       rat_2[1][i].l=pow(IO1,(i+1)/2);
  189.       rat_2[0][i].r=
  190.       rat_2[1][i].r=1.;
  191.     }
  192.     else
  193.     {
  194.       rat_2[0][i].l=
  195.       rat_2[1][i].l=1.;
  196.       rat_2[0][i].r=pow(IO0,i/2);
  197.       rat_2[1][i].r=pow(IO1,i/2);
  198.     }
  200.   {
  201.     static REAL Ci[8]=
  202.     {-0.6f,-0.535f,-0.33f,-0.185f,-0.095f,-0.041f,-0.0142f,-0.0037f};
  203.     REAL sq;
  205.     for(int i=0;i<8;i++)
  206.     {
  207.       sq=sqrt(1.0f+Ci[i]*Ci[i]);
  208.       cs[i]=1.0f/sq;
  209.       ca[i]=Ci[i]*cs[i];
  210.     }
  211.   }
  213.   initializedlayer3=true;
  214. }
  216. bool MPEGaudio::layer3getsideinfo(void)
  217. {
  218.   sideinfo.main_data_begin=getbits(9);
  220.   if(!inputstereo)sideinfo.private_bits=getbits(5);
  221.   else sideinfo.private_bits=getbits(3);
  222.   
  223.     sideinfo.ch[LS].scfsi[0]=getbit();
  224.     sideinfo.ch[LS].scfsi[1]=getbit();
  225.     sideinfo.ch[LS].scfsi[2]=getbit();
  226.     sideinfo.ch[LS].scfsi[3]=getbit();
  227.   if(inputstereo)
  228.   {
  229.     sideinfo.ch[RS].scfsi[0]=getbit();
  230.     sideinfo.ch[RS].scfsi[1]=getbit();
  231.     sideinfo.ch[RS].scfsi[2]=getbit();
  232.     sideinfo.ch[RS].scfsi[3]=getbit();
  233.   }
  235.   for(int gr=0,ch;gr<2;gr++)
  236.     for(ch=0;;ch++)
  237.     {
  238.       layer3grinfo *gi=&(sideinfo.ch[ch].gr[gr]);
  240.       gi->part2_3_length       =getbits(12);
  241.       gi->big_values           =getbits(9);
  242.       gi->global_gain          =getbits(8);
  243.       gi->scalefac_compress    =getbits(4);
  244.       gi->window_switching_flag=getbit();
  245.       if(gi->window_switching_flag)
  246.       {
  247. gi->block_type      =getbits(2);
  248. gi->mixed_block_flag=getbit();
  250. gi->table_select[0] =getbits(5);
  251. gi->table_select[1] =getbits(5);
  253. gi->subblock_gain[0]=getbits(3);
  254. gi->subblock_gain[1]=getbits(3);
  255. gi->subblock_gain[2]=getbits(3);
  257. /* Set region_count parameters since they are implicit in this case. */
  258. if(gi->block_type==0)
  259. {
  260.   /* printf("Side info bad: block_type == 0 in split block.n");
  261.      exit(0); */
  262.   return false;
  263. }
  264. else if (gi->block_type==2 && gi->mixed_block_flag==0)
  265.      gi->region0_count=8; /* MI 9; */
  266. else gi->region0_count=7; /* MI 8; */
  267. gi->region1_count=20-(gi->region0_count);
  268.       }
  269.       else
  270.       {
  271. gi->table_select[0] =getbits(5);
  272. gi->table_select[1] =getbits(5);
  273. gi->table_select[2] =getbits(5);
  274. gi->region0_count   =getbits(4);
  275. gi->region1_count   =getbits(3);
  276. gi->block_type      =0;
  277. gi->mixed_block_flag = 0;
  278.       }
  279.       gi->preflag           =getbit();
  280.       gi->scalefac_scale    =getbit();
  281.       gi->count1table_select=getbit();
  283.       gi->generalflag=gi->window_switching_flag && (gi->block_type==2);
  285.       if(!inputstereo || ch)break;
  286.     }
  288.   return true;
  289. }
  291. bool MPEGaudio::layer3getsideinfo_2(void)
  292. {
  293.   sideinfo.main_data_begin=getbits(8);
  295.   if(!inputstereo)sideinfo.private_bits=getbit();
  296.   else sideinfo.private_bits=getbits(2);
  297.   
  298.   for(int ch=0;;ch++)
  299.   {
  300.     layer3grinfo *gi=&(sideinfo.ch[ch].gr[0]);
  302.     gi->part2_3_length       =getbits(12);
  303.     gi->big_values           =getbits(9);
  304.     gi->global_gain          =getbits(8);
  305.     gi->scalefac_compress    =getbits(9);
  306.     gi->window_switching_flag=getbit();
  307.     if(gi->window_switching_flag)
  308.     {
  309.       gi->block_type      =getbits(2);
  310.       gi->mixed_block_flag=getbit();
  312.       gi->table_select[0] =getbits(5);
  313.       gi->table_select[1] =getbits(5);
  315.       gi->subblock_gain[0]=getbits(3);
  316.       gi->subblock_gain[1]=getbits(3);
  317.       gi->subblock_gain[2]=getbits(3);
  319.       /* Set region_count parameters since they are implicit in this case. */
  320.       if(gi->block_type==0)
  321.       {
  322. /* printf("Side info bad: block_type == 0 in split block.n");
  323.    exit(0); */
  324. return false;
  325.       }
  326.       else if (gi->block_type==2 && gi->mixed_block_flag==0)
  327. gi->region0_count=8; /* MI 9; */
  328.       else gi->region0_count=7; /* MI 8; */
  329.       gi->region1_count=20-(gi->region0_count);
  330.     }
  331.     else
  332.     {
  333.       gi->table_select[0] =getbits(5);
  334.       gi->table_select[1] =getbits(5);
  335.       gi->table_select[2] =getbits(5);
  336.       gi->region0_count   =getbits(4);
  337.       gi->region1_count   =getbits(3);
  338.       gi->block_type      =0;
  339.       gi->mixed_block_flag = 0;
  340.     }
  341.     gi->scalefac_scale    =getbit();
  342.     gi->count1table_select=getbit();
  343.     
  344.     gi->generalflag=gi->window_switching_flag && (gi->block_type==2);
  345.     
  346.     if(!inputstereo || ch)break;
  347.   }
  349.   return true;
  350. }
  352. void MPEGaudio::layer3getscalefactors(int ch,int gr)
  353. {
  354.   static int slen[2][16]={{0, 0, 0, 0, 3, 1, 1, 1, 2, 2, 2, 3, 3, 3, 4, 4},
  355.   {0, 1, 2, 3, 0, 1, 2, 3, 1, 2, 3, 1, 2, 3, 2, 3}};
  357.   layer3grinfo *gi=&(sideinfo.ch[ch].gr[gr]);
  358.   register layer3scalefactor *sf=(&scalefactors[ch]);
  359.   int l0,l1;
  361.   {
  362.     int scale_comp=gi->scalefac_compress;
  364.     l0=slen[0][scale_comp];
  365.     l1=slen[1][scale_comp];
  366.   }  
  367.   if(gi->generalflag)
  368.   {
  369.     if(gi->mixed_block_flag)
  370.     {                                 /* MIXED */ /* NEW-ag 11/25 */
  371.       sf->l[0]=wgetbits9(l0);sf->l[1]=wgetbits9(l0);
  372.       sf->l[2]=wgetbits9(l0);sf->l[3]=wgetbits9(l0);
  373.       sf->l[4]=wgetbits9(l0);sf->l[5]=wgetbits9(l0);
  374.       sf->l[6]=wgetbits9(l0);sf->l[7]=wgetbits9(l0);
  376.       sf->s[0][ 3]=wgetbits9(l0);sf->s[1][ 3]=wgetbits9(l0);
  377.       sf->s[2][ 3]=wgetbits9(l0);
  378.       sf->s[0][ 4]=wgetbits9(l0);sf->s[1][ 4]=wgetbits9(l0);
  379.       sf->s[2][ 4]=wgetbits9(l0);
  380.       sf->s[0][ 5]=wgetbits9(l0);sf->s[1][ 5]=wgetbits9(l0);
  381.       sf->s[2][ 5]=wgetbits9(l0);
  383.       sf->s[0][ 6]=wgetbits9(l1);sf->s[1][ 6]=wgetbits9(l1);
  384.       sf->s[2][ 6]=wgetbits9(l1);
  385.       sf->s[0][ 7]=wgetbits9(l1);sf->s[1][ 7]=wgetbits9(l1);
  386.       sf->s[2][ 7]=wgetbits9(l1);
  387.       sf->s[0][ 8]=wgetbits9(l1);sf->s[1][ 8]=wgetbits9(l1);
  388.       sf->s[2][ 8]=wgetbits9(l1);
  389.       sf->s[0][ 9]=wgetbits9(l1);sf->s[1][ 9]=wgetbits9(l1);
  390.       sf->s[2][ 9]=wgetbits9(l1);
  391.       sf->s[0][10]=wgetbits9(l1);sf->s[1][10]=wgetbits9(l1);
  392.       sf->s[2][10]=wgetbits9(l1);
  393.       sf->s[0][11]=wgetbits9(l1);sf->s[1][11]=wgetbits9(l1);
  394.       sf->s[2][11]=wgetbits9(l1);
  396.       sf->s[0][12]=sf->s[1][12]=sf->s[2][12]=0;
  397.     }
  398.     else 
  399.     {  /* SHORT*/
  400.       sf->s[0][ 0]=wgetbits9(l0);sf->s[1][ 0]=wgetbits9(l0);
  401.       sf->s[2][ 0]=wgetbits9(l0);
  402.       sf->s[0][ 1]=wgetbits9(l0);sf->s[1][ 1]=wgetbits9(l0);
  403.       sf->s[2][ 1]=wgetbits9(l0);
  404.       sf->s[0][ 2]=wgetbits9(l0);sf->s[1][ 2]=wgetbits9(l0);
  405.       sf->s[2][ 2]=wgetbits9(l0);
  406.       sf->s[0][ 3]=wgetbits9(l0);sf->s[1][ 3]=wgetbits9(l0);
  407.       sf->s[2][ 3]=wgetbits9(l0);
  408.       sf->s[0][ 4]=wgetbits9(l0);sf->s[1][ 4]=wgetbits9(l0);
  409.       sf->s[2][ 4]=wgetbits9(l0);
  410.       sf->s[0][ 5]=wgetbits9(l0);sf->s[1][ 5]=wgetbits9(l0);
  411.       sf->s[2][ 5]=wgetbits9(l0);
  413.       sf->s[0][ 6]=wgetbits9(l1);sf->s[1][ 6]=wgetbits9(l1);
  414.       sf->s[2][ 6]=wgetbits9(l1);
  415.       sf->s[0][ 7]=wgetbits9(l1);sf->s[1][ 7]=wgetbits9(l1);
  416.       sf->s[2][ 7]=wgetbits9(l1);
  417.       sf->s[0][ 8]=wgetbits9(l1);sf->s[1][ 8]=wgetbits9(l1);
  418.       sf->s[2][ 8]=wgetbits9(l1);
  419.       sf->s[0][ 9]=wgetbits9(l1);sf->s[1][ 9]=wgetbits9(l1);
  420.       sf->s[2][ 9]=wgetbits9(l1);
  421.       sf->s[0][10]=wgetbits9(l1);sf->s[1][10]=wgetbits9(l1);
  422.       sf->s[2][10]=wgetbits9(l1);
  423.       sf->s[0][11]=wgetbits9(l1);sf->s[1][11]=wgetbits9(l1);
  424.       sf->s[2][11]=wgetbits9(l1);
  426.       sf->s[0][12]=sf->s[1][12]=sf->s[2][12]=0;
  427.     }
  428.   }
  429.   else
  430.   {   /* LONG types 0,1,3 */
  431.     if(gr==0)
  432.     {
  433.       sf->l[ 0]=wgetbits9(l0);sf->l[ 1]=wgetbits9(l0);
  434.       sf->l[ 2]=wgetbits9(l0);sf->l[ 3]=wgetbits9(l0);
  435.       sf->l[ 4]=wgetbits9(l0);sf->l[ 5]=wgetbits9(l0);
  436.       sf->l[ 6]=wgetbits9(l0);sf->l[ 7]=wgetbits9(l0);
  437.       sf->l[ 8]=wgetbits9(l0);sf->l[ 9]=wgetbits9(l0);
  438.       sf->l[10]=wgetbits9(l0);
  439.       sf->l[11]=wgetbits9(l1);sf->l[12]=wgetbits9(l1);
  440.       sf->l[13]=wgetbits9(l1);sf->l[14]=wgetbits9(l1);
  441.       sf->l[15]=wgetbits9(l1);
  442.       sf->l[16]=wgetbits9(l1);sf->l[17]=wgetbits9(l1);
  443.       sf->l[18]=wgetbits9(l1);sf->l[19]=wgetbits9(l1);
  444.       sf->l[20]=wgetbits9(l1);
  445.     }
  446.     else
  447.     {
  448.       if(sideinfo.ch[ch].scfsi[0]==0)
  449.       {
  450. sf->l[ 0]=wgetbits9(l0);sf->l[ 1]=wgetbits9(l0);
  451. sf->l[ 2]=wgetbits9(l0);sf->l[ 3]=wgetbits9(l0);
  452. sf->l[ 4]=wgetbits9(l0);sf->l[ 5]=wgetbits9(l0);
  453.       }
  454.       if(sideinfo.ch[ch].scfsi[1]==0)
  455.       {
  456. sf->l[ 6]=wgetbits9(l0);sf->l[ 7]=wgetbits9(l0);
  457. sf->l[ 8]=wgetbits9(l0);sf->l[ 9]=wgetbits9(l0);
  458. sf->l[10]=wgetbits9(l0);
  459.       }
  460.       if(sideinfo.ch[ch].scfsi[2]==0)
  461.       {
  462. sf->l[11]=wgetbits9(l1);sf->l[12]=wgetbits9(l1);
  463. sf->l[13]=wgetbits9(l1);sf->l[14]=wgetbits9(l1);
  464. sf->l[15]=wgetbits9(l1);
  465.       }
  466.       if(sideinfo.ch[ch].scfsi[3]==0)
  467.       {
  468. sf->l[16]=wgetbits9(l1);sf->l[17]=wgetbits9(l1);
  469. sf->l[18]=wgetbits9(l1);sf->l[19]=wgetbits9(l1);
  470. sf->l[20]=wgetbits9(l1);
  471.       }
  472.     }
  473.     sf->l[21]=sf->l[22]=0;
  474.   }
  475. }
  477. void MPEGaudio::layer3getscalefactors_2(int ch)
  478. {
  479.   static int sfbblockindex[6][3][4]=
  480.   {
  481.     {{ 6, 5, 5, 5},{ 9, 9, 9, 9},{ 6, 9, 9, 9}},
  482.     {{ 6, 5, 7, 3},{ 9, 9,12, 6},{ 6, 9,12, 6}},
  483.     {{11,10, 0, 0},{18,18, 0, 0},{15,18, 0, 0}},
  484.     {{ 7, 7, 7, 0},{12,12,12, 0},{ 6,15,12, 0}},
  485.     {{ 6, 6, 6, 3},{12, 9, 9, 6},{ 6,12, 9, 6}},
  486.     {{ 8, 8, 5, 0},{15,12, 9, 0},{ 6,18, 9, 0}}
  487.   };
  489.   int sb[54];
  490.   layer3grinfo *gi=&(sideinfo.ch[ch].gr[0]);
  491.   register layer3scalefactor *sf=(&scalefactors[ch]);
  493.   {
  494.     int blocktypenumber,sc;
  495.     int blocknumber;
  496.     int slen[4];
  498.     if(gi->block_type==2)blocktypenumber=1+gi->mixed_block_flag;
  499.     else blocktypenumber=0;
  501.     sc=gi->scalefac_compress;
  502.     if(!((extendedmode==1 || extendedmode==3) && (ch==1)))
  503.     {
  504.       if(sc<400)
  505.       {
  506. slen[0]=(sc>>4)/5;
  507. slen[1]=(sc>>4)%5;
  508. slen[2]=(sc%16)>>2;
  509. slen[3]=(sc%4);
  510. gi->preflag=0;
  511. blocknumber=0;
  512.       }
  513.       else if(sc<500)
  514.       {
  515. sc-=400;
  516. slen[0]=(sc>>2)/5;
  517. slen[1]=(sc>>2)%5;
  518. slen[2]=sc%4;
  519. slen[3]=0;
  520. gi->preflag=0;
  521. blocknumber=1;
  522.       }
  523.       else // if(sc<512)
  524.       {
  525. sc-=500;
  526. slen[0]=sc/3;
  527. slen[1]=sc%3;
  528. slen[2]=0;
  529. slen[3]=0;
  530. gi->preflag=1;
  531. blocknumber=2;
  532.       }
  533.     }
  534.     else
  535.     {
  536.       sc>>=1;
  537.       if(sc<180)
  538.       {
  539. slen[0]=sc/36;
  540. slen[1]=(sc%36)/6;
  541. slen[2]=(sc%36)%6;
  542. slen[3]=0;
  543. gi->preflag=0;
  544. blocknumber=3;
  545.       }
  546.       else if(sc<244)
  547.       {
  548. sc-=180;
  549. slen[0]=(sc%64)>>4;
  550. slen[1]=(sc%16)>>2;
  551. slen[2]=sc%4;
  552. slen[3]=0;
  553. gi->preflag=0;
  554. blocknumber=4;
  555.       }
  556.       else // if(sc<255)
  557.       {
  558. sc-=244;
  559. slen[0]=sc/3;
  560. slen[1]=sc%3;
  561. slen[2]=
  562. slen[3]=0;
  563. gi->preflag=0;
  564. blocknumber=5;
  565.       }
  566.     }
  568.     {
  569.       int i,j,k,*si;
  571.       si=sfbblockindex[blocknumber][blocktypenumber];
  572.       for(i=0;i<45;i++)sb[i]=0;
  574.       for(k=i=0;i<4;i++)
  575. for(j=0;j<si[i];j++,k++)
  576.   if(slen[i]==0)sb[k]=0;
  577.   else sb[k]=wgetbits(slen[i]);
  578.     }
  579.   }
  582.   {
  583.     int sfb,window;
  584.     int k=0;
  586.     if(gi->window_switching_flag && (gi->block_type==2))
  587.     {
  588.       if(gi->mixed_block_flag)
  589.       {
  590. for(sfb=0;sfb<8;sfb++)sf->l[sfb]=sb[k++];
  591. sfb=3;
  592.       }
  593.       else sfb=0;
  595.       for(;sfb<12;sfb++)
  596. for(window=0;window<3;window++)
  597.   sf->s[window][sfb]=sb[k++];
  599.       sf->s[0][12]=sf->s[1][12]=sf->s[2][12]=0;
  600.     }
  601.     else
  602.     {
  603.       for(sfb=0;sfb<21;sfb++)
  604. sf->l[sfb]=sb[k++];
  605.       sf->l[21]=sf->l[22]=0;
  606.     }
  607.   }
  608. }
  611. typedef unsigned int HUFFBITS;
  612. #define MXOFF   250
  614. /* do the huffman-decoding  */
  615. /* note! for counta,countb -the 4 bit value is returned in y, discard x */
  616. // Huffman decoder for tablename<32
  617. void MPEGaudio::huffmandecoder_1(const HUFFMANCODETABLE *h,int *x,int *y)
  618. {  
  619.   HUFFBITS level=(1<<(sizeof(HUFFBITS)*8-1));
  620.   int point=0;
  622.   /* Lookup in Huffman table. */
  623.   for(;;)
  624.   {
  625.     if(h->val[point][0]==0)
  626.     {   /*end of tree*/
  627.       int xx,yy;
  629.       xx=h->val[point][1]>>4;
  630.       yy=h->val[point][1]&0xf;
  632.       if(h->linbits)
  633.       {
  634. if((h->xlen)==(unsigned)xx)xx+=wgetbits(h->linbits);
  635. if(xx)if(wgetbit())xx=-xx;
  636. if((h->ylen)==(unsigned)yy)yy+=wgetbits(h->linbits);
  637. if(yy)if(wgetbit())yy=-yy;
  638.       }
  639.       else
  640.       {
  641. if(xx)if(wgetbit())xx=-xx;
  642. if(yy)if(wgetbit())yy=-yy;
  643.       }
  644.       *x=xx;*y=yy;
  645.       break;
  646.     } 
  648.     point+=h->val[point][wgetbit()];
  649.     
  650.     level>>=1;
  651.     if(!(level || ((unsigned)point<ht->treelen)))
  652.     {
  653.       register int xx,yy;
  655.       xx=(h->xlen<<1);// set x and y to a medium value as a simple concealment
  656.       yy=(h->ylen<<1);
  658.       // h->xlen and h->ylen can't be 1 under tablename 32
  659.       //      if(xx)
  660. if(wgetbit())xx=-xx;
  661.       //      if(yy)
  662. if(wgetbit())yy=-yy;
  664.       *x=xx;*y=yy;
  665.       break;
  666.     }
  667.   }
  668. }
  670. // Huffman decoder tablenumber>=32
  671. void MPEGaudio::huffmandecoder_2(const HUFFMANCODETABLE *h,
  672.        int *x,int *y,int *v,int *w)
  673. {  
  674.   HUFFBITS level=(1<<(sizeof(HUFFBITS)*8-1));
  675.   int point=0;
  677.   /* Lookup in Huffman table. */
  678.   for(;;)
  679.   {
  680.     if(h->val[point][0]==0)
  681.     {   /*end of tree*/
  682.       register int t=h->val[point][1];
  684.       if(t&8)*v=1-(wgetbit()<<1); else *v=0;
  685.       if(t&4)*w=1-(wgetbit()<<1); else *w=0;
  686.       if(t&2)*x=1-(wgetbit()<<1); else *x=0;
  687.       if(t&1)*y=1-(wgetbit()<<1); else *y=0;
  688.       break;
  689.     } 
  690.     point+=h->val[point][wgetbit()];
  691.     level>>=1;
  692.     if(!(level || ((unsigned)point<ht->treelen)))
  693.     {
  694.       *v=1-(wgetbit()<<1);
  695.       *w=1-(wgetbit()<<1);
  696.       *x=1-(wgetbit()<<1);
  697.       *y=1-(wgetbit()<<1);
  698.       break;
  699.     }
  700.   }
  701. }
  703. typedef struct
  704. {
  705.   int l[23];
  706.   int s[14];
  707. }SFBANDINDEX;
  709. static SFBANDINDEX sfBandIndextable[2][3]=
  710. {
  711.   // MPEG 1
  712.   {{{0,4,8,12,16,20,24,30,36,44,52,62,74,90,110,134,162,196,238,288,342,418,576},
  713.     {0,4,8,12,16,22,30,40,52,66,84,106,136,192}},
  714.    {{0,4,8,12,16,20,24,30,36,42,50,60,72,88,106,128,156,190,230,276,330,384,576},
  715.     {0,4,8,12,16,22,28,38,50,64,80,100,126,192}},
  716.    {{0,4,8,12,16,20,24,30,36,44,54,66,82,102,126,156,194,240,296,364,448,550,576},
  717.     {0,4,8,12,16,22,30,42,58,78,104,138,180,192}}},
  719.   // MPEG 2
  720.   {{{0,6,12,18,24,30,36,44,54,66,80,96,116,140,168,200,238,284,336,396,464,522,576},
  721.     {0,4,8,12,18,24,32,42,56,74,100,132,174,192}},
  722.    {{0,6,12,18,24,30,36,44,54,66,80,96,114,136,162,194,232,278,330,394,464,540,576},
  723.     {0,4,8,12,18,26,36,48,62,80,104,136,180,192}},
  724.    {{0,6,12,18,24,30,36,44,54,66,80,96,116,140,168,200,238,284,336,396,464,522,576},
  725.     {0,4,8,12,18,26,36,48,62,80,104,134,174,192}}}
  726. };
  729. void MPEGaudio::layer3huffmandecode(int ch,int gr,int out[SBLIMIT][SSLIMIT])
  730. {
  731.   layer3grinfo *gi=&(sideinfo.ch[ch].gr[gr]);
  732.   int part2_3_end=layer3part2start+(gi->part2_3_length);
  733.   int region1Start,region2Start;
  734.   int i,e=gi->big_values<<1;
  736.   /* Find region boundary for short block case. */
  737.   if(gi->generalflag)
  738.   {
  739.     /* Region2. */
  740.     region1Start=36; /* sfb[9/3]*3=36 */
  741.     region2Start=576;/* No Region2 for short block case. */
  742.   }
  743.   else
  744.   {          /* Find region boundary for long block case. */
  745.     region1Start=sfBandIndextable[version][frequency].l[gi->region0_count+1];
  746.     region2Start=sfBandIndextable[version][frequency].l[gi->region0_count+
  747.         gi->region1_count+2];
  748.   }
  750.   /* Read bigvalues area. */
  751.   for(i=0;i<e;)
  752.   {
  753.     const HUFFMANCODETABLE *h;
  754.     register int end;
  755.       
  756.     if     (i<region1Start)
  757.     {
  758.       h=&ht[gi->table_select[0]];
  759.       if(region1Start>e)end=e; else end=region1Start;
  760.     }
  761.     else if(i<region2Start)
  762.     {
  763.       h=&ht[gi->table_select[1]];
  764.       if(region2Start>e)end=e; else end=region2Start;
  765.     }
  766.     else
  767.     {
  768.       h=&ht[gi->table_select[2]];
  769.       end=e;
  770.     }
  772.     if(h->treelen)
  773.       while(i<end)
  774.       {
  775. huffmandecoder_1(h,&out[0][i],&out[0][i+1]);
  776. i+=2;
  777.       }
  778.     else
  779.       for(;i<end;i+=2)
  780. out[0][i]  =
  781. out[0][i+1]=0;
  782.   }
  784.   /* Read count1 area. */
  785.   const HUFFMANCODETABLE *h=&ht[gi->count1table_select+32];
  786.   while(bitwindow.gettotalbit()<part2_3_end)
  787.   {
  788.     huffmandecoder_2(h,&out[0][i+2],&out[0][i+3],
  789.      &out[0][i  ],&out[0][i+1]);
  790.     i+=4;
  792.     if(i>=ARRAYSIZE)
  793.     {
  794.       bitwindow.rewind(bitwindow.gettotalbit()-part2_3_end);
  795.       return;
  796.     }
  797.   }
  798.   
  799.   for(;i<ARRAYSIZE;i++)out[0][i]=0;
  800.   bitwindow.rewind(bitwindow.gettotalbit()-part2_3_end);
  801. }
  804. static int pretab[22]={0,0,0,0,0,0,0,0,0,0,0,1,1,1,1,2,2,3,3,3,2,0};
  806. REAL MPEGaudio::layer3twopow2(int scale,int preflag,
  807.      int pretab_offset,int l)
  808. {
  809.   int index=l;
  810.   
  811.   if(preflag)index+=pretab_offset;
  812.   return(two_to_negative_half_pow[index<<scale]);
  813. }
  815. REAL MPEGaudio::layer3twopow2_1(int a,int b,int c)
  816. {
  817.   return POW2_1[a][b][c];
  818. }
  820. void MPEGaudio::layer3dequantizesample(int ch,int gr,
  821.        int   in[SBLIMIT][SSLIMIT],
  822.        REAL out[SBLIMIT][SSLIMIT])
  823. {
  824.   layer3grinfo *gi=&(sideinfo.ch[ch].gr[gr]);
  825.   SFBANDINDEX *sfBandIndex=&(sfBandIndextable[version][frequency]);
  826.   REAL globalgain=POW2[gi->global_gain];
  827.   REAL *TO_FOUR_THIRDS=TO_FOUR_THIRDSTABLE+FOURTHIRDSTABLENUMBER;
  829.   /* choose correct scalefactor band per block type, initalize boundary */
  830.   /* and apply formula per block type */
  831.   
  832.   if(!gi->generalflag)
  833.   {                                          /* LONG blocks: 0,1,3 */
  834.     int next_cb_boundary;
  835.     int cb=-1,index=0;
  836.     REAL factor;
  838.     do
  839.     {
  840.       next_cb_boundary=sfBandIndex->l[(++cb)+1];
  841.       factor=globalgain*
  842.      layer3twopow2(gi->scalefac_scale,gi->preflag,
  843.    pretab[cb],scalefactors[ch].l[cb]);
  844.       for(;index<next_cb_boundary;)
  845.       {
  846. out[0][index]=factor*TO_FOUR_THIRDS[in[0][index]];index++;
  847. out[0][index]=factor*TO_FOUR_THIRDS[in[0][index]];index++;
  848.       }
  849.     }while(index<ARRAYSIZE);
  850.   }
  851.   else if(!gi->mixed_block_flag)
  852.   {
  853.     int cb=0,index=0;
  854.     int cb_width;
  856.     do
  857.     {
  858.       cb_width=(sfBandIndex->s[cb+1]-sfBandIndex->s[cb])>>1;
  860.       for(register int k=0;k<3;k++)
  861.       {
  862. register REAL factor;
  863. register int count=cb_width;
  865. factor=globalgain*
  866.        layer3twopow2_1(gi->subblock_gain[k],gi->scalefac_scale,
  867.        scalefactors[ch].s[k][cb]);
  868. do{
  869.   out[0][index]=factor*TO_FOUR_THIRDS[in[0][index]];index++;
  870.   out[0][index]=factor*TO_FOUR_THIRDS[in[0][index]];index++;
  871. }while(--count);
  872.       }
  873.       cb++;
  874.     }while(index<ARRAYSIZE);
  875.   }
  876.   else
  877.   {
  878.     int cb_begin=0,cb_width=0;
  879.     int cb=0;
  880.     int next_cb_boundary=sfBandIndex->l[1]; /* LONG blocks: 0,1,3 */
  881.     int index;
  883.     /* Compute overall (global) scaling. */
  884.     {
  885.       for(int sb=0;sb<SBLIMIT;sb++)
  886.       {
  887. int *i=in[sb];
  888. REAL *o=out[sb];
  890. o[ 0]=globalgain*TO_FOUR_THIRDS[i[ 0]];o[ 1]=globalgain*TO_FOUR_THIRDS[i[ 1]];
  891. o[ 2]=globalgain*TO_FOUR_THIRDS[i[ 2]];o[ 3]=globalgain*TO_FOUR_THIRDS[i[ 3]];
  892. o[ 4]=globalgain*TO_FOUR_THIRDS[i[ 4]];o[ 5]=globalgain*TO_FOUR_THIRDS[i[ 5]];
  893. o[ 6]=globalgain*TO_FOUR_THIRDS[i[ 6]];o[ 7]=globalgain*TO_FOUR_THIRDS[i[ 7]];
  894. o[ 8]=globalgain*TO_FOUR_THIRDS[i[ 8]];o[ 9]=globalgain*TO_FOUR_THIRDS[i[ 9]];
  895. o[10]=globalgain*TO_FOUR_THIRDS[i[10]];o[11]=globalgain*TO_FOUR_THIRDS[i[11]];
  896. o[12]=globalgain*TO_FOUR_THIRDS[i[12]];o[13]=globalgain*TO_FOUR_THIRDS[i[13]];
  897. o[14]=globalgain*TO_FOUR_THIRDS[i[14]];o[15]=globalgain*TO_FOUR_THIRDS[i[15]];
  898. o[16]=globalgain*TO_FOUR_THIRDS[i[16]];o[17]=globalgain*TO_FOUR_THIRDS[i[17]];
  899.       }
  900.     }
  902.     for(index=0;index<SSLIMIT*2;index++)
  903.     {
  904.       if(index==next_cb_boundary)
  905.       {
  906. if(index==sfBandIndex->l[8])
  907. {
  908.   next_cb_boundary=sfBandIndex->s[4];
  909.   next_cb_boundary=MUL3(next_cb_boundary);
  910.   cb=3;
  911.   cb_width=sfBandIndex->s[4]-sfBandIndex->s[3];
  912.   cb_begin=sfBandIndex->s[3];
  913.   cb_begin=MUL3(cb_begin);
  914. }
  915. else if(index<sfBandIndex->l[8])
  916.   next_cb_boundary=sfBandIndex->l[(++cb)+1];
  917. else 
  918. {
  919.   next_cb_boundary=sfBandIndex->s[(++cb)+1];
  920.   next_cb_boundary=MUL3(next_cb_boundary);
  921.   cb_begin=sfBandIndex->s[cb];
  922.   cb_width=sfBandIndex->s[cb+1]-cb_begin;
  923.   cb_begin=MUL3(cb_begin);
  924. }
  925.       }
  926.       /* LONG block types 0,1,3 & 1st 2 subbands of switched blocks */
  927.       out[0][index]*=layer3twopow2(gi->scalefac_scale,gi->preflag,
  928.    pretab[cb],scalefactors[ch].l[cb]);
  929.     }
  931.     for(;index<ARRAYSIZE;index++)
  932.     { 
  933.       if(index==next_cb_boundary)
  934.       {
  935. if(index==sfBandIndex->l[8])
  936. {
  937.   next_cb_boundary=sfBandIndex->s[4];
  938.   next_cb_boundary=MUL3(next_cb_boundary);
  939.   cb=3;
  940.   cb_width=sfBandIndex->s[4]-sfBandIndex->s[3];
  941.   cb_begin=sfBandIndex->s[3];
  942.   cb_begin=(cb_begin<<2)-cb_begin;
  943. }
  944. else if(index<sfBandIndex->l[8])
  945.   next_cb_boundary=sfBandIndex->l[(++cb)+1];
  946. else 
  947. {
  948.   next_cb_boundary=sfBandIndex->s[(++cb)+1];
  949.   next_cb_boundary=MUL3(next_cb_boundary);
  950.   cb_begin=sfBandIndex->s[cb];
  951.   cb_width=sfBandIndex->s[cb+1]-cb_begin;
  952.   cb_begin=MUL3(cb_begin);
  953. }
  954.       }
  955.       {
  956. int t_index=(index-cb_begin)/cb_width;
  957. out[0][index]*=layer3twopow2_1(gi->subblock_gain[t_index],
  958.        gi->scalefac_scale,
  959.        scalefactors[ch].s[t_index][cb]);
  960.       }
  961.     }
  962.   }
  963. }
  965. void MPEGaudio::layer3fixtostereo(int gr,REAL in[2][SBLIMIT][SSLIMIT])
  966. {
  967.   layer3grinfo *gi=&(sideinfo.ch[0].gr[gr]);
  968.   SFBANDINDEX *sfBandIndex=&(sfBandIndextable[version][frequency]);
  969.   
  970.   int ms_stereo=(mode==joint) && (extendedmode & 0x2);
  971.   int i_stereo =(mode==joint) && (extendedmode & 0x1);
  973.   if(!inputstereo)
  974.   { /* mono , bypass xr[0][][] to lr[0][][]*/
  975.     // memcpy(out[0][0],in[0][0],ARRAYSIZE*REALSIZE);
  976.     return;
  977.   } 
  978.     
  979.   if(i_stereo)
  980.   {
  981.     int i;
  982.     int    is_pos[ARRAYSIZE];
  983.     RATIOS is_ratio[ARRAYSIZE];
  984.     RATIOS *ratios;
  986.     if(version)ratios=rat_2[gi->scalefac_compress%2];
  987.     else ratios=rat_1;
  989.     /* initialization */
  990.     for(i=0;i<ARRAYSIZE;i+=2)is_pos[i]=is_pos[i+1]=7;
  992.     if(gi->generalflag)
  993.     {
  994.       if(gi->mixed_block_flag)           // Part I
  995.       {
  996. int max_sfb=0;
  998. for(int j=0;j<3;j++)
  999. {
  1000.   int sfb,sfbcnt=2;
  1002.   for(sfb=12;sfb>=3;sfb--)
  1003.   {
  1004.     int lines;
  1006.     i=sfBandIndex->s[sfb];
  1007.     lines=sfBandIndex->s[sfb+1]-i;
  1008.     i=MUL3(i)+(j+1)*lines-1;
  1009.     for(;lines>0;lines--,i--)
  1010.       if(in[1][0][i]!=0.0f)
  1011.       {
  1012. sfbcnt=sfb;
  1013. sfb=0;break;        // quit loop
  1014.       }
  1015.   }
  1016.   sfb=sfbcnt+1;
  1017.     
  1018.   if(sfb>max_sfb)max_sfb=sfb;
  1019.     
  1020.   for(;sfb<12;sfb++)
  1021.   {
  1022.     int k,t;
  1024.     t=sfBandIndex->s[sfb];
  1025.     k=sfBandIndex->s[sfb+1]-t;
  1026.     i=MUL3(t)+j*k;
  1028.     t=scalefactors[1].s[j][sfb];
  1029.     if(t!=7)
  1030.     {
  1031.       RATIOS r=ratios[t];
  1033.       for(;k>0;k--,i++){
  1034. is_pos[i]=t;is_ratio[i]=r;}
  1035.     }
  1036.     else
  1037.       for(;k>0;k--,i++)is_pos[i]=t;
  1038.   }
  1039.   sfb=sfBandIndex->s[10];
  1040.   sfb=MUL3(sfb)+j*(sfBandIndex->s[11]-sfb);
  1042.   {
  1043.     int k,t;
  1045.     t=sfBandIndex->s[11];
  1046.     k=sfBandIndex->s[12]-t;
  1047.     i=MUL3(t)+j*k;
  1049.     t=is_pos[sfb];
  1050.     if(t!=7)
  1051.     {
  1052.       RATIOS r=is_ratio[sfb];
  1054.       for(;k>0;k--,i++){
  1055. is_pos[i]=t;is_ratio[i]=r;}
  1056.     }
  1057.     else
  1058.       for(;k>0;k--,i++)is_pos[i]=t;
  1059.   }
  1060. }
  1062. if(max_sfb<=3)
  1063. {
  1064.   {
  1065.     REAL temp;
  1066.     int k;
  1068.     temp=in[1][0][0];in[1][0][0]=1.0;
  1069.     for(k=3*SSLIMIT-1;in[1][0][k]==0.0;k--);
  1070.     in[1][0][0]=temp;
  1071.     for(i=0;sfBandIndex->l[i]<=k;i++);
  1072.   }
  1073.   {
  1074.     int sfb=i;
  1076.     i=sfBandIndex->l[i];
  1077.     for(;sfb<8;sfb++)
  1078.     {
  1079.       int t=scalefactors[1].l[sfb];
  1080.       int k=sfBandIndex->l[sfb+1]-sfBandIndex->l[sfb];
  1082.       if(t!=7)
  1083.       {
  1084. RATIOS r=ratios[t];
  1086. for(;k>0;k--,i++){
  1087.   is_pos[i]=t;is_ratio[i]=r;}
  1088.       }
  1089.       else for(;k>0;k--,i++)is_pos[i]=t;
  1090.     }
  1091.   }
  1092. }
  1093.       }
  1094.       else                                // Part II
  1095.       {
  1096. for(int j=0;j<3;j++)
  1097. {
  1098.   int sfb;
  1099.       int sfbcnt=-1;
  1101.   for(sfb=12;sfb>=0;sfb--)
  1102.   {
  1103.     int lines;
  1105.     {
  1106.       int t;
  1108.       t=sfBandIndex->s[sfb];
  1109.       lines=sfBandIndex->s[sfb+1]-t;
  1110.       i=MUL3(t)+(j+1)*lines-1;
  1111.     }
  1112.   
  1113.     for(;lines>0;lines--,i--)
  1114.       if(in[1][0][i]!=0.0f)
  1115.       {
  1116. sfbcnt=sfb;
  1117. sfb=0;break;       // quit loop
  1118.       }
  1119.   }
  1121.   for(sfb=sfbcnt+1;sfb<12;sfb++)
  1122.   {
  1123.     int k,t;
  1125.     t=sfBandIndex->s[sfb];
  1126.     k=sfBandIndex->s[sfb+1]-t;
  1127.     i=MUL3(t)+j*k;
  1129.     t=scalefactors[1].s[j][sfb];
  1130.     if(t!=7)
  1131.     {
  1132.       RATIOS r=ratios[t];
  1134.       for(;k>0;k--,i++){
  1135. is_pos[i]=t;is_ratio[i]=r;}
  1136.     }
  1137.     else for(;k>0;k--,i++)is_pos[i]=t;
  1138.   }
  1140.   {
  1141.     int t1=sfBandIndex->s[10],
  1142.         t2=sfBandIndex->s[11];
  1143.     int k,tt;
  1145.     tt=MUL3(t1)+j*(t2-t1);
  1146.     k =sfBandIndex->s[12]-t2;
  1147.     if(is_pos[tt]!=7)
  1148.     {
  1149.       RATIOS r=is_ratio[tt];
  1150.       int  t=is_pos[tt];
  1152.       i   =MUL3(t1)+j*k;
  1153.       for(;k>0;k--,i++){
  1154. is_pos[i]=t;is_ratio[i]=r;}
  1155.     }
  1156.     else
  1157.       for(;k>0;k--,i++)is_pos[i]=7;
  1158.   }
  1159. }
  1160.       }
  1161.     }
  1162.     else // ms-stereo (Part III)
  1163.     {
  1164.       {
  1165. REAL temp;
  1166. int k;
  1168. temp=in[1][0][0];in[1][0][0]=1.0;
  1169. for(k=ARRAYSIZE-1;in[1][0][k]==0.0;k--);
  1170. in[1][0][0]=temp;
  1171. for(i=0;sfBandIndex->l[i]<=k;i++);
  1172.       }
  1174.       {
  1175. int sfb;
  1177. sfb=i;
  1178. i=sfBandIndex->l[i];
  1179. for(;sfb<21;sfb++)
  1180.         {
  1181.   int k,t;
  1183.   k=sfBandIndex->l[sfb+1]-sfBandIndex->l[sfb];
  1184.   t=scalefactors[1].l[sfb];
  1185.   if(t!=7)
  1186.   {
  1187.     RATIOS r=ratios[t];
  1189.     for(;k>0;k--,i++){
  1190.       is_pos[i]=t;is_ratio[i]=r;}
  1191.   }
  1192.   else
  1193.     for(;k>0;k--,i++)is_pos[i]=t;
  1194. }
  1195.       }
  1197.       if (i <= sfBandIndex->l[21]) {
  1198. int k,t,tt;
  1200. tt=sfBandIndex->l[20];
  1201. k=576-sfBandIndex->l[21];
  1202. t=is_pos[tt];
  1203. if(t!=7)
  1204. {
  1205.   RATIOS r=is_ratio[tt];
  1207.   for(;k>0;k--,i++){
  1208.     is_pos[i]=t;is_ratio[i]=r;}
  1209. }
  1210. else
  1211.   for(;k>0;k--,i++)is_pos[i]=t;
  1212.       }
  1213.     }
  1215.     if(ms_stereo)
  1216.     {
  1217.       i=ARRAYSIZE-1;
  1218.       do{
  1219. if(is_pos[i]==7)
  1220. {
  1221.   register REAL t=in[LS][0][i];
  1222.   in[LS][0][i]=(t+in[RS][0][i])*0.7071068f;
  1223.   in[RS][0][i]=(t-in[RS][0][i])*0.7071068f;
  1224. }
  1225. else
  1226. {
  1227.   in[RS][0][i]=in[LS][0][i]*is_ratio[i].r;
  1228.   in[LS][0][i]*=is_ratio[i].l;
  1229. }
  1230.       }while(i--);
  1231.     }
  1232.     else
  1233.     {
  1234.       i=ARRAYSIZE-1;
  1235.       do{
  1236. if(is_pos[i]!=7)
  1237. {
  1238.   in[RS][0][i]=in[LS][0][i]*is_ratio[i].r;
  1239.   in[LS][0][i]*=is_ratio[i].l;
  1240. }
  1241.       }while(i--);
  1242.     }
  1243.   }
  1244.   else
  1245.   {
  1246.     if(ms_stereo)
  1247.     {
  1248.       int i=ARRAYSIZE-1;
  1249.       do{
  1250. register REAL t=in[LS][0][i];
  1252. in[LS][0][i]=(t+in[RS][0][i])*0.7071068f;
  1253. in[RS][0][i]=(t-in[RS][0][i])*0.7071068f;
  1254.       }while(i--);
  1255.     }
  1256.   }
  1258.   // channels==2
  1259. }
  1261. inline void layer3reorder_1(int version,int frequency,
  1262.     REAL  in[SBLIMIT][SSLIMIT],
  1263.     REAL out[SBLIMIT][SSLIMIT])
  1264. {
  1265.   SFBANDINDEX *sfBandIndex=&(sfBandIndextable[version][frequency]);
  1266.   int sfb,sfb_start,sfb_lines;
  1267.   
  1268.   /* NO REORDER FOR LOW 2 SUBBANDS */
  1269.   out[0][ 0]=in[0][ 0];out[0][ 1]=in[0][ 1];out[0][ 2]=in[0][ 2];
  1270.   out[0][ 3]=in[0][ 3];out[0][ 4]=in[0][ 4];out[0][ 5]=in[0][ 5];
  1271.   out[0][ 6]=in[0][ 6];out[0][ 7]=in[0][ 7];out[0][ 8]=in[0][ 8];
  1272.   out[0][ 9]=in[0][ 9];out[0][10]=in[0][10];out[0][11]=in[0][11];
  1273.   out[0][12]=in[0][12];out[0][13]=in[0][13];out[0][14]=in[0][14];
  1274.   out[0][15]=in[0][15];out[0][16]=in[0][16];out[0][17]=in[0][17];
  1276.   out[1][ 0]=in[1][ 0];out[1][ 1]=in[1][ 1];out[1][ 2]=in[1][ 2];
  1277.   out[1][ 3]=in[1][ 3];out[1][ 4]=in[1][ 4];out[1][ 5]=in[1][ 5];
  1278.   out[1][ 6]=in[1][ 6];out[1][ 7]=in[1][ 7];out[1][ 8]=in[1][ 8];
  1279.   out[1][ 9]=in[1][ 9];out[1][10]=in[1][10];out[1][11]=in[1][11];
  1280.   out[1][12]=in[1][12];out[1][13]=in[1][13];out[1][14]=in[1][14];
  1281.   out[1][15]=in[1][15];out[1][16]=in[1][16];out[1][17]=in[1][17];
  1284.   /* REORDERING FOR REST SWITCHED SHORT */
  1285.   for(sfb=3,sfb_start=sfBandIndex->s[3],
  1286. sfb_lines=sfBandIndex->s[4]-sfb_start;
  1287.       sfb<13;
  1288.       sfb++,sfb_start=sfBandIndex->s[sfb],
  1289. (sfb_lines=sfBandIndex->s[sfb+1]-sfb_start))
  1290.   {
  1291.     for(int freq=0;freq<sfb_lines;freq++)
  1292.     {
  1293.       int src_line=sfb_start+(sfb_start<<1)+freq;
  1294.       int des_line=src_line+(freq<<1);
  1295.       out[0][des_line  ]=in[0][src_line               ];
  1296.       out[0][des_line+1]=in[0][src_line+sfb_lines     ];
  1297.       out[0][des_line+2]=in[0][src_line+(sfb_lines<<1)];
  1298.     }
  1299.   }
  1300. }
  1302. inline void layer3reorder_2(int version,int frequency,REAL  in[SBLIMIT][SSLIMIT],
  1303.     REAL out[SBLIMIT][SSLIMIT])
  1304. {
  1305.   SFBANDINDEX *sfBandIndex=&(sfBandIndextable[version][frequency]);
  1306.   int sfb,sfb_start,sfb_lines;
  1307.   
  1308.   for(sfb=0,sfb_start=0,sfb_lines=sfBandIndex->s[1];
  1309.       sfb<13;
  1310.       sfb++,sfb_start=sfBandIndex->s[sfb],
  1311. (sfb_lines=sfBandIndex->s[sfb+1]-sfb_start))
  1312.   {
  1313.     for(int freq=0;freq<sfb_lines;freq++)
  1314.     {
  1315.       int src_line=sfb_start+(sfb_start<<1)+freq;
  1316.       int des_line=src_line+(freq<<1);
  1318.       out[0][des_line  ]=in[0][src_line               ];
  1319.       out[0][des_line+1]=in[0][src_line+sfb_lines     ];
  1320.       out[0][des_line+2]=in[0][src_line+(sfb_lines<<1)];
  1321.     }
  1322.   }
  1323. }
  1326. inline void layer3antialias_1(REAL  in[SBLIMIT][SSLIMIT])
  1327. {
  1328.   for(int ss=0;ss<8;ss++)
  1329.   {
  1330.     REAL bu,bd; /* upper and lower butterfly inputs */
  1331.     
  1332.     bu=in[0][17-ss];bd=in[1][ss];
  1333.     in[0][17-ss]=(bu*cs[ss])-(bd*ca[ss]);
  1334.     in[1][ss]   =(bd*cs[ss])+(bu*ca[ss]);
  1335.   }
  1336. }
  1338. inline
  1339. void layer3antialias_2(REAL  in[SBLIMIT][SSLIMIT],
  1340.        REAL out[SBLIMIT][SSLIMIT])
  1341. {
  1342.   out[0][0]=in[0][0];out[0][1]=in[0][1];
  1343.   out[0][2]=in[0][2];out[0][3]=in[0][3];
  1344.   out[0][4]=in[0][4];out[0][5]=in[0][5];
  1345.   out[0][6]=in[0][6];out[0][7]=in[0][7];
  1347.   for(int index=SSLIMIT;index<=(SBLIMIT-1)*SSLIMIT;index+=SSLIMIT)
  1348.   {
  1349.     for(int n=0;n<8;n++)
  1350.     {
  1351.       REAL bu,bd;
  1353.       bu=in[0][index-n-1];bd=in[0][index+n];
  1354.       out[0][index-n-1]=(bu*cs[n])-(bd*ca[n]);
  1355.       out[0][index+n  ]=(bd*cs[n])+(bu*ca[n]);
  1356.     }
  1357.     out[0][index-SSLIMIT+8]=in[0][index-SSLIMIT+8];
  1358.     out[0][index-SSLIMIT+9]=in[0][index-SSLIMIT+9];
  1359.   }
  1361.   out[31][ 8]=in[31][ 8];out[31][ 9]=in[31][ 9];
  1362.   out[31][10]=in[31][10];out[31][11]=in[31][11];
  1363.   out[31][12]=in[31][12];out[31][13]=in[31][13];
  1364.   out[31][14]=in[31][14];out[31][15]=in[31][15];
  1365.   out[31][16]=in[31][16];out[31][17]=in[31][17];
  1366. }
  1368. void MPEGaudio::layer3reorderandantialias(int ch,int gr,
  1369.   REAL  in[SBLIMIT][SSLIMIT],
  1370.   REAL out[SBLIMIT][SSLIMIT])
  1371. {
  1372.   register layer3grinfo *gi=&(sideinfo.ch[ch].gr[gr]);
  1374.   if(gi->generalflag)
  1375.   {
  1376.     if(gi->mixed_block_flag)
  1377.     {
  1378.       fprintf(stderr,"Notchecked!");
  1379.       layer3reorder_1  (version,frequency,in,out);    // Not checked...
  1380.       layer3antialias_1(out);
  1381.     }
  1382.     else
  1383.       layer3reorder_2(version,frequency,in,out);
  1384.   }
  1385.   else
  1386.     layer3antialias_2(in,out);
  1387. }
  1389. static void dct36(REAL *inbuf,REAL *prevblk1,REAL *prevblk2,REAL *wi,REAL *out)
  1390. {
  1391. #define MACRO0(v) {                                 
  1392.     REAL tmp;                                       
  1393.     out2[9+(v)]=(tmp=sum0+sum1)*wi[27+(v)];         
  1394.     out2[8-(v)]=tmp * wi[26-(v)];  }                
  1395.     sum0-=sum1;                                     
  1396.     ts[SBLIMIT*(8-(v))]=out1[8-(v)]+sum0*wi[8-(v)]; 
  1397.     ts[SBLIMIT*(9+(v))]=out1[9+(v)]+sum0*wi[9+(v)]; 
  1398. #define MACRO1(v) { 
  1399.     REAL sum0,sum1; 
  1400.     sum0=tmp1a+tmp2a; 
  1401.     sum1=(tmp1b+tmp2b)*hsec_36[(v)]; 
  1402.     MACRO0(v); }
  1403. #define MACRO2(v) {                    
  1404.     REAL sum0,sum1;                    
  1405.     sum0=tmp2a-tmp1a;                  
  1406.     sum1=(tmp2b-tmp1b) * hsec_36[(v)]; 
  1407.     MACRO0(v); }
  1409.   {
  1410.     register REAL *in = inbuf;
  1411.    
  1412.     in[17]+=in[16];in[16]+=in[15];in[15]+=in[14];in[14]+=in[13]; 
  1413.     in[13]+=in[12];in[12]+=in[11];in[11]+=in[10];in[10]+=in[ 9];
  1414.     in[ 9]+=in[ 8];in[ 8]+=in[ 7];in[ 7]+=in[ 6];in[ 6]+=in[ 5];
  1415.     in[ 5]+=in[ 4];in[ 4]+=in[ 3];in[ 3]+=in[ 2];in[ 2]+=in[ 1];
  1416.     in[ 1]+=in[ 0];
  1418.     in[17]+=in[15];in[15]+=in[13];in[13]+=in[11];in[11]+=in[ 9];
  1419.     in[ 9]+=in[ 7];in[7] +=in[ 5];in[ 5]+=in[ 3];in[ 3]+=in[ 1];
  1421.     {
  1422.       register REAL *c = cos_18;
  1423.       register REAL *out2 = prevblk2;
  1424.       register REAL *out1 = prevblk1;
  1425.       register REAL *ts = out;
  1426.       
  1427.       REAL ta33,ta66,tb33,tb66;
  1429.       ta33=in[2*3+0]*c[3];
  1430.       ta66=in[2*6+0]*c[6];
  1431.       tb33=in[2*3+1]*c[3];
  1432.       tb66=in[2*6+1]*c[6];
  1434.       { 
  1435. REAL tmp1a,tmp2a,tmp1b,tmp2b;
  1436. tmp1a=          in[2*1+0]*c[1]+ta33          +in[2*5+0]*c[5]+in[2*7+0]*c[7];
  1437. tmp1b=          in[2*1+1]*c[1]+tb33          +in[2*5+1]*c[5]+in[2*7+1]*c[7];
  1438. tmp2a=in[2*0+0]+in[2*2+0]*c[2]+in[2*4+0]*c[4]+ta66          +in[2*8+0]*c[8];
  1439. tmp2b=in[2*0+1]+in[2*2+1]*c[2]+in[2*4+1]*c[4]+tb66          +in[2*8+1]*c[8];
  1440. MACRO1(0);
  1441. MACRO2(8);
  1442.       }
  1444.       {
  1445. REAL tmp1a,tmp2a,tmp1b,tmp2b;
  1446. tmp1a=(in[2*1+0]-in[2*5+0]-in[2*7+0])*c[3];
  1447. tmp1b=(in[2*1+1]-in[2*5+1]-in[2*7+1])*c[3];
  1448. tmp2a=(in[2*2+0]-in[2*4+0]-in[2*8+0])*c[6]-in[2*6+0]+in[2*0+0];
  1449. tmp2b=(in[2*2+1]-in[2*4+1]-in[2*8+1])*c[6]-in[2*6+1]+in[2*0+1];
  1450. MACRO1(1);
  1451. MACRO2(7);
  1452.       }
  1454.       {
  1455. REAL tmp1a,tmp2a,tmp1b,tmp2b;
  1456. tmp1a=          in[2*1+0]*c[5]-ta33          -in[2*5+0]*c[7]+in[2*7+0]*c[1];
  1457. tmp1b=          in[2*1+1]*c[5]-tb33          -in[2*5+1]*c[7]+in[2*7+1]*c[1];
  1458. tmp2a=in[2*0+0]-in[2*2+0]*c[8]-in[2*4+0]*c[2]+ta66          +in[2*8+0]*c[4];
  1459. tmp2b=in[2*0+1]-in[2*2+1]*c[8]-in[2*4+1]*c[2]+tb66          +in[2*8+1]*c[4];
  1460. MACRO1(2);
  1461. MACRO2(6);
  1462.       }
  1464.       {
  1465. REAL tmp1a,tmp2a,tmp1b,tmp2b;
  1466. tmp1a=          in[2*1+0]*c[7]-ta33          +in[2*5+0]*c[1]-in[2*7+0]*c[5];
  1467. tmp1b=          in[2*1+1]*c[7]-tb33          +in[2*5+1]*c[1]-in[2*7+1]*c[5];
  1468. tmp2a=in[2*0+0]-in[2*2+0]*c[4]+in[2*4+0]*c[8]+ta66          -in[2*8+0]*c[2];
  1469. tmp2b=in[2*0+1]-in[2*2+1]*c[4]+in[2*4+1]*c[8]+tb66          -in[2*8+1]*c[2];
  1470. MACRO1(3);
  1471. MACRO2(5);
  1472.       }
  1474.       {
  1475.         REAL sum0,sum1;
  1476.      sum0= in[2*0+0]-in[2*2+0]+in[2*4+0]-in[2*6+0]+in[2*8+0];
  1477.      sum1=(in[2*0+1]-in[2*2+1]+in[2*4+1]-in[2*6+1]+in[2*8+1])*hsec_36[4];
  1478. MACRO0(4);
  1479.       }
  1480.     }
  1481.   }
  1482. }
  1485. static void dct12(REAL *in,REAL *prevblk1,REAL *prevblk2,register REAL *wi,register REAL *out)
  1486. {
  1487. #define DCT12_PART1   
  1488.         in5=in[5*3];  
  1489.   in5+=(in4=in[4*3]); 
  1490.   in4+=(in3=in[3*3]); 
  1491.   in3+=(in2=in[2*3]); 
  1492.   in2+=(in1=in[1*3]); 
  1493.   in1+=(in0=in[0*3]); 
  1494.                       
  1495.   in5+=in3;in3+=in1;  
  1496.                       
  1497.   in2*=cos1_6;        
  1498.   in3*=cos1_6;
  1500. #define DCT12_PART2         
  1501.   in0+=in4*cos2_6;          
  1502.                             
  1503.   in4=in0+in2;              
  1504.   in0-=in2;                 
  1505.                             
  1506.   in1+=in5*cos2_6;          
  1507.                             
  1508.   in5=(in1+in3)*hsec_12[0]; 
  1509.   in1=(in1-in3)*hsec_12[2]; 
  1510.                             
  1511.   in3=in4+in5;              
  1512.   in4-=in5;                 
  1513.                             
  1514.   in2=in0+in1;              
  1515.   in0-=in1;
  1517.   {
  1518.     REAL in0,in1,in2,in3,in4,in5;
  1519.     register REAL *pb1=prevblk1;
  1520.     out[SBLIMIT*0]=pb1[0];out[SBLIMIT*1]=pb1[1];out[SBLIMIT*2]=pb1[2];
  1521.     out[SBLIMIT*3]=pb1[3];out[SBLIMIT*4]=pb1[4];out[SBLIMIT*5]=pb1[5];
  1522.  
  1523.     DCT12_PART1;
  1524.     
  1525.     {
  1526.       REAL tmp0,tmp1=(in0-in4);
  1527.       {
  1528. register REAL tmp2=(in1-in5)*hsec_12[1];
  1529. tmp0=tmp1+tmp2;
  1530. tmp1-=tmp2;
  1531.       }
  1532.       out[(17-1)*SBLIMIT]=pb1[17-1]+tmp0*wi[11-1];
  1533.       out[(12+1)*SBLIMIT]=pb1[12+1]+tmp0*wi[ 6+1];
  1534.       out[(6 +1)*SBLIMIT]=pb1[6 +1]+tmp1*wi[ 1  ];
  1535.       out[(11-1)*SBLIMIT]=pb1[11-1]+tmp1*wi[ 5-1];
  1536.     }
  1538.     DCT12_PART2;
  1539.     out[(17-0)*SBLIMIT]=pb1[17-0]+in2*wi[11-0];
  1540.     out[(12+0)*SBLIMIT]=pb1[12+0]+in2*wi[ 6+0];
  1541.     out[(12+2)*SBLIMIT]=pb1[12+2]+in3*wi[ 6+2];
  1542.     out[(17-2)*SBLIMIT]=pb1[17-2]+in3*wi[11-2];
  1544.     out[( 6+0)*SBLIMIT]=pb1[ 6+0]+in0*wi[0];
  1545.     out[(11-0)*SBLIMIT]=pb1[11-0]+in0*wi[5-0];
  1546.     out[( 6+2)*SBLIMIT]=pb1[ 6+2]+in4*wi[2];
  1547.     out[(11-2)*SBLIMIT]=pb1[11-2]+in4*wi[5-2];
  1548.   }
  1550.   in++;
  1551.   {
  1552.     REAL in0,in1,in2,in3,in4,in5;
  1553.     register REAL *pb2 = prevblk2;
  1554.  
  1555.     DCT12_PART1;
  1557.     {
  1558.       REAL tmp0,tmp1=(in0-in4);
  1559.       {
  1560. REAL tmp2=(in1-in5)*hsec_12[1];
  1561. tmp0=tmp1+tmp2;
  1562. tmp1-=tmp2;
  1563.       }
  1564.       pb2[5-1]=tmp0*wi[11-1];
  1565.       pb2[0+1]=tmp0*wi[6+1];
  1566.       out[(12+1)*SBLIMIT]+=tmp1*wi[1];
  1567.       out[(17-1)*SBLIMIT]+=tmp1*wi[5-1];
  1568.     }
  1570.     DCT12_PART2;
  1572.     pb2[5-0]=in2*wi[11-0];
  1573.     pb2[0+0]=in2*wi[6+0];
  1574.     pb2[0+2]=in3*wi[6+2];
  1575.     pb2[5-2]=in3*wi[11-2];
  1577.     out[(12+0)*SBLIMIT]+=in0*wi[0];
  1578.     out[(17-0)*SBLIMIT]+=in0*wi[5-0];
  1579.     out[(12+2)*SBLIMIT]+=in4*wi[2];
  1580.     out[(17-2)*SBLIMIT]+=in4*wi[5-2];
  1581.   }
  1583.   in++; 
  1584.   {
  1585.     REAL in0,in1,in2,in3,in4,in5;
  1586.     register REAL *pb2 = prevblk2;
  1587.     pb2[12]=pb2[13]=pb2[14]=pb2[15]=pb2[16]=pb2[17]=0.0;
  1589.     DCT12_PART1;
  1591.     {
  1592.       REAL tmp0,tmp1=(in0-in4);
  1593.       {
  1594. REAL tmp2=(in1-in5)*hsec_12[1];
  1595. tmp0=tmp1+tmp2;
  1596. tmp1-=tmp2;
  1597.       }
  1598.       pb2[11-1]=tmp0*wi[11-1];
  1599.       pb2[ 6+1]=tmp0*wi[6+1];
  1600.       pb2[ 0+1]+=tmp1*wi[1];
  1601.       pb2[ 5-1]+=tmp1*wi[5-1];
  1602.     }
  1604.     DCT12_PART2;
  1605.     pb2[11-0]=in2*wi[11-0];
  1606.     pb2[ 6+0]=in2*wi[ 6+0];
  1607.     pb2[ 6+2]=in3*wi[ 6+2];
  1608.     pb2[11-2]=in3*wi[11-2];
  1610.     pb2[ 0+0]+=in0*wi[0  ];
  1611.     pb2[ 5-0]+=in0*wi[5-0];
  1612.     pb2[ 0+2]+=in4*wi[2  ];
  1613.     pb2[ 5-2]+=in4*wi[5-2];
  1614.   }
  1615. }
  1617. void MPEGaudio::layer3hybrid(int ch,int gr,REAL in[SBLIMIT][SSLIMIT],
  1618.                    REAL out[SSLIMIT][SBLIMIT])
  1619. {
  1620.   layer3grinfo *gi=&(sideinfo.ch[ch].gr[gr]);
  1621.   int bt1,bt2;
  1622.   REAL *prev1,*prev2;
  1624.   prev1=prevblck[ch][currentprevblock][0];
  1625.   prev2=prevblck[ch][currentprevblock^1][0];
  1627.   bt1 = gi->mixed_block_flag ? 0 : gi->block_type;
  1628.   bt2 = gi->block_type;
  1630.   {
  1631.     REAL *ci=(REAL *)in,
  1632.          *co=(REAL *)out;
  1633.     int  i;
  1635.     if(downfrequency)i=(SBLIMIT/2)-2;
  1636.     else i=SBLIMIT-2;
  1638.     if(bt2==2)
  1639.     {
  1640.       if(!bt1)
  1641.       {
  1642.   dct36(ci,prev1,prev2,win[0],co);
  1643. ci+=SSLIMIT;prev1+=SSLIMIT;prev2+=SSLIMIT;co++;
  1644.   dct36(ci,prev1,prev2,win[0],co);
  1645.       }
  1646.       else
  1647.       {
  1648. dct12(ci,prev1,prev2,win[2],co);
  1649. ci+=SSLIMIT;prev1+=SSLIMIT;prev2+=SSLIMIT;co++;
  1650. dct12(ci,prev1,prev2,win[2],co);
  1651.       }
  1653.       do{
  1654. ci+=SSLIMIT;prev1+=SSLIMIT;prev2+=SSLIMIT;co++;
  1655. dct12(ci,prev1,prev2,win[2],co);
  1656.       }while(--i);
  1657.     }
  1658.     else
  1659.     {
  1660.       dct36(ci,prev1,prev2,win[bt1],co);
  1661.       ci+=SSLIMIT;prev1+=SSLIMIT;prev2+=SSLIMIT;co++;
  1662.       dct36(ci,prev1,prev2,win[bt1],co);
  1664.       do
  1665.       {
  1666. ci+=SSLIMIT;prev1+=SSLIMIT;prev2+=SSLIMIT;co++;
  1667. dct36(ci,prev1,prev2,win[bt2],co);
  1668.       }while(--i);
  1669.     }
  1670.   }
  1671. }
  1673. #define NEG(a)  (a)=-(a)
  1675. void MPEGaudio::extractlayer3(void)
  1676. {
  1677.   if(version)
  1678.   {
  1679.     extractlayer3_2();
  1680.     return;
  1681.   }
  1683.   {
  1684.     int main_data_end,flush_main;
  1685.     int bytes_to_discard;
  1687.     layer3getsideinfo();
  1688.  
  1689.     if(issync())
  1690.     {
  1691.       for(register int i=layer3slots;i>0;i--)  // read main data.
  1692. bitwindow.putbyte(getbyte());
  1693.     }
  1694.     else
  1695.     {
  1696.       for(register int i=layer3slots;i>0;i--)  // read main data.
  1697. bitwindow.putbyte(getbits8());
  1698.     }
  1700.     main_data_end=bitwindow.gettotalbit()>>3;// of previous frame
  1701.     if (main_data_end < 0) // Fix from Michael Vogt
  1702.     {
  1703.       return;
  1704.     }
  1706.     if((flush_main=(bitwindow.gettotalbit() & 0x7)))
  1707.     {
  1708.       bitwindow.forward(8-flush_main);
  1709.       main_data_end++;
  1710.     }
  1712.     bytes_to_discard=layer3framestart-(main_data_end+sideinfo.main_data_begin);
  1713.     if(main_data_end>WINDOWSIZE)
  1714.     {
  1715.       layer3framestart-=WINDOWSIZE;
  1716.       bitwindow.rewind(WINDOWSIZE*8);
  1717.     }
  1718.   
  1719.     layer3framestart+=layer3slots;
  1720.   
  1721.     bitwindow.wrap();
  1723.     if(bytes_to_discard<0)return;
  1724.     bitwindow.forward(bytes_to_discard<<3);
  1725.   }
  1727.   for(int gr=0;gr<2;gr++)
  1728.   {
  1729.     union
  1730.     {
  1731.       int  is      [SBLIMIT][SSLIMIT];
  1732.       REAL hin  [2][SBLIMIT][SSLIMIT];
  1733.     }b1;
  1734.     union
  1735.     {
  1736.       REAL ro   [2][SBLIMIT][SSLIMIT];
  1737.       REAL lr   [2][SBLIMIT][SSLIMIT];
  1738.       REAL hout [2][SSLIMIT][SBLIMIT];
  1739.     }b2;
  1742.       layer3part2start=bitwindow.gettotalbit();
  1743.       layer3getscalefactors (LS,gr);
  1744.       layer3huffmandecode   (LS,gr      ,b1.is);
  1745.       layer3dequantizesample(LS,gr,b1.is,b2.ro[LS]);
  1746.     if(inputstereo)
  1747.     {
  1748.       layer3part2start=bitwindow.gettotalbit();
  1749.       layer3getscalefactors (RS,gr);
  1750.       layer3huffmandecode   (RS,gr      ,b1.is);
  1751.       layer3dequantizesample(RS,gr,b1.is,b2.ro[RS]);
  1752.     }
  1754.     layer3fixtostereo(gr,b2.ro);   // b2.ro -> b2.lr
  1755.     
  1756.     currentprevblock^=1;
  1757.       layer3reorderandantialias(LS,gr,b2.lr[LS],b1.hin[LS]);
  1758.       layer3hybrid (LS,gr,b1.hin[LS],b2.hout[LS]);
  1759.     if(outputstereo)
  1760.     {
  1761.       layer3reorderandantialias(RS,gr,b2.lr[RS],b1.hin[RS]);
  1762.       layer3hybrid (RS,gr,b1.hin[RS],b2.hout[RS]);
  1764.       register int i=2*SSLIMIT*SBLIMIT-1;
  1765.       do{
  1766. NEG(b2.hout[0][0][i   ]);NEG(b2.hout[0][0][i- 2]);
  1767. NEG(b2.hout[0][0][i- 4]);NEG(b2.hout[0][0][i- 6]);
  1768. NEG(b2.hout[0][0][i- 8]);NEG(b2.hout[0][0][i-10]);
  1769. NEG(b2.hout[0][0][i-12]);NEG(b2.hout[0][0][i-14]);
  1770. NEG(b2.hout[0][0][i-16]);NEG(b2.hout[0][0][i-18]);
  1771. NEG(b2.hout[0][0][i-20]);NEG(b2.hout[0][0][i-22]);
  1772. NEG(b2.hout[0][0][i-24]);NEG(b2.hout[0][0][i-26]);
  1773. NEG(b2.hout[0][0][i-28]);NEG(b2.hout[0][0][i-30]);
  1774.       }while((i-=2*SBLIMIT)>0);
  1775.     }
  1776.     else
  1777.     {
  1778.       register int i=SSLIMIT*SBLIMIT-1;
  1779.       do{
  1780. NEG(b2.hout[0][0][i   ]);NEG(b2.hout[0][0][i- 2]);
  1781. NEG(b2.hout[0][0][i- 4]);NEG(b2.hout[0][0][i- 6]);
  1782. NEG(b2.hout[0][0][i- 8]);NEG(b2.hout[0][0][i-10]);
  1783. NEG(b2.hout[0][0][i-12]);NEG(b2.hout[0][0][i-14]);
  1784. NEG(b2.hout[0][0][i-16]);NEG(b2.hout[0][0][i-18]);
  1785. NEG(b2.hout[0][0][i-20]);NEG(b2.hout[0][0][i-22]);
  1786. NEG(b2.hout[0][0][i-24]);NEG(b2.hout[0][0][i-26]);
  1787. NEG(b2.hout[0][0][i-28]);NEG(b2.hout[0][0][i-30]);
  1788.       }while((i-=2*SBLIMIT)>0);
  1789.     }
  1791.     for(int ss=0;ss<SSLIMIT;ss++)
  1792.       subbandsynthesis(b2.hout[LS][ss],b2.hout[RS][ss]);
  1793.   }
  1794. }
  1796. void MPEGaudio::extractlayer3_2(void)
  1797. {
  1798.   {
  1799.     int main_data_end,flush_main;
  1800.     int bytes_to_discard;
  1802.     layer3getsideinfo_2();
  1803.  
  1804.     if(issync())
  1805.     {
  1806.       for(register int i=layer3slots;i>0;i--)  // read main data.
  1807. bitwindow.putbyte(getbyte());
  1808.     }
  1809.     else
  1810.     {
  1811.       for(register int i=layer3slots;i>0;i--)  // read main data.
  1812. bitwindow.putbyte(getbits8());
  1813.     }
  1814.     bitwindow.wrap();
  1816.     main_data_end=bitwindow.gettotalbit()>>3;// of previous frame
  1818.     if((flush_main=(bitwindow.gettotalbit() & 0x7)))
  1819.     {
  1820.       bitwindow.forward(8-flush_main);
  1821.       main_data_end++;
  1822.     }
  1824.     bytes_to_discard=layer3framestart-main_data_end-sideinfo.main_data_begin;
  1825.     if(main_data_end>WINDOWSIZE)
  1826.     {
  1827.       layer3framestart-=WINDOWSIZE;
  1828.       bitwindow.rewind(WINDOWSIZE*8);
  1829.     }
  1830.   
  1831.     layer3framestart+=layer3slots;
  1832.   
  1833.     if(bytes_to_discard<0) return;
  1834.     bitwindow.forward(bytes_to_discard<<3);
  1835.   }
  1837.   //  for(int gr=0;gr<2;gr++)
  1838.   {
  1839.     union
  1840.     {
  1841.       int  is      [SBLIMIT][SSLIMIT];
  1842.       REAL hin  [2][SBLIMIT][SSLIMIT];
  1843.     }b1;
  1844.     union
  1845.     {
  1846.       REAL ro   [2][SBLIMIT][SSLIMIT];
  1847.       REAL lr   [2][SBLIMIT][SSLIMIT];
  1848.       REAL hout [2][SSLIMIT][SBLIMIT];
  1849.     }b2;
  1852.       layer3part2start=bitwindow.gettotalbit();
  1853.       layer3getscalefactors_2(LS);
  1854.       layer3huffmandecode    (LS,0      ,b1.is);
  1855.       layer3dequantizesample (LS,0,b1.is,b2.ro[LS]);
  1856.     if(inputstereo)
  1857.     {
  1858.       layer3part2start=bitwindow.gettotalbit();
  1859.       layer3getscalefactors_2(RS);
  1860.       layer3huffmandecode    (RS,0      ,b1.is);
  1861.       layer3dequantizesample (RS,0,b1.is,b2.ro[RS]);
  1862.     }
  1864.     layer3fixtostereo(0,b2.ro);          // b2.ro -> b2.lr
  1865.     
  1866.     currentprevblock^=1;
  1867.       layer3reorderandantialias(LS,0,b2.lr[LS],b1.hin[LS]);
  1868.       layer3hybrid (LS,0,b1.hin[LS],b2.hout[LS]);
  1869.     if(outputstereo)
  1870.     {
  1871.       layer3reorderandantialias(RS,0,b2.lr[RS],b1.hin[RS]);
  1872.       layer3hybrid (RS,0,b1.hin[RS],b2.hout[RS]);
  1874.       register int i=2*SSLIMIT*SBLIMIT-1;
  1875.       do{
  1876. NEG(b2.hout[0][0][i-16]);NEG(b2.hout[0][0][i-18]);
  1877. NEG(b2.hout[0][0][i-20]);NEG(b2.hout[0][0][i-22]);
  1878. NEG(b2.hout[0][0][i-24]);NEG(b2.hout[0][0][i-26]);
  1879. NEG(b2.hout[0][0][i-28]);NEG(b2.hout[0][0][i-30]);
  1880.       }while((i-=2*SBLIMIT)>0);
  1881.     }
  1882.     else
  1883.     {
  1884.       register int i=SSLIMIT*SBLIMIT-1;
  1885.       do{
  1886. NEG(b2.hout[0][0][i-16]);NEG(b2.hout[0][0][i-18]);
  1887. NEG(b2.hout[0][0][i-20]);NEG(b2.hout[0][0][i-22]);
  1888. NEG(b2.hout[0][0][i-24]);NEG(b2.hout[0][0][i-26]);
  1889. NEG(b2.hout[0][0][i-28]);NEG(b2.hout[0][0][i-30]);
  1890.       }while((i-=2*SBLIMIT)>0);
  1891.     }
  1893.     for(int ss=0;ss<SSLIMIT;ss++)
  1894.       subbandsynthesis(b2.hout[LS][ss],b2.hout[RS][ss]);
  1895.   }
  1896. }