layer12.c
上传用户:xjjlds
上传日期:2015-12-05
资源大小:22823k
文件大小:13k
源码类别:

多媒体编程

开发平台:

Visual C++

  1. /*
  2.  * libmad - MPEG audio decoder library
  3.  * Copyright (C) 2000-2003 Underbit Technologies, Inc.
  4.  *
  5.  * This program is free software; you can redistribute it and/or modify
  6.  * it under the terms of the GNU General Public License as published by
  7.  * the Free Software Foundation; either version 2 of the License, or
  8.  * (at your option) any later version.
  9.  *
  10.  * This program is distributed in the hope that it will be useful,
  11.  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12.  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13.  * GNU General Public License for more details.
  14.  *
  15.  * You should have received a copy of the GNU General Public License
  16.  * along with this program; if not, write to the Free Software
  17.  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  18.  *
  19.  * $Id: layer12.c,v 1.1 2003/08/31 18:59:46 gabest Exp $
  20.  */
  21. # ifdef HAVE_CONFIG_H
  22. #  include "config.h"
  23. # endif
  24. # include "global.h"
  25. # ifdef HAVE_LIMITS_H
  26. #  include <limits.h>
  27. # else
  28. #  define CHAR_BIT  8
  29. # endif
  30. # include "fixed.h"
  31. # include "bit.h"
  32. # include "stream.h"
  33. # include "frame.h"
  34. # include "layer12.h"
  35. /*
  36.  * scalefactor table
  37.  * used in both Layer I and Layer II decoding
  38.  */
  39. static
  40. mad_fixed_t const sf_table[64] = {
  41. # include "sf_table.dat"
  42. };
  43. /* --- Layer I ------------------------------------------------------------- */
  44. /* linear scaling table */
  45. static
  46. mad_fixed_t const linear_table[14] = {
  47.   MAD_F(0x15555555),  /* 2^2  / (2^2  - 1) == 1.33333333333333 */
  48.   MAD_F(0x12492492),  /* 2^3  / (2^3  - 1) == 1.14285714285714 */
  49.   MAD_F(0x11111111),  /* 2^4  / (2^4  - 1) == 1.06666666666667 */
  50.   MAD_F(0x10842108),  /* 2^5  / (2^5  - 1) == 1.03225806451613 */
  51.   MAD_F(0x10410410),  /* 2^6  / (2^6  - 1) == 1.01587301587302 */
  52.   MAD_F(0x10204081),  /* 2^7  / (2^7  - 1) == 1.00787401574803 */
  53.   MAD_F(0x10101010),  /* 2^8  / (2^8  - 1) == 1.00392156862745 */
  54.   MAD_F(0x10080402),  /* 2^9  / (2^9  - 1) == 1.00195694716243 */
  55.   MAD_F(0x10040100),  /* 2^10 / (2^10 - 1) == 1.00097751710655 */
  56.   MAD_F(0x10020040),  /* 2^11 / (2^11 - 1) == 1.00048851978505 */
  57.   MAD_F(0x10010010),  /* 2^12 / (2^12 - 1) == 1.00024420024420 */
  58.   MAD_F(0x10008004),  /* 2^13 / (2^13 - 1) == 1.00012208521548 */
  59.   MAD_F(0x10004001),  /* 2^14 / (2^14 - 1) == 1.00006103888177 */
  60.   MAD_F(0x10002000)   /* 2^15 / (2^15 - 1) == 1.00003051850948 */
  61. };
  62. /*
  63.  * NAME: I_sample()
  64.  * DESCRIPTION: decode one requantized Layer I sample from a bitstream
  65.  */
  66. static
  67. mad_fixed_t I_sample(struct mad_bitptr *ptr, unsigned int nb)
  68. {
  69.   mad_fixed_t sample;
  70.   sample = mad_bit_read(ptr, nb);
  71.   /* invert most significant bit, extend sign, then scale to fixed format */
  72.   sample ^= 1 << (nb - 1);
  73.   sample |= -(sample & (1 << (nb - 1)));
  74.   sample <<= MAD_F_FRACBITS - (nb - 1);
  75.   /* requantize the sample */
  76.   /* s'' = (2^nb / (2^nb - 1)) * (s''' + 2^(-nb + 1)) */
  77.   sample += MAD_F_ONE >> (nb - 1);
  78.   return mad_f_mul(sample, linear_table[nb - 2]);
  79.   /* s' = factor * s'' */
  80.   /* (to be performed by caller) */
  81. }
  82. /*
  83.  * NAME: layer->I()
  84.  * DESCRIPTION: decode a single Layer I frame
  85.  */
  86. int mad_layer_I(struct mad_stream *stream, struct mad_frame *frame)
  87. {
  88.   struct mad_header *header = &frame->header;
  89.   unsigned int nch, bound, ch, s, sb, nb;
  90.   unsigned char allocation[2][32], scalefactor[2][32];
  91.   nch = MAD_NCHANNELS(header);
  92.   bound = 32;
  93.   if (header->mode == MAD_MODE_JOINT_STEREO) {
  94.     header->flags |= MAD_FLAG_I_STEREO;
  95.     bound = 4 + header->mode_extension * 4;
  96.   }
  97.   /* check CRC word */
  98.   if (header->flags & MAD_FLAG_PROTECTION) {
  99.     header->crc_check =
  100.       mad_bit_crc(stream->ptr, 4 * (bound * nch + (32 - bound)),
  101.   header->crc_check);
  102.     if (header->crc_check != header->crc_target &&
  103. !(frame->options & MAD_OPTION_IGNORECRC)) {
  104.       stream->error = MAD_ERROR_BADCRC;
  105.       return -1;
  106.     }
  107.   }
  108.   /* decode bit allocations */
  109.   for (sb = 0; sb < bound; ++sb) {
  110.     for (ch = 0; ch < nch; ++ch) {
  111.       nb = mad_bit_read(&stream->ptr, 4);
  112.       if (nb == 15) {
  113. stream->error = MAD_ERROR_BADBITALLOC;
  114. return -1;
  115.       }
  116.       allocation[ch][sb] = nb ? nb + 1 : 0;
  117.     }
  118.   }
  119.   for (sb = bound; sb < 32; ++sb) {
  120.     nb = mad_bit_read(&stream->ptr, 4);
  121.     if (nb == 15) {
  122.       stream->error = MAD_ERROR_BADBITALLOC;
  123.       return -1;
  124.     }
  125.     allocation[0][sb] =
  126.     allocation[1][sb] = nb ? nb + 1 : 0;
  127.   }
  128.   /* decode scalefactors */
  129.   for (sb = 0; sb < 32; ++sb) {
  130.     for (ch = 0; ch < nch; ++ch) {
  131.       if (allocation[ch][sb]) {
  132. scalefactor[ch][sb] = mad_bit_read(&stream->ptr, 6);
  133. # if defined(OPT_STRICT)
  134. /*
  135.  * Scalefactor index 63 does not appear in Table B.1 of
  136.  * ISO/IEC 11172-3. Nonetheless, other implementations accept it,
  137.  * so we only reject it if OPT_STRICT is defined.
  138.  */
  139. if (scalefactor[ch][sb] == 63) {
  140.   stream->error = MAD_ERROR_BADSCALEFACTOR;
  141.   return -1;
  142. }
  143. # endif
  144.       }
  145.     }
  146.   }
  147.   /* decode samples */
  148.   for (s = 0; s < 12; ++s) {
  149.     for (sb = 0; sb < bound; ++sb) {
  150.       for (ch = 0; ch < nch; ++ch) {
  151. nb = allocation[ch][sb];
  152. frame->sbsample[ch][s][sb] = nb ?
  153.   mad_f_mul(I_sample(&stream->ptr, nb),
  154.     sf_table[scalefactor[ch][sb]]) : 0;
  155.       }
  156.     }
  157.     for (sb = bound; sb < 32; ++sb) {
  158.       if ((nb = allocation[0][sb])) {
  159. mad_fixed_t sample;
  160. sample = I_sample(&stream->ptr, nb);
  161. for (ch = 0; ch < nch; ++ch) {
  162.   frame->sbsample[ch][s][sb] =
  163.     mad_f_mul(sample, sf_table[scalefactor[ch][sb]]);
  164. }
  165.       }
  166.       else {
  167. for (ch = 0; ch < nch; ++ch)
  168.   frame->sbsample[ch][s][sb] = 0;
  169.       }
  170.     }
  171.   }
  172.   return 0;
  173. }
  174. /* --- Layer II ------------------------------------------------------------ */
  175. /* possible quantization per subband table */
  176. static
  177. struct {
  178.   unsigned int sblimit;
  179.   unsigned char const offsets[30];
  180. } const sbquant_table[5] = {
  181.   /* ISO/IEC 11172-3 Table B.2a */
  182.   { 27, { 7, 7, 7, 6, 6, 6, 6, 6, 6, 6, 6, 3, 3, 3, 3, 3, /* 0 */
  183.   3, 3, 3, 3, 3, 3, 3, 0, 0, 0, 0 } },
  184.   /* ISO/IEC 11172-3 Table B.2b */
  185.   { 30, { 7, 7, 7, 6, 6, 6, 6, 6, 6, 6, 6, 3, 3, 3, 3, 3, /* 1 */
  186.   3, 3, 3, 3, 3, 3, 3, 0, 0, 0, 0, 0, 0, 0 } },
  187.   /* ISO/IEC 11172-3 Table B.2c */
  188.   {  8, { 5, 5, 2, 2, 2, 2, 2, 2 } }, /* 2 */
  189.   /* ISO/IEC 11172-3 Table B.2d */
  190.   { 12, { 5, 5, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2 } }, /* 3 */
  191.   /* ISO/IEC 13818-3 Table B.1 */
  192.   { 30, { 4, 4, 4, 4, 2, 2, 2, 2, 2, 2, 2, 1, 1, 1, 1, 1, /* 4 */
  193.   1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1 } }
  194. };
  195. /* bit allocation table */
  196. static
  197. struct {
  198.   unsigned short nbal;
  199.   unsigned short offset;
  200. } const bitalloc_table[8] = {
  201.   { 2, 0 },  /* 0 */
  202.   { 2, 3 },  /* 1 */
  203.   { 3, 3 },  /* 2 */
  204.   { 3, 1 },  /* 3 */
  205.   { 4, 2 },  /* 4 */
  206.   { 4, 3 },  /* 5 */
  207.   { 4, 4 },  /* 6 */
  208.   { 4, 5 }   /* 7 */
  209. };
  210. /* offsets into quantization class table */
  211. static
  212. unsigned char const offset_table[6][15] = {
  213.   { 0, 1, 16                                             },  /* 0 */
  214.   { 0, 1,  2, 3, 4, 5, 16                                },  /* 1 */
  215.   { 0, 1,  2, 3, 4, 5,  6, 7,  8,  9, 10, 11, 12, 13, 14 },  /* 2 */
  216.   { 0, 1,  3, 4, 5, 6,  7, 8,  9, 10, 11, 12, 13, 14, 15 },  /* 3 */
  217.   { 0, 1,  2, 3, 4, 5,  6, 7,  8,  9, 10, 11, 12, 13, 16 },  /* 4 */
  218.   { 0, 2,  4, 5, 6, 7,  8, 9, 10, 11, 12, 13, 14, 15, 16 }   /* 5 */
  219. };
  220. /* quantization class table */
  221. static
  222. struct quantclass {
  223.   unsigned short nlevels;
  224.   unsigned char group;
  225.   unsigned char bits;
  226.   mad_fixed_t C;
  227.   mad_fixed_t D;
  228. } const qc_table[17] = {
  229. # include "qc_table.dat"
  230. };
  231. /*
  232.  * NAME: II_samples()
  233.  * DESCRIPTION: decode three requantized Layer II samples from a bitstream
  234.  */
  235. static
  236. void II_samples(struct mad_bitptr *ptr,
  237. struct quantclass const *quantclass,
  238. mad_fixed_t output[3])
  239. {
  240.   unsigned int nb, s, sample[3];
  241.   if ((nb = quantclass->group)) {
  242.     unsigned int c, nlevels;
  243.     /* degrouping */
  244.     c = mad_bit_read(ptr, quantclass->bits);
  245.     nlevels = quantclass->nlevels;
  246.     for (s = 0; s < 3; ++s) {
  247.       sample[s] = c % nlevels;
  248.       c /= nlevels;
  249.     }
  250.   }
  251.   else {
  252.     nb = quantclass->bits;
  253.     for (s = 0; s < 3; ++s)
  254.       sample[s] = mad_bit_read(ptr, nb);
  255.   }
  256.   for (s = 0; s < 3; ++s) {
  257.     mad_fixed_t requantized;
  258.     /* invert most significant bit, extend sign, then scale to fixed format */
  259.     requantized  = sample[s] ^ (1 << (nb - 1));
  260.     requantized |= -(requantized & (1 << (nb - 1)));
  261.     requantized <<= MAD_F_FRACBITS - (nb - 1);
  262.     /* requantize the sample */
  263.     /* s'' = C * (s''' + D) */
  264.     output[s] = mad_f_mul(requantized + quantclass->D, quantclass->C);
  265.     /* s' = factor * s'' */
  266.     /* (to be performed by caller) */
  267.   }
  268. }
  269. /*
  270.  * NAME: layer->II()
  271.  * DESCRIPTION: decode a single Layer II frame
  272.  */
  273. int mad_layer_II(struct mad_stream *stream, struct mad_frame *frame)
  274. {
  275.   struct mad_header *header = &frame->header;
  276.   struct mad_bitptr start;
  277.   unsigned int index, sblimit, nbal, nch, bound, gr, ch, s, sb;
  278.   unsigned char const *offsets;
  279.   unsigned char allocation[2][32], scfsi[2][32], scalefactor[2][32][3];
  280.   mad_fixed_t samples[3];
  281.   nch = MAD_NCHANNELS(header);
  282.   if (header->flags & MAD_FLAG_LSF_EXT)
  283.     index = 4;
  284.   else {
  285.     switch (nch == 2 ? header->bitrate / 2 : header->bitrate) {
  286.     case 32000:
  287.     case 48000:
  288.       index = (header->samplerate == 32000) ? 3 : 2;
  289.       break;
  290.     case 56000:
  291.     case 64000:
  292.     case 80000:
  293.       index = 0;
  294.       break;
  295.     default:
  296.       index = (header->samplerate == 48000) ? 0 : 1;
  297.     }
  298.   }
  299.   sblimit = sbquant_table[index].sblimit;
  300.   offsets = sbquant_table[index].offsets;
  301.   bound = 32;
  302.   if (header->mode == MAD_MODE_JOINT_STEREO) {
  303.     header->flags |= MAD_FLAG_I_STEREO;
  304.     bound = 4 + header->mode_extension * 4;
  305.   }
  306.   if (bound > sblimit)
  307.     bound = sblimit;
  308.   start = stream->ptr;
  309.   /* decode bit allocations */
  310.   for (sb = 0; sb < bound; ++sb) {
  311.     nbal = bitalloc_table[offsets[sb]].nbal;
  312.     for (ch = 0; ch < nch; ++ch)
  313.       allocation[ch][sb] = mad_bit_read(&stream->ptr, nbal);
  314.   }
  315.   for (sb = bound; sb < sblimit; ++sb) {
  316.     nbal = bitalloc_table[offsets[sb]].nbal;
  317.     allocation[0][sb] =
  318.     allocation[1][sb] = mad_bit_read(&stream->ptr, nbal);
  319.   }
  320.   /* decode scalefactor selection info */
  321.   for (sb = 0; sb < sblimit; ++sb) {
  322.     for (ch = 0; ch < nch; ++ch) {
  323.       if (allocation[ch][sb])
  324. scfsi[ch][sb] = mad_bit_read(&stream->ptr, 2);
  325.     }
  326.   }
  327.   /* check CRC word */
  328.   if (header->flags & MAD_FLAG_PROTECTION) {
  329.     header->crc_check =
  330.       mad_bit_crc(start, mad_bit_length(&start, &stream->ptr),
  331.   header->crc_check);
  332.     if (header->crc_check != header->crc_target &&
  333. !(frame->options & MAD_OPTION_IGNORECRC)) {
  334.       stream->error = MAD_ERROR_BADCRC;
  335.       return -1;
  336.     }
  337.   }
  338.   /* decode scalefactors */
  339.   for (sb = 0; sb < sblimit; ++sb) {
  340.     for (ch = 0; ch < nch; ++ch) {
  341.       if (allocation[ch][sb]) {
  342. scalefactor[ch][sb][0] = mad_bit_read(&stream->ptr, 6);
  343. switch (scfsi[ch][sb]) {
  344. case 2:
  345.   scalefactor[ch][sb][2] =
  346.   scalefactor[ch][sb][1] =
  347.   scalefactor[ch][sb][0];
  348.   break;
  349. case 0:
  350.   scalefactor[ch][sb][1] = mad_bit_read(&stream->ptr, 6);
  351.   /* fall through */
  352. case 1:
  353. case 3:
  354.   scalefactor[ch][sb][2] = mad_bit_read(&stream->ptr, 6);
  355. }
  356. if (scfsi[ch][sb] & 1)
  357.   scalefactor[ch][sb][1] = scalefactor[ch][sb][scfsi[ch][sb] - 1];
  358. # if defined(OPT_STRICT)
  359. /*
  360.  * Scalefactor index 63 does not appear in Table B.1 of
  361.  * ISO/IEC 11172-3. Nonetheless, other implementations accept it,
  362.  * so we only reject it if OPT_STRICT is defined.
  363.  */
  364. if (scalefactor[ch][sb][0] == 63 ||
  365.     scalefactor[ch][sb][1] == 63 ||
  366.     scalefactor[ch][sb][2] == 63) {
  367.   stream->error = MAD_ERROR_BADSCALEFACTOR;
  368.   return -1;
  369. }
  370. # endif
  371.       }
  372.     }
  373.   }
  374.   /* decode samples */
  375.   for (gr = 0; gr < 12; ++gr) {
  376.     for (sb = 0; sb < bound; ++sb) {
  377.       for (ch = 0; ch < nch; ++ch) {
  378. if ((index = allocation[ch][sb])) {
  379.   index = offset_table[bitalloc_table[offsets[sb]].offset][index - 1];
  380.   II_samples(&stream->ptr, &qc_table[index], samples);
  381.   for (s = 0; s < 3; ++s) {
  382.     frame->sbsample[ch][3 * gr + s][sb] =
  383.       mad_f_mul(samples[s], sf_table[scalefactor[ch][sb][gr / 4]]);
  384.   }
  385. }
  386. else {
  387.   for (s = 0; s < 3; ++s)
  388.     frame->sbsample[ch][3 * gr + s][sb] = 0;
  389. }
  390.       }
  391.     }
  392.     for (sb = bound; sb < sblimit; ++sb) {
  393.       if ((index = allocation[0][sb])) {
  394. index = offset_table[bitalloc_table[offsets[sb]].offset][index - 1];
  395. II_samples(&stream->ptr, &qc_table[index], samples);
  396. for (ch = 0; ch < nch; ++ch) {
  397.   for (s = 0; s < 3; ++s) {
  398.     frame->sbsample[ch][3 * gr + s][sb] =
  399.       mad_f_mul(samples[s], sf_table[scalefactor[ch][sb][gr / 4]]);
  400.   }
  401. }
  402.       }
  403.       else {
  404. for (ch = 0; ch < nch; ++ch) {
  405.   for (s = 0; s < 3; ++s)
  406.     frame->sbsample[ch][3 * gr + s][sb] = 0;
  407. }
  408.       }
  409.     }
  410.     for (ch = 0; ch < nch; ++ch) {
  411.       for (s = 0; s < 3; ++s) {
  412. for (sb = sblimit; sb < 32; ++sb)
  413.   frame->sbsample[ch][3 * gr + s][sb] = 0;
  414.       }
  415.     }
  416.   }
  417.   return 0;
  418. }