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

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

流媒体/Mpeg4/MP4

开发平台：

Visual C++

MP3Internals.cpp：源码内容
  1. /**********
  2. This library is free software; you can redistribute it and/or modify it under
  3. the terms of the GNU Lesser General Public License as published by the
  4. Free Software Foundation; either version 2.1 of the License, or (at your
  5. option) any later version. (See <http://www.gnu.org/copyleft/lesser.html>.)
  7. This library is distributed in the hope that it will be useful, but WITHOUT
  8. ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
  9. FOR A PARTICULAR PURPOSE.  See the GNU Lesser General Public License for
  10. more details.
  12. You should have received a copy of the GNU Lesser General Public License
  13. along with this library; if not, write to the Free Software Foundation, Inc.,
  14. 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  15. **********/
  16. // "liveMedia"
  17. // Copyright (c) 1996-2001 Live Networks, Inc.  All rights reserved.
  18. // MP3 internal implementation details
  19. // Implementation
  22. #include <stdlib.h>
  23. #include <math.h>
  24. #include <stdio.h>
  25. #include <string.h>
  26. #include "MP3Internals.hh"
  28. // This is crufty old code that needs to be cleaned up #####
  30. unsigned tabsel_123[2][3][16] = {
  31.    { {32,32,64,96,128,160,192,224,256,288,320,352,384,416,448,448},
  32.      {32,32,48,56, 64, 80, 96,112,128,160,192,224,256,320,384,384},
  33.      {32,32,40,48, 56, 64, 80, 96,112,128,160,192,224,256,320,320} },
  35.    { {32,32,48,56,64,80,96,112,128,144,160,176,192,224,256,256},
  36.      {8,8,16,24,32,40,48,56,64,80,96,112,128,144,160,160},
  37.      {8,8,16,24,32,40,48,56,64,80,96,112,128,144,160,160} }
  38. };
  39. /* Note: tabsel_123[*][*][0 or 15] shouldn't occur; use dummy values there */
  41. long freqs[7] = { 44100, 48000, 32000, 22050, 24000, 16000 , 11025 };
  43. static float ispow[8207];
  44. static float aa_ca[8], aa_cs[8];
  45. static float COS1[12][6];
  46. static float win[4][36];
  47. static float win1[4][36];
  48. static float COS9[9];
  49. static float COS6_1,COS6_2;
  50. static float tfcos36[9];
  51. static float tfcos12[3];
  53. int longLimit[7][23];
  54. int shortLimit[7][14];
  55. struct bandInfoStruct {
  56.   int longIdx[23];
  57.   int longDiff[22];
  58.   int shortIdx[14];
  59.   int shortDiff[13];
  60. };
  62. struct bandInfoStruct bandInfo[7] = { 
  63. /* MPEG 1.0 */
  64.  { {0,4,8,12,16,20,24,30,36,44,52,62,74, 90,110,134,162,196,238,288,342,418,576},
  65.    {4,4,4,4,4,4,6,6,8, 8,10,12,16,20,24,28,34,42,50,54, 76,158},
  66.    {0,4*3,8*3,12*3,16*3,22*3,30*3,40*3,52*3,66*3, 84*3,106*3,136*3,192*3},
  67.    {4,4,4,4,6,8,10,12,14,18,22,30,56} } ,
  69.  { {0,4,8,12,16,20,24,30,36,42,50,60,72, 88,106,128,156,190,230,276,330,384,576},
  70.    {4,4,4,4,4,4,6,6,6, 8,10,12,16,18,22,28,34,40,46,54, 54,192},
  71.    {0,4*3,8*3,12*3,16*3,22*3,28*3,38*3,50*3,64*3, 80*3,100*3,126*3,192*3},
  72.    {4,4,4,4,6,6,10,12,14,16,20,26,66} } ,
  74.  { {0,4,8,12,16,20,24,30,36,44,54,66,82,102,126,156,194,240,296,364,448,550,576} ,
  75.    {4,4,4,4,4,4,6,6,8,10,12,16,20,24,30,38,46,56,68,84,102, 26} ,
  76.    {0,4*3,8*3,12*3,16*3,22*3,30*3,42*3,58*3,78*3,104*3,138*3,180*3,192*3} ,
  77.    {4,4,4,4,6,8,12,16,20,26,34,42,12} }  ,
  79. /* MPEG 2.0 */
  80.  { {0,6,12,18,24,30,36,44,54,66,80,96,116,140,168,200,238,284,336,396,464,522,576},
  81.    {6,6,6,6,6,6,8,10,12,14,16,20,24,28,32,38,46,52,60,68,58,54 } ,
  82.    {0,4*3,8*3,12*3,18*3,24*3,32*3,42*3,56*3,74*3,100*3,132*3,174*3,192*3} ,
  83.    {4,4,4,6,6,8,10,14,18,26,32,42,18 } } ,
  85.  { {0,6,12,18,24,30,36,44,54,66,80,96,114,136,162,194,232,278,330,394,464,540,576},
  86.    {6,6,6,6,6,6,8,10,12,14,16,18,22,26,32,38,46,52,64,70,76,36 } ,
  87.    {0,4*3,8*3,12*3,18*3,26*3,36*3,48*3,62*3,80*3,104*3,136*3,180*3,192*3} ,
  88.    {4,4,4,6,8,10,12,14,18,24,32,44,12 } } ,
  90.  { {0,6,12,18,24,30,36,44,54,66,80,96,116,140,168,200,238,284,336,396,464,522,576},
  91.    {6,6,6,6,6,6,8,10,12,14,16,20,24,28,32,38,46,52,60,68,58,54 },
  92.    {0,4*3,8*3,12*3,18*3,26*3,36*3,48*3,62*3,80*3,104*3,134*3,174*3,192*3},
  93.    {4,4,4,6,8,10,12,14,18,24,30,40,18 } } ,
  95. /* MPEG 2.5, wrong! table (it's just a copy of MPEG 2.0/44.1kHz) */
  96.  { {0,6,12,18,24,30,36,44,54,66,80,96,116,140,168,200,238,284,336,396,464,522,576},
  97.    {6,6,6,6,6,6,8,10,12,14,16,20,24,28,32,38,46,52,60,68,58,54 } ,
  98.    {0,4*3,8*3,12*3,18*3,24*3,32*3,42*3,56*3,74*3,100*3,132*3,174*3,192*3} ,
  99.    {4,4,4,6,6,8,10,14,18,26,32,42,18 } } ,
  100. };
  102. static int mapbuf0[7][152];
  103. static int mapbuf1[7][156];
  104. static int mapbuf2[7][44];
  105. static int *map[7][3];
  106. static int *mapend[7][3];
  108. unsigned int n_slen2[512]; /* MPEG 2.0 slen for 'normal' mode */
  109. unsigned int i_slen2[256]; /* MPEG 2.0 slen for intensity stereo */
  111. static float tan1_1[16],tan2_1[16],tan1_2[16],tan2_2[16];
  112. static float pow1_1[2][16],pow2_1[2][16],pow1_2[2][16],pow2_2[2][16];
  114. // Init tables for layer-3 
  115. static float gainpow2[256+118+4];
  117. #define MPG_MD_MONO 3 
  119. #ifndef M_PI
  120. #define  M_PI            3.14159265358979323846  /* pi */
  121. #endif
  122. #ifndef M_SQRT2
  123. #define  M_SQRT2         1.41421356237309504880  /* sqrt(2) */
  124. #endif
  126. ////////// MP3FrameParams //////////
  128. MP3FrameParams::MP3FrameParams()
  129.   : bv(frameBytes, 0, sizeof frameBytes) /* by default */ {
  130.   oldHdr = firstHdr = 0;
  132.   static Boolean doneInit = False;
  133.   if (doneInit) return;
  134.   doneInit = True;
  136.   int i,j,k,l;
  138.   for (i=-256;i<118+4;i++) {
  139.     gainpow2[i+256] = pow((double)2.0,-0.25 * (double) (i+210) );
  140.   }
  142.   for (i=0;i<8207;i++) {
  143.     ispow[i] = pow((double)i,(double)4.0/3.0);
  144.   }
  146.   for (i=0;i<8;i++) {
  147.     static double Ci[8]={-0.6,-0.535,-0.33,-0.185,-0.095,-0.041,-0.0142,-0.0037};
  148.     double sq=sqrt(1.0+Ci[i]*Ci[i]);
  149.     aa_cs[i] = 1.0/sq;
  150.     aa_ca[i] = Ci[i]/sq;
  151.   }
  153.   for (i=0;i<18;i++) {
  154.     win[0][i]    = win[1][i]    = 0.5 * sin( M_PI / 72.0 * (double) (2*(i+0) +1) ) / cos ( M_PI * (double) (2*(i+0) +19) / 72.0 );
  155.     win[0][i+18] = win[3][i+18] = 0.5 * sin( M_PI / 72.0 * (double) (2*(i+18)+1) ) / cos ( M_PI * (double) (2*(i+18)+19) / 72.0 );
  156.   }
  157.   for (i=0;i<6;i++) {
  158.     win[1][i+18] = 0.5 / cos ( M_PI * (double) (2*(i+18)+19) / 72.0 );
  159.     win[3][i+12] = 0.5 / cos ( M_PI * (double) (2*(i+12)+19) / 72.0 );
  160.     win[1][i+24] = 0.5 * sin( M_PI / 24.0 * (double) (2*i+13) ) / cos ( M_PI * (double) (2*(i+24)+19) / 72.0 );
  161.     win[1][i+30] = win[3][i] = 0.0;
  162.     win[3][i+6 ] = 0.5 * sin( M_PI / 24.0 * (double) (2*i+1) )  / cos ( M_PI * (double) (2*(i+6 )+19) / 72.0 );
  163.   }
  165.   for (i=0;i<9;i++) {
  166.     COS9[i] = cos( M_PI / 18.0 * (double) i);
  167.   }
  169.   for (i=0;i<9;i++) {
  170.     tfcos36[i] = 0.5 / cos ( M_PI * (double) (i*2+1) / 36.0 );
  171.   }
  172.   for(i=0;i<3;i++) {
  173.     tfcos12[i] = 0.5 / cos ( M_PI * (double) (i*2+1) / 12.0 );
  174.   }
  176.   COS6_1 = cos( M_PI / 6.0 * (double) 1);
  177.   COS6_2 = cos( M_PI / 6.0 * (double) 2);
  179.   for (i=0;i<12;i++) {
  180.     win[2][i]  = 0.5 * sin( M_PI / 24.0 * (double) (2*i+1) ) / cos ( M_PI * (double) (2*i+7) / 24.0 );
  181.     for (j=0;j<6;j++) {
  182.       COS1[i][j] = cos( M_PI / 24.0 * (double) ((2*i+7)*(2*j+1)) );
  183.     }
  184.   }
  186.   for (j=0;j<4;j++) {
  187.     static int len[4] = { 36,36,12,36 };
  188.     for (i=0;i<len[j];i+=2) {
  189.       win1[j][i] = + win[j][i];
  190.     }
  191.     for (i=1;i<len[j];i+=2) {
  192.       win1[j][i] = - win[j][i];
  193.     }
  194.   }
  196.   for (i=0;i<16;i++) {
  197.     double t = tan( (double) i * M_PI / 12.0 );
  198.     tan1_1[i] = t / (1.0+t);
  199.     tan2_1[i] = 1.0 / (1.0 + t);
  200.     tan1_2[i] = M_SQRT2 * t / (1.0+t);
  201.     tan2_2[i] = M_SQRT2 / (1.0 + t);
  203.     for (j=0;j<2;j++) {
  204.       double base = pow(2.0,-0.25*(j+1.0));
  205.       double p1=1.0,p2=1.0;
  206.       if (i > 0) {
  207.         if (i & 1) {
  208.           p1 = pow(base,(i+1.0)*0.5);
  209. } else {
  210.           p2 = pow(base,i*0.5);
  211. }
  212.       }
  213.       pow1_1[j][i] = p1;
  214.       pow2_1[j][i] = p2;
  215.       pow1_2[j][i] = M_SQRT2 * p1;
  216.       pow2_2[j][i] = M_SQRT2 * p2;
  217.     }
  218.   }
  220.   for (j=0;j<7;j++) {
  221.     struct bandInfoStruct *bi = &bandInfo[j];
  222.     int *mp;
  223.     int cb,lwin;
  224.     int *bdf;
  225.     
  226.     mp = map[j][0] = mapbuf0[j];
  227.     bdf = bi->longDiff;
  228.     for (i=0,cb = 0; cb < 8 ; cb++,i+=*bdf++) {
  229.       *mp++ = (*bdf) >> 1;
  230.       *mp++ = i;
  231.       *mp++ = 3;
  232.       *mp++ = cb;
  233.     }
  234.     bdf = bi->shortDiff+3;
  235.     for (cb=3;cb<13;cb++) {
  236.       int l = (*bdf++) >> 1;
  237.       for(lwin=0;lwin<3;lwin++) {
  238. *mp++ = l;
  239. *mp++ = i + lwin;
  240. *mp++ = lwin;
  241. *mp++ = cb;
  242.       }
  243.       i += 6*l;
  244.     }
  245.     mapend[j][0] = mp;
  246.     
  247.     mp = map[j][1] = mapbuf1[j];
  248.     bdf = bi->shortDiff+0;
  249.     for (i=0,cb=0;cb<13;cb++) {
  250.       int l = (*bdf++) >> 1;
  251.       for (lwin=0;lwin<3;lwin++) {
  252. *mp++ = l;
  253. *mp++ = i + lwin;
  254. *mp++ = lwin;
  255. *mp++ = cb;
  256.       }
  257.       i += 6*l;
  258.     }
  259.     mapend[j][1] = mp;
  260.     
  261.     mp = map[j][2] = mapbuf2[j];
  262.     bdf = bi->longDiff;
  263.     for (cb = 0; cb < 22 ; cb++) {
  264.       *mp++ = (*bdf++) >> 1;
  265.       *mp++ = cb;
  266.     }
  267.     mapend[j][2] = mp;
  268.   }
  270.   for (j=0;j<7;j++) {
  271.     for (i=0;i<23;i++) {
  272.       longLimit[j][i] = (bandInfo[j].longIdx[i] - 1 + 8) / 18 + 1;
  273.       if (longLimit[j][i] > SBLIMIT) {
  274.         longLimit[j][i] = SBLIMIT;
  275.       }
  276.     }
  277.     for (i=0;i<14;i++) {
  278.       shortLimit[j][i] = (bandInfo[j].shortIdx[i] - 1) / 18 + 1;
  279.       if (shortLimit[j][i] > SBLIMIT) {
  280.         shortLimit[j][i] = SBLIMIT;
  281.       }
  282.     }
  283.   }
  285.   for (i=0;i<5;i++) {
  286.     for (j=0;j<6;j++) {
  287.       for (k=0;k<6;k++) {
  288.         int n = k + j * 6 + i * 36;
  289.         i_slen2[n] = i|(j<<3)|(k<<6)|(3<<12);
  290.       }
  291.     }
  292.   }
  293.   for (i=0;i<4;i++) {
  294.     for (j=0;j<4;j++) {
  295.       for (k=0;k<4;k++) {
  296.         int n = k + j * 4 + i * 16;
  297.         i_slen2[n+180] = i|(j<<3)|(k<<6)|(4<<12);
  298.       }
  299.     }
  300.   }
  301.   for (i=0;i<4;i++) {
  302.     for (j=0;j<3;j++) {
  303.       int n = j + i * 3;
  304.       i_slen2[n+244] = i|(j<<3) | (5<<12);
  305.       n_slen2[n+500] = i|(j<<3) | (2<<12) | (1<<15);
  306.     }
  307.   }
  309.   for (i=0;i<5;i++) {
  310.     for (j=0;j<5;j++) {
  311.       for (k=0;k<4;k++) {
  312.         for (l=0;l<4;l++) {
  313.           int n = l + k * 4 + j * 16 + i * 80;
  314.           n_slen2[n] = i|(j<<3)|(k<<6)|(l<<9)|(0<<12);
  315.         }
  316.       }
  317.     }
  318.   }
  319.   for (i=0;i<5;i++) {
  320.     for (j=0;j<5;j++) {
  321.       for (k=0;k<4;k++) {
  322.         int n = k + j * 4 + i * 20;
  323.         n_slen2[n+400] = i|(j<<3)|(k<<6)|(1<<12);
  324.       }
  325.     }
  326.   }
  327. }
  329. MP3FrameParams::~MP3FrameParams() {
  330. }
  332. void MP3FrameParams::setParamsFromHeader() {
  333.   if (hdr & (1<<20)) {
  334.     isMPEG2 = (hdr & (1<<19)) ? 0x0 : 0x1;
  335.     isMPEG2_5 = 0;
  336.   }
  337.   else {
  338.     isMPEG2 = 1;
  339.     isMPEG2_5 = 1;
  340.   }
  341.   
  342.   layer = 4-((hdr>>17)&3);
  343.   if (layer == 4) layer = 3; // layer==4 is not allowed
  344.   bitrateIndex = ((hdr>>12)&0xf);
  345.   
  346.   if (isMPEG2_5) {
  347.     samplingFreqIndex = 6;
  348.   } else {
  349.     samplingFreqIndex = ((hdr>>10)&0x3) + (isMPEG2*3);
  350.   }
  351.   
  352.   hasCRC = ((hdr>>16)&0x1)^0x1;
  353.   
  354.   padding   = ((hdr>>9)&0x1);
  355.   extension = ((hdr>>8)&0x1);
  356.   mode      = ((hdr>>6)&0x3);
  357.   mode_ext  = ((hdr>>4)&0x3);
  358.   copyright = ((hdr>>3)&0x1);
  359.   original  = ((hdr>>2)&0x1);
  360.   emphasis  = hdr & 0x3;
  361.   
  362.   stereo    = (mode == MPG_MD_MONO) ? 1 : 2;
  363.   
  364.   if (((hdr>>10)&0x3) == 0x3) {
  365. #ifdef DEBUG_ERRORS
  366.     fprintf(stderr,"Stream error - hdr: 0x%08xn", hdr);
  367. #endif
  368.   }
  370.   bitrate = tabsel_123[isMPEG2][layer-1][bitrateIndex];
  371.   samplingFreq = freqs[samplingFreqIndex];
  372.   isStereo = (stereo > 1);
  373.   isFreeFormat = (bitrateIndex == 0);
  374.   frameSize
  375.     = ComputeFrameSize(bitrate, samplingFreq, padding, isMPEG2, layer);
  376.   sideInfoSize = computeSideInfoSize();
  377.  }
  379. unsigned MP3FrameParams::computeSideInfoSize() {
  380.   unsigned size;
  381.   
  382.   if (isMPEG2) {
  383.     size = isStereo ? 17 : 9;
  384.   } else {
  385.     size = isStereo ? 32 : 17;
  386.   }
  388.   if (hasCRC) {
  389.     size += 2;
  390.   }
  392.   return size;
  393. }
  395. unsigned ComputeFrameSize(unsigned bitrate, unsigned samplingFreq,
  396.   Boolean usePadding, Boolean isMPEG2,
  397.   unsigned char layer) {
  398.   unsigned const bitrateMultiplier = (layer == 1) ? 12000*4 : 144000;
  399.   unsigned framesize;
  401.   framesize = bitrate*bitrateMultiplier;
  402.   framesize /= samplingFreq<<isMPEG2;
  403.   framesize = framesize + usePadding - 4;
  405.   return framesize;
  406. }
  407. #if 0
  408. #define TRUNC_FAIRLY
  409. static unsigned updateSideInfoSizes(MP3SideInfo& sideInfo, Boolean isMPEG2,
  410.     unsigned char const* mainDataPtr,
  411.     unsigned allowedNumBits,
  412.     unsigned& part23Length0a,
  413.     unsigned& part23Length0aTruncation,
  414.     unsigned& part23Length0b,
  415.     unsigned& part23Length0bTruncation,
  416.     unsigned& part23Length1a,
  417.     unsigned& part23Length1aTruncation,
  418.     unsigned& part23Length1b,
  419.     unsigned& part23Length1bTruncation) {
  420.   unsigned p23L0, p23L1 = 0, p23L0Trunc = 0, p23L1Trunc = 0;
  422.   p23L0 = sideInfo.ch[0].gr[0].part2_3_length;
  423.   p23L1 = isMPEG2 ? 0 : sideInfo.ch[0].gr[1].part2_3_length;
  424. #ifdef TRUNC_ONLY0
  425.   if (p23L0 < allowedNumBits)
  426.     allowedNumBits = p23L0;
  427. #endif
  428. #ifdef TRUNC_ONLY1
  429.   if (p23L1 < allowedNumBits)
  430.     allowedNumBits = p23L1;
  431. #endif
  432.   if (p23L0 + p23L1 > allowedNumBits) {
  433.     /* We need to shorten one or both fields */
  434.     unsigned truncation = p23L0 + p23L1 - allowedNumBits;
  435. #ifdef TRUNC_FAIRLY
  436.     p23L0Trunc = (truncation*p23L0)/(p23L0 + p23L1);
  437.     p23L1Trunc = truncation - p23L0Trunc;
  438. #endif
  439. #if defined(TRUNC_FAVOR0) || defined(TRUNC_ONLY0)
  440.     p23L1Trunc = (truncation>p23L1) ? p23L1 : truncation;
  441.     p23L0Trunc = truncation - p23L1Trunc;
  442. #endif
  443. #if defined(TRUNC_FAVOR1) || defined(TRUNC_ONLY1)
  444.     p23L0Trunc = (truncation>p23L0) ? p23L0 : truncation;
  445.     p23L1Trunc = truncation - p23L0Trunc;
  446. #endif
  447.   }
  449.   /* ASSERT: (p23L0Trunc <= p23L0) && (p23l1Trunc <= p23L1) */
  450.   p23L0 -= p23L0Trunc; p23L1 -= p23L1Trunc;
  451. #ifdef DEBUG
  452.   fprintf(stderr, "updateSideInfoSizes (allowed: %d): %d->%d, %d->%dn", allowedNumBits, p23L0+p23L0Trunc, p23L0, p23L1+p23L1Trunc, p23L1);
  453. #endif
  455.   // The truncations computed above are still estimates.  We need to 
  456.   // adjust them so that the new fields will continue to end on
  457.   // Huffman-encoded sample boundaries:
  458.   updateSideInfoForHuffman(sideInfo, isMPEG2, mainDataPtr,
  459.    p23L0, p23L1,
  460.    part23Length0a, part23Length0aTruncation,
  461.    part23Length0b, part23Length0bTruncation,
  462.    part23Length1a, part23Length1aTruncation,
  463.    part23Length1b, part23Length1bTruncation);
  464.   p23L0 = part23Length0a + part23Length0b;
  465.   p23L1 = part23Length1a + part23Length1b;
  467.   sideInfo.ch[0].gr[0].part2_3_length = p23L0;
  468.   sideInfo.ch[0].gr[1].part2_3_length = p23L1;
  469.   part23Length0bTruncation
  470.     += sideInfo.ch[1].gr[0].part2_3_length; /* allow for stereo */
  471.   sideInfo.ch[1].gr[0].part2_3_length = 0; /* output mono */
  472.   sideInfo.ch[1].gr[1].part2_3_length = 0; /* output mono */
  474.   return p23L0 + p23L1;
  475. }
  477. #endif
  479. Boolean GetADUInfoFromMP3Frame(unsigned char const* framePtr,
  480.        unsigned totFrameSize,
  481.        unsigned& hdr, unsigned& frameSize,
  482.        MP3SideInfo& sideInfo, unsigned& sideInfoSize,
  483.        unsigned& backpointer, unsigned& aduSize) {
  484.   if (totFrameSize < 4) return False; // there's not enough data
  486.   MP3FrameParams fr;
  487.   fr.hdr =   ((unsigned)framePtr[0] << 24) | ((unsigned)framePtr[1] << 16)
  488.            | ((unsigned)framePtr[2] << 8) | (unsigned)framePtr[3];
  489.   fr.setParamsFromHeader();
  490.   fr.setBytePointer(framePtr + 4, totFrameSize - 4); // skip hdr
  492.   frameSize = 4 + fr.frameSize;
  494.   sideInfoSize = fr.sideInfoSize;
  495.   if (totFrameSize < 4 + sideInfoSize) return False; // not enough data
  497.   fr.getSideInfo(sideInfo);
  499.   hdr = fr.hdr;
  500.   backpointer = sideInfo.main_data_begin;
  501.   unsigned numBits = sideInfo.ch[0].gr[0].part2_3_length;
  502.   numBits += sideInfo.ch[0].gr[1].part2_3_length;
  503.   numBits += sideInfo.ch[1].gr[0].part2_3_length;
  504.   numBits += sideInfo.ch[1].gr[1].part2_3_length;
  505.   aduSize = (numBits+7)/8;
  506. #ifdef DEBUG
  507.   fprintf(stderr, "mp3GetADUInfoFromFrame: hdr: %08x, frameSize: %d, part2_3_lengths: %d,%d,%d,%d, aduSize: %d, backpointer: %dn", hdr, frameSize, sideInfo.ch[0].gr[0].part2_3_length, sideInfo.ch[0].gr[1].part2_3_length, sideInfo.ch[1].gr[0].part2_3_length, sideInfo.ch[1].gr[1].part2_3_length, aduSize, backpointer);
  508. #endif
  510.   return True;
  511. }
  514. static void getSideInfo1(MP3FrameParams& fr, MP3SideInfo& si,
  515.  int stereo, int ms_stereo, long sfreq, int single) {
  516.    int ch, gr;
  517.    int powdiff = (single == 3) ? 4 : 0;
  519.    /* initialize all four "part2_3_length" fields to zero: */
  520.    si.ch[0].gr[0].part2_3_length = 0; si.ch[1].gr[0].part2_3_length = 0;
  521.    si.ch[0].gr[1].part2_3_length = 0; si.ch[1].gr[1].part2_3_length = 0;
  523.    si.main_data_begin = fr.getBits(9);
  524.    if (stereo == 1)
  525.      si.private_bits = fr.getBits(5);
  526.    else 
  527.      si.private_bits = fr.getBits(3);
  529.    for (ch=0; ch<stereo; ch++) {
  530.        si.ch[ch].gr[0].scfsi = -1;
  531.        si.ch[ch].gr[1].scfsi = fr.getBits(4);
  532.    }
  534.    for (gr=0; gr<2; gr++) {
  535.      for (ch=0; ch<stereo; ch++) {
  536.        MP3SideInfo::gr_info_s_t& gr_info = si.ch[ch].gr[gr];
  538.        gr_info.part2_3_length = fr.getBits(12);
  539.        gr_info.big_values = fr.getBits(9);
  540.        gr_info.global_gain = fr.getBits(8);
  541.        gr_info.pow2gain = gainpow2+256 - gr_info.global_gain + powdiff;
  542.        if (ms_stereo) gr_info.pow2gain += 2;
  543.        gr_info.scalefac_compress = fr.getBits(4);
  544. /* window-switching flag == 1 for block_Type != 0 .. and block-type == 0 -> win-sw-flag = 0 */
  545.        gr_info.window_switching_flag = fr.get1Bit();
  546.        if (gr_info.window_switching_flag) {
  547.          int i;
  548.          gr_info.block_type = fr.getBits(2);
  549.          gr_info.mixed_block_flag = fr.get1Bit();
  550.          gr_info.table_select[0] = fr.getBits(5);
  551.          gr_info.table_select[1] = fr.getBits(5);
  552.          /*
  553.           * table_select[2] not needed, because there is no region2,
  554.           * but to satisfy some verifications tools we set it either.
  555.           */
  556.          gr_info.table_select[2] = 0;
  557.          for (i=0;i<3;i++) {
  558.    gr_info.subblock_gain[i] = fr.getBits(3);
  559.            gr_info.full_gain[i]
  560.      = gr_info.pow2gain + ((gr_info.subblock_gain[i])<<3);
  561.  }
  563. #ifdef DEBUG_ERRORS
  564.          if (gr_info.block_type == 0) {
  565.            fprintf(stderr,"Blocktype == 0 and window-switching == 1 not allowed.n");
  566.          }
  567. #endif
  568.          /* region_count/start parameters are implicit in this case. */       
  569.          gr_info.region1start = 36>>1;
  570.          gr_info.region2start = 576>>1;
  571.        }
  572.        else 
  573.        {
  574.          int i,r0c,r1c;
  575.          for (i=0; i<3; i++) {
  576.    gr_info.table_select[i] = fr.getBits(5);
  577.  }
  578.          r0c = gr_info.region0_count = fr.getBits(4);
  579.          r1c = gr_info.region1_count = fr.getBits(3);
  580.          gr_info.region1start = bandInfo[sfreq].longIdx[r0c+1] >> 1 ;
  581.          gr_info.region2start = bandInfo[sfreq].longIdx[r0c+1+r1c+1] >> 1;
  582.          gr_info.block_type = 0;
  583.          gr_info.mixed_block_flag = 0;
  584.        }
  585.        gr_info.preflag = fr.get1Bit();
  586.        gr_info.scalefac_scale = fr.get1Bit();
  587.        gr_info.count1table_select = fr.get1Bit();
  588.      }
  589.    }
  590. }
  592. static void getSideInfo2(MP3FrameParams& fr, MP3SideInfo& si,
  593.  int stereo, int ms_stereo, long sfreq, int single) {
  594.    int ch;
  595.    int powdiff = (single == 3) ? 4 : 0;
  597.    /* initialize all four "part2_3_length" fields to zero: */
  598.    si.ch[0].gr[0].part2_3_length = 0; si.ch[1].gr[0].part2_3_length = 0;
  599.    si.ch[0].gr[1].part2_3_length = 0; si.ch[1].gr[1].part2_3_length = 0;
  601.    si.main_data_begin = fr.getBits(8);
  602.    if (stereo == 1)
  603.      si.private_bits = fr.get1Bit();
  604.    else 
  605.      si.private_bits = fr.getBits(2);
  607.    for (ch=0; ch<stereo; ch++) {
  608.        MP3SideInfo::gr_info_s_t& gr_info = si.ch[ch].gr[0];
  610.        gr_info.part2_3_length = fr.getBits(12);
  611.        si.ch[ch].gr[1].part2_3_length = 0; /* to ensure granule 1 unused */
  613.        gr_info.big_values = fr.getBits(9);
  614.        gr_info.global_gain = fr.getBits(8);
  615.        gr_info.pow2gain = gainpow2+256 - gr_info.global_gain + powdiff;
  616.        if (ms_stereo) gr_info.pow2gain += 2;
  617.        gr_info.scalefac_compress = fr.getBits(9);
  618. /* window-switching flag == 1 for block_Type != 0 .. and block-type == 0 -> win-sw-flag = 0 */
  619.        gr_info.window_switching_flag = fr.get1Bit();
  620.        if (gr_info.window_switching_flag) {
  621.          int i;
  622.          gr_info.block_type = fr.getBits(2);
  623.          gr_info.mixed_block_flag = fr.get1Bit();
  624.          gr_info.table_select[0] = fr.getBits(5);
  625.          gr_info.table_select[1] = fr.getBits(5);
  626.          /*
  627.           * table_select[2] not needed, because there is no region2,
  628.           * but to satisfy some verifications tools we set it either.
  629.           */
  630.          gr_info.table_select[2] = 0;
  631.          for (i=0;i<3;i++) {
  632.    gr_info.subblock_gain[i] = fr.getBits(3);
  633.            gr_info.full_gain[i]
  634.      = gr_info.pow2gain + ((gr_info.subblock_gain[i])<<3);
  635.  }
  637. #ifdef DEBUG_ERRORS
  638.          if (gr_info.block_type == 0) {
  639.            fprintf(stderr,"Blocktype == 0 and window-switching == 1 not allowed.n");
  640.          }
  641. #endif
  642.          /* region_count/start parameters are implicit in this case. */       
  643. /* check this again! */
  644.          if (gr_info.block_type == 2)
  645.            gr_info.region1start = 36>>1;
  646.          else {
  647.            gr_info.region1start = 54>>1;
  648.          }
  649.          gr_info.region2start = 576>>1;
  650.        }
  651.        else 
  652.        {
  653.          int i,r0c,r1c;
  654.          for (i=0; i<3; i++) {
  655.            gr_info.table_select[i] = fr.getBits(5);
  656.  }
  657.          r0c = gr_info.region0_count = fr.getBits(4);
  658.          r1c = gr_info.region1_count = fr.getBits(3);
  659.          gr_info.region1start = bandInfo[sfreq].longIdx[r0c+1] >> 1 ;
  660.          gr_info.region2start = bandInfo[sfreq].longIdx[r0c+1+r1c+1] >> 1;
  661.          gr_info.block_type = 0;
  662.          gr_info.mixed_block_flag = 0;
  663.        }
  664.        gr_info.scalefac_scale = fr.get1Bit();
  665.        gr_info.count1table_select = fr.get1Bit();
  666.    }
  667. }
  670. #define         MPG_MD_JOINT_STEREO     1
  672. void MP3FrameParams::getSideInfo(MP3SideInfo& si) {
  673.   // First skip over the CRC if present:
  674.   if (hasCRC) getBits(16);
  676.   int single = -1;
  677.   int ms_stereo, i_stereo;
  678.   int sfreq = samplingFreqIndex;
  680.   if (stereo == 1) {
  681.     single = 0;
  682.   }
  684.   ms_stereo = (mode == MPG_MD_JOINT_STEREO) && (mode_ext & 0x2);
  685.   i_stereo = (mode == MPG_MD_JOINT_STEREO) && (mode_ext & 0x1);
  687.   if (isMPEG2) {
  688.     getSideInfo2(*this, si, stereo, ms_stereo, sfreq, single);
  689.   } else {
  690.     getSideInfo1(*this, si, stereo, ms_stereo, sfreq, single);
  691.   }
  692. }
  694. static void putSideInfo1(BitVector& bv,
  695.  MP3SideInfo const& si, Boolean isStereo) {
  696.   int ch, gr, i;
  697.   int stereo = isStereo ? 2 : 1;
  698.   
  699.   bv.putBits(si.main_data_begin,9);
  700.   if (stereo == 1)
  701.     bv.putBits(si.private_bits, 5);
  702.   else
  703.     bv.putBits(si.private_bits, 3);
  704.   
  705.   for (ch=0; ch<stereo; ch++) {
  706.     bv.putBits(si.ch[ch].gr[1].scfsi, 4);
  707.   }
  708.   
  709.   for (gr=0; gr<2; gr++) {
  710.     for (ch=0; ch<stereo; ch++) {
  711.       MP3SideInfo::gr_info_s_t const& gr_info = si.ch[ch].gr[gr];
  713.       bv.putBits(gr_info.part2_3_length, 12);
  714.       bv.putBits(gr_info.big_values, 9);
  715.       bv.putBits(gr_info.global_gain, 8);
  716.       bv.putBits(gr_info.scalefac_compress, 4);
  717.       bv.put1Bit(gr_info.window_switching_flag);
  718.       if (gr_info.window_switching_flag) {
  719. bv.putBits(gr_info.block_type, 2);
  720. bv.put1Bit(gr_info.mixed_block_flag);
  721. for (i=0; i<2; i++)
  722.   bv.putBits(gr_info.table_select[i], 5);
  723. for (i=0; i<3; i++)
  724.   bv.putBits(gr_info.subblock_gain[i], 3);
  725.       }
  726.       else {
  727. for (i=0; i<3; i++)
  728.   bv.putBits(gr_info.table_select[i], 5);
  729. bv.putBits(gr_info.region0_count, 4);
  730. bv.putBits(gr_info.region1_count, 3);
  731.       }      
  732.       
  733.       bv.put1Bit(gr_info.preflag);
  734.       bv.put1Bit(gr_info.scalefac_scale);
  735.       bv.put1Bit(gr_info.count1table_select);
  736.     }
  737.   }
  738. }
  740. static void putSideInfo2(BitVector& bv,
  741.  MP3SideInfo const& si, Boolean isStereo) {
  742.   int ch, i;
  743.   int stereo = isStereo ? 2 : 1;
  744.   
  745.   bv.putBits(si.main_data_begin,8);
  746.   if (stereo == 1)
  747.     bv.put1Bit(si.private_bits);
  748.   else
  749.     bv.putBits(si.private_bits, 2);
  750.   
  751.   for (ch=0; ch<stereo; ch++) {
  752.     MP3SideInfo::gr_info_s_t const& gr_info = si.ch[ch].gr[0];
  753.     
  754.     bv.putBits(gr_info.part2_3_length, 12);
  755.     bv.putBits(gr_info.big_values, 9);
  756.     bv.putBits(gr_info.global_gain, 8);
  757.     bv.putBits(gr_info.scalefac_compress, 9);
  758.     bv.put1Bit(gr_info.window_switching_flag);
  759.     if (gr_info.window_switching_flag) {
  760.       bv.putBits(gr_info.block_type, 2);
  761.       bv.put1Bit(gr_info.mixed_block_flag);
  762.       for (i=0; i<2; i++)
  763. bv.putBits(gr_info.table_select[i], 5);
  764.       for (i=0; i<3; i++)
  765. bv.putBits(gr_info.subblock_gain[i], 3);
  766.     }
  767.     else {
  768.       for (i=0; i<3; i++)
  769. bv.putBits(gr_info.table_select[i], 5);
  770.       bv.putBits(gr_info.region0_count, 4);
  771.       bv.putBits(gr_info.region1_count, 3);
  772.     }      
  773.     
  774.     bv.put1Bit(gr_info.scalefac_scale);
  775.     bv.put1Bit(gr_info.count1table_select);
  776.   }
  777. }
  779. static void PutMP3SideInfoIntoFrame(MP3SideInfo const& si,
  780.     MP3FrameParams const& fr,
  781.     unsigned char* framePtr) {
  782.   if (fr.hasCRC) framePtr += 2; // skip CRC
  784.   BitVector bv(framePtr, 0, 8*fr.sideInfoSize);
  786.   if (fr.isMPEG2) {
  787.     putSideInfo2(bv, si, fr.isStereo);
  788.   } else {
  789.     putSideInfo1(bv, si, fr.isStereo);
  790.   }
  791. }
  794. Boolean ZeroOutMP3SideInfo(unsigned char* framePtr, unsigned totFrameSize,
  795.                            unsigned newBackpointer) {
  796.   if (totFrameSize < 4) return False; // there's not enough data
  798.   MP3FrameParams fr;
  799.   fr.hdr =   ((unsigned)framePtr[0] << 24) | ((unsigned)framePtr[1] << 16)
  800.            | ((unsigned)framePtr[2] << 8) | (unsigned)framePtr[3];
  801.   fr.setParamsFromHeader();
  802.   fr.setBytePointer(framePtr + 4, totFrameSize - 4); // skip hdr
  804.   if (totFrameSize < 4 + fr.sideInfoSize) return False; // not enough data
  806.   MP3SideInfo si;
  807.   fr.getSideInfo(si);
  809.   si.main_data_begin = newBackpointer; /* backpointer */
  810.   /* set all four "part2_3_length" and "big_values" fields to zero: */
  811.   si.ch[0].gr[0].part2_3_length = si.ch[0].gr[0].big_values = 0;
  812.   si.ch[1].gr[0].part2_3_length = si.ch[1].gr[0].big_values = 0;
  813.   si.ch[0].gr[1].part2_3_length = si.ch[0].gr[1].big_values = 0;
  814.   si.ch[1].gr[1].part2_3_length = si.ch[1].gr[1].big_values = 0;
  816.   PutMP3SideInfoIntoFrame(si, fr, framePtr + 4);
  818.   return True;
  819. }
  821. #if 0
  822. static unsigned MP3BitrateToBitrateIndex(unsigned bitrate /* in kbps */,
  823.  Boolean isMPEG2) {
  824.   for (unsigned i = 1; i < 15; ++i) {
  825.     if (tabsel_123[isMPEG2][2][i] >= bitrate)
  826.       return i;
  827.   }
  829.   // "bitrate" was larger than any possible, so return the largest possible:
  830.   return 14;
  831. }           
  833. static void outputHeader(unsigned char* toPtr, unsigned hdr) {
  834.   toPtr[0] = (unsigned char)(hdr>>24);
  835.   toPtr[1] = (unsigned char)(hdr>>16);
  836.   toPtr[2] = (unsigned char)(hdr>>8);
  837.   toPtr[3] = (unsigned char)(hdr);
  838. }
  840. static void assignADUBackpointer(MP3FrameParams const& fr,
  841.  unsigned aduSize,
  842.  MP3SideInfo& sideInfo,
  843.  unsigned& availableBytesForBackpointer) {
  844.   // Give the ADU as large a backpointer as possible:
  845.   unsigned maxBackpointerSize = fr.isMPEG2 ? 255 : 511;
  847.   unsigned backpointerSize = availableBytesForBackpointer;
  848.   if (backpointerSize > maxBackpointerSize) {
  849.     backpointerSize = maxBackpointerSize; 
  850.   }
  852.   // Store the new backpointer now:
  853.   sideInfo.main_data_begin = backpointerSize;
  855.   // Figure out how many bytes are available for the *next* ADU's backpointer:
  856.   availableBytesForBackpointer
  857.     = backpointerSize + fr.frameSize - fr.sideInfoSize ;
  858.   if (availableBytesForBackpointer < aduSize) {
  859.     availableBytesForBackpointer = 0;
  860.   } else {
  861.     availableBytesForBackpointer -= aduSize;
  862.   }
  863. }
  865. unsigned TranscodeMP3ADU(unsigned char const* fromPtr, unsigned fromSize,
  866.                       unsigned toBitrate,
  867.       unsigned char* toPtr, unsigned toMaxSize,
  868.       unsigned& availableBytesForBackpointer) {
  869.   // Begin by parsing the input ADU's parameters:
  870.   unsigned hdr, inFrameSize, inSideInfoSize, backpointer, inAduSize;
  871.   MP3SideInfo sideInfo;
  872.   if (!GetADUInfoFromMP3Frame(fromPtr, fromSize,
  873.                               hdr, inFrameSize, sideInfo, inSideInfoSize,
  874.       backpointer, inAduSize)) {
  875.     return 0;
  876.   }
  877.   fromPtr += (4+inSideInfoSize); // skip to 'main data'
  879.   // Alter the 4-byte MPEG header to reflect the output ADU:
  880.   // (different bitrate; mono; no CRC)
  881.   Boolean isMPEG2 = ((hdr&0x00080000) == 0);
  882.   unsigned toBitrateIndex = MP3BitrateToBitrateIndex(toBitrate, isMPEG2);
  883.   hdr &=~ 0xF000; hdr |= (toBitrateIndex<<12); // set bitrate index
  884.   hdr |= 0x10200; // turn on !error-prot and padding bits
  885.   hdr &=~ 0xC0; hdr |= 0xC0; // set mode to 3 (mono)
  887.   // Set up the rest of the parameters of the new ADU:
  888.   MP3FrameParams outFr;
  889.   outFr.hdr = hdr;
  890.   outFr.setParamsFromHeader();
  892.   // Figure out how big to make the output ADU:
  893.   unsigned inAveAduSize = inFrameSize - inSideInfoSize;
  894.   unsigned outAveAduSize = outFr.frameSize - outFr.sideInfoSize;
  895.   unsigned desiredOutAduSize /*=inAduSize*outAveAduSize/inAveAduSize*/
  896.     = (2*inAduSize*outAveAduSize + inAveAduSize)/(2*inAveAduSize);
  897.       // this rounds to the nearest integer
  899.   if (toMaxSize < (4 + outFr.sideInfoSize)) return 0;
  900.   unsigned maxOutAduSize = toMaxSize - (4 + outFr.sideInfoSize);
  901.   if (desiredOutAduSize > maxOutAduSize) {
  902.     desiredOutAduSize = maxOutAduSize;
  903.   }
  905.   // Figure out the new sizes of the various 'part23 lengths',
  906.   // and how much they are truncated:
  907.   unsigned part23Length0a, part23Length0aTruncation;
  908.   unsigned part23Length0b, part23Length0bTruncation;
  909.   unsigned part23Length1a, part23Length1aTruncation;
  910.   unsigned part23Length1b, part23Length1bTruncation;
  911.   unsigned numAduBits
  912.     = updateSideInfoSizes(sideInfo, outFr.isMPEG2,
  913.   fromPtr, 8*desiredOutAduSize,
  914.   part23Length0a, part23Length0aTruncation,
  915.   part23Length0b, part23Length0bTruncation,
  916.   part23Length1a, part23Length1aTruncation,
  917.   part23Length1b, part23Length1bTruncation);
  918. #ifdef DEBUG
  919. fprintf(stderr, "shrinkage %d->%d [(%d,%d),(%d,%d)] (trunc: [(%d,%d),(%d,%d)]) {%d}n", inAduSize, (numAduBits+7)/8,
  920.       part23Length0a, part23Length0b, part23Length1a, part23Length1b,
  921.       part23Length0aTruncation, part23Length0bTruncation,
  922.       part23Length1aTruncation, part23Length1bTruncation,
  923.       maxOutAduSize);
  924. #endif
  925.  unsigned actualOutAduSize = (numAduBits+7)/8;
  927.  // Give the new ADU an appropriate 'backpointer':
  928.  assignADUBackpointer(outFr, actualOutAduSize, sideInfo, availableBytesForBackpointer);
  930.  ///// Now output the new ADU:
  932.  // 4-byte header
  933.  outputHeader(toPtr, hdr); toPtr += 4;
  935.  // side info
  936.  PutMP3SideInfoIntoFrame(sideInfo, outFr, toPtr); toPtr += outFr.sideInfoSize;
  938.  // 'main data', using the new lengths
  939.  unsigned toBitOffset = 0;
  940.  unsigned fromBitOffset = 0;
  941.  
  942.  /* rebuild portion 0a: */
  943.  memmove(toPtr, fromPtr, (part23Length0a+7)/8);
  944.  toBitOffset += part23Length0a;
  945.  fromBitOffset += part23Length0a + part23Length0aTruncation;
  946.  
  947.  /* rebuild portion 0b: */
  948.  shiftBits(toPtr, toBitOffset, fromPtr, fromBitOffset, part23Length0b);
  949.  toBitOffset += part23Length0b;
  950.  fromBitOffset += part23Length0b + part23Length0bTruncation;
  951.  
  952.  /* rebuild portion 1a: */
  953.  shiftBits(toPtr, toBitOffset, fromPtr, fromBitOffset, part23Length1a);
  954.  toBitOffset += part23Length1a;
  955.  fromBitOffset += part23Length1a + part23Length1aTruncation;
  956.  
  957.  /* rebuild portion 1b: */
  958.  shiftBits(toPtr, toBitOffset, fromPtr, fromBitOffset, part23Length1b);
  959.  toBitOffset += part23Length1b;
  961.  /* zero out any remaining bits (probably unnecessary, but...) */
  962.  unsigned char const zero = '';
  963.  shiftBits(toPtr, toBitOffset, &zero, 0,
  964.    actualOutAduSize*8 - numAduBits);
  966.  return 4 + outFr.sideInfoSize + actualOutAduSize;
  967. }
  969. #endif