layer2.c
上传用户:yisoukefu
上传日期:2020-08-09
资源大小:39506k
文件大小:10k
源码类别:

其他游戏

开发平台:

Visual C++

  1. /*
  2.  * Modified for use with MPlayer, for details see the changelog at
  3.  * http://svn.mplayerhq.hu/mplayer/trunk/
  4.  * $Id: layer2.c 23484 2007-06-06 05:13:13Z zuxy $
  5.  */
  6. /* 
  7.  * Mpeg Layer-2 audio decoder 
  8.  * --------------------------
  9.  * copyright (c) 1995 by Michael Hipp, All rights reserved. See also 'README'
  10.  *
  11.  */
  12. #include "l2tables.h"
  13. static int grp_3tab[32 * 3] = { 0, };   /* used: 27 */
  14. static int grp_5tab[128 * 3] = { 0, };  /* used: 125 */
  15. static int grp_9tab[1024 * 3] = { 0, }; /* used: 729 */
  16. static real muls[27][64]; /* also used by layer 1 */
  17. static void init_layer2(void)
  18. {
  19.   static double mulmul[27] = {
  20.     0.0 , -2.0/3.0 , 2.0/3.0 ,
  21.     2.0/7.0 , 2.0/15.0 , 2.0/31.0, 2.0/63.0 , 2.0/127.0 , 2.0/255.0 ,
  22.     2.0/511.0 , 2.0/1023.0 , 2.0/2047.0 , 2.0/4095.0 , 2.0/8191.0 ,
  23.     2.0/16383.0 , 2.0/32767.0 , 2.0/65535.0 ,
  24.     -4.0/5.0 , -2.0/5.0 , 2.0/5.0, 4.0/5.0 ,
  25.     -8.0/9.0 , -4.0/9.0 , -2.0/9.0 , 2.0/9.0 , 4.0/9.0 , 8.0/9.0 };
  26.   static int base[3][9] = {
  27.      { 1 , 0, 2 , } ,
  28.      { 17, 18, 0 , 19, 20 , } ,
  29.      { 21, 1, 22, 23, 0, 24, 25, 2, 26 } };
  30.   int i,j,k,l,len;
  31.   real *table;
  32.   static int tablen[3] = { 3 , 5 , 9 };
  33.   static int *itable,*tables[3] = { grp_3tab , grp_5tab , grp_9tab };
  34.   for(i=0;i<3;i++)
  35.   {
  36.     itable = tables[i];
  37.     len = tablen[i];
  38.     for(j=0;j<len;j++)
  39.       for(k=0;k<len;k++)
  40.         for(l=0;l<len;l++)
  41.         {
  42.           *itable++ = base[i][l];
  43.           *itable++ = base[i][k];
  44.           *itable++ = base[i][j];
  45.         }
  46.   }
  47.   for(k=0;k<27;k++)
  48.   {
  49.     double m=mulmul[k];
  50.     table = muls[k];
  51.     if(_has_mmx) 
  52.     {
  53.         for(j=3,i=0;i<63;i++,j--)
  54.   *table++ = 16384 * m * pow(2.0,(double) j / 3.0);
  55.     }
  56.     else
  57.     for(j=3,i=0;i<63;i++,j--)
  58.     {
  59.       *table++ = m * pow(2.0,(double) j / 3.0);
  60.     }
  61.     *table++ = 0.0;
  62.   }
  63. }
  64. static void II_step_one(unsigned int *bit_alloc,int *scale,struct frame *fr)
  65. {
  66.     int stereo = fr->stereo-1;
  67.     int sblimit = fr->II_sblimit;
  68.     int jsbound = fr->jsbound;
  69.     int sblimit2 = fr->II_sblimit<<stereo;
  70.     struct al_table *alloc1 = fr->alloc;
  71.     int i;
  72.     static unsigned int scfsi_buf[64];
  73.     unsigned int *scfsi,*bita;
  74.     int sc,step;
  75.     bita = bit_alloc;
  76.     if(stereo)
  77.     {
  78.       for (i=jsbound;i>0;i--,alloc1+=(1<<step))
  79.       {
  80.         *bita++ = (char) getbits(step=alloc1->bits);
  81.         *bita++ = (char) getbits(step);
  82.       }
  83.       for (i=sblimit-jsbound;i>0;i--,alloc1+=(1<<step))
  84.       {
  85.         bita[0] = (char) getbits(step=alloc1->bits);
  86.         bita[1] = bita[0];
  87.         bita+=2;
  88.       }
  89.       bita = bit_alloc;
  90.       scfsi=scfsi_buf;
  91.       for (i=sblimit2;i>0;i--)
  92.         if (*bita++)
  93.           *scfsi++ = (char) getbits_fast(2);
  94.     }
  95.     else /* mono */
  96.     {
  97.       for (i=sblimit;i>0;i--,alloc1+=(1<<step))
  98.         *bita++ = (char) getbits(step=alloc1->bits);
  99.       bita = bit_alloc;
  100.       scfsi=scfsi_buf;
  101.       for (i=sblimit;i>0;i--)
  102.         if (*bita++)
  103.           *scfsi++ = (char) getbits_fast(2);
  104.     }
  105.     bita = bit_alloc;
  106.     scfsi=scfsi_buf;
  107.     for (i=sblimit2;i>0;i--) 
  108.       if (*bita++)
  109.         switch (*scfsi++) 
  110.         {
  111.           case 0: 
  112.                 *scale++ = getbits_fast(6);
  113.                 *scale++ = getbits_fast(6);
  114.                 *scale++ = getbits_fast(6);
  115.                 break;
  116.           case 1 : 
  117.                 *scale++ = sc = getbits_fast(6);
  118.                 *scale++ = sc;
  119.                 *scale++ = getbits_fast(6);
  120.                 break;
  121.           case 2: 
  122.                 *scale++ = sc = getbits_fast(6);
  123.                 *scale++ = sc;
  124.                 *scale++ = sc;
  125.                 break;
  126.           default:              /* case 3 */
  127.                 *scale++ = getbits_fast(6);
  128.                 *scale++ = sc = getbits_fast(6);
  129.                 *scale++ = sc;
  130.                 break;
  131.         }
  132. }
  133. static void II_step_two(unsigned int *bit_alloc,real fraction[2][4][SBLIMIT],int *scale,struct frame *fr,int x1)
  134. {
  135.     int i,j,k,ba;
  136.     int stereo = fr->stereo;
  137.     int sblimit = fr->II_sblimit;
  138.     int jsbound = fr->jsbound;
  139.     struct al_table *alloc2,*alloc1 = fr->alloc;
  140.     unsigned int *bita=bit_alloc;
  141.     int d1,step;
  142.     for (i=0;i<jsbound;i++,alloc1+=(1<<step))
  143.     {
  144.       step = alloc1->bits;
  145.       for (j=0;j<stereo;j++)
  146.       {
  147.         if ( (ba=*bita++) ) 
  148.         {
  149.           k=(alloc2 = alloc1+ba)->bits;
  150.           if( (d1=alloc2->d) < 0) 
  151.           {
  152.             real cm=muls[k][scale[x1]];
  153.             fraction[j][0][i] = ((real) ((int)getbits(k) + d1)) * cm;
  154.             fraction[j][1][i] = ((real) ((int)getbits(k) + d1)) * cm;
  155.             fraction[j][2][i] = ((real) ((int)getbits(k) + d1)) * cm;
  156.           }        
  157.           else 
  158.           {
  159.             static int *table[] = { 0,0,0,grp_3tab,0,grp_5tab,0,0,0,grp_9tab };
  160.             unsigned int idx,*tab,m=scale[x1];
  161.             idx = (unsigned int) getbits(k);
  162.             tab = (unsigned int *) (table[d1] + idx + idx + idx);
  163.             fraction[j][0][i] = muls[*tab++][m];
  164.             fraction[j][1][i] = muls[*tab++][m];
  165.             fraction[j][2][i] = muls[*tab][m];  
  166.           }
  167.           scale+=3;
  168.         }
  169.         else
  170.           fraction[j][0][i] = fraction[j][1][i] = fraction[j][2][i] = 0.0;
  171.       }
  172.     }
  173.     for (i=jsbound;i<sblimit;i++,alloc1+=(1<<step))
  174.     {
  175.       step = alloc1->bits;
  176.       bita++; /* channel 1 and channel 2 bitalloc are the same */
  177.       if ( (ba=*bita++) )
  178.       {
  179.         k=(alloc2 = alloc1+ba)->bits;
  180.         if( (d1=alloc2->d) < 0)
  181.         {
  182.           real cm;
  183.           cm=muls[k][scale[x1+3]];
  184.           fraction[1][0][i] = (fraction[0][0][i] = (real) ((int)getbits(k) + d1) ) * cm;
  185.           fraction[1][1][i] = (fraction[0][1][i] = (real) ((int)getbits(k) + d1) ) * cm;
  186.           fraction[1][2][i] = (fraction[0][2][i] = (real) ((int)getbits(k) + d1) ) * cm;
  187.           cm=muls[k][scale[x1]];
  188.           fraction[0][0][i] *= cm; fraction[0][1][i] *= cm; fraction[0][2][i] *= cm;
  189.         }
  190.         else
  191.         {
  192.           static int *table[] = { 0,0,0,grp_3tab,0,grp_5tab,0,0,0,grp_9tab };
  193.           unsigned int idx,*tab,m1,m2;
  194.           m1 = scale[x1]; m2 = scale[x1+3];
  195.           idx = (unsigned int) getbits(k);
  196.           tab = (unsigned int *) (table[d1] + idx + idx + idx);
  197.           fraction[0][0][i] = muls[*tab][m1]; fraction[1][0][i] = muls[*tab++][m2];
  198.           fraction[0][1][i] = muls[*tab][m1]; fraction[1][1][i] = muls[*tab++][m2];
  199.           fraction[0][2][i] = muls[*tab][m1]; fraction[1][2][i] = muls[*tab][m2];
  200.         }
  201.         scale+=6;
  202.       }
  203.       else {
  204.         fraction[0][0][i] = fraction[0][1][i] = fraction[0][2][i] =
  205.         fraction[1][0][i] = fraction[1][1][i] = fraction[1][2][i] = 0.0;
  206.       }
  207. /* 
  208.    should we use individual scalefac for channel 2 or
  209.    is the current way the right one , where we just copy channel 1 to
  210.    channel 2 ?? 
  211.    The current 'strange' thing is, that we throw away the scalefac
  212.    values for the second channel ...!!
  213. -> changed .. now we use the scalefac values of channel one !! 
  214. */
  215.     }
  216.     if(sblimit > (fr->down_sample_sblimit) )
  217.       sblimit = fr->down_sample_sblimit;
  218.     for(i=sblimit;i<SBLIMIT;i++)
  219.       for (j=0;j<stereo;j++)
  220.         fraction[j][0][i] = fraction[j][1][i] = fraction[j][2][i] = 0.0;
  221. }
  222. static void II_select_table(struct frame *fr)
  223. {
  224.   static int translate[9][2][16] =
  225.    { { { 0,2,2,2,2,2,2,0,0,0,1,1,1,1,1,0 } ,   /*44.1 stereo*/
  226.        { 0,2,2,0,0,0,1,1,1,1,1,1,1,1,1,0 } } , /*44.1 mono*/
  227.      { { 0,2,2,2,2,2,2,0,0,0,0,0,0,0,0,0 } ,   /*48 stereo*/
  228.        { 0,2,2,0,0,0,0,0,0,0,0,0,0,0,0,0 } } , /*48 mono*/
  229.      { { 0,3,3,3,3,3,3,0,0,0,1,1,1,1,1,0 } ,   /*32 stereo*/
  230.        { 0,3,3,0,0,0,1,1,1,1,1,1,1,1,1,0 } } , /*32 mono*/
  231.      { { 2,2,2,2,2,2,2,3,3,3,3,3,3,3,3,0 } ,   /*22.05 stereo*/
  232.        { 2,2,2,3,3,3,3,3,3,3,3,3,3,3,3,0 } } , /*22.05 mono*/
  233.      { { 2,2,2,2,2,2,2,3,3,3,3,3,3,3,3,0 } ,   /*24 stereo*/
  234.        { 2,2,2,3,3,3,3,3,3,3,3,3,3,3,3,0 } } , /*24 mono*/
  235.      { { 2,2,2,2,2,2,2,3,3,3,3,3,3,3,3,0 } ,   /*16 stereo*/
  236.        { 2,2,2,3,3,3,3,3,3,3,3,3,3,3,3,0 } } , /*16 mono*/
  237.      { { 2,2,2,2,2,2,2,3,3,3,3,3,3,3,3,0 } ,   /*11.025 stereo*/
  238.        { 2,2,2,3,3,3,3,3,3,3,3,3,3,3,3,0 } } , /*11.025 mono*/
  239.      { { 2,2,2,2,2,2,2,3,3,3,3,3,3,3,3,0 } ,   /*12 stereo*/
  240.        { 2,2,2,3,3,3,3,3,3,3,3,3,3,3,3,0 } } , /*12 mono*/
  241.      { { 2,2,2,2,2,2,2,3,3,3,3,3,3,3,3,0 } ,   /*8 stereo*/
  242.        { 2,2,2,3,3,3,3,3,3,3,3,3,3,3,3,0 } }   /*8 mono*/
  243. /*       0  48  64  96 128 192 256 384 */
  244. /*        32  56  80 112 160 224 320  XX*/
  245.        };
  246.   int table,sblim;
  247.   static struct al_table *tables[5] =
  248.        { alloc_0, alloc_1, alloc_2, alloc_3 , alloc_4 };
  249.   static int sblims[5] = { 27 , 30 , 8, 12 , 30 };
  250.   if(fr->lsf)
  251.     table = 4;
  252.   else
  253.     table = translate[fr->sampling_frequency][2-fr->stereo][fr->bitrate_index];
  254.   sblim = sblims[table];
  255.   fr->alloc      = tables[table];
  256.   fr->II_sblimit = sblim;
  257. }
  258. static int do_layer2(struct frame *fr,int outmode)
  259. {
  260.   int clip=0;
  261.   int i,j;
  262.   int stereo = fr->stereo;
  263.   DECLARE_ALIGNED(16, real, fraction[2][4][SBLIMIT]); /* pick_table clears unused subbands */
  264.   unsigned int bit_alloc[64];
  265.   int scale[192];
  266.   int single = fr->single;
  267.   II_select_table(fr);
  268.   fr->jsbound = (fr->mode == MPG_MD_JOINT_STEREO) ?
  269.      (fr->mode_ext<<2)+4 : fr->II_sblimit;
  270.   if(stereo == 1 || single == 3)
  271.     single = 0;
  272.   II_step_one(bit_alloc, scale, fr);
  273.   for (i=0;i<SCALE_BLOCK;i++) 
  274.   {
  275.     II_step_two(bit_alloc,fraction,scale,fr,i>>2);
  276.     for (j=0;j<3;j++) 
  277.     {
  278.       if(single >= 0)
  279.       {
  280.         clip += (fr->synth_mono) (fraction[single][j],pcm_sample,&pcm_point);
  281.       }
  282.       else {
  283.           int p1 = pcm_point;
  284.           clip += (fr->synth) (fraction[0][j],0,pcm_sample,&p1);
  285.           clip += (fr->synth) (fraction[1][j],1,pcm_sample,&pcm_point);
  286.       }
  287. //      if(pcm_point >= audiobufsize) audio_flush(outmode,ai);
  288.     }
  289.   }
  290.   return clip;
  291. }