wmadec.c
上传用户:wstnjxml
上传日期:2014-04-03
资源大小:7248k
文件大小:42k
源码类别:

Windows CE

开发平台:

C/C++

  1. /*
  2.  * WMA compatible decoder
  3.  * Copyright (c) 2002 The FFmpeg Project.
  4.  *
  5.  * This library is free software; you can redistribute it and/or
  6.  * modify it under the terms of the GNU Lesser General Public
  7.  * License as published by the Free Software Foundation; either
  8.  * version 2 of the License, or (at your option) any later version.
  9.  *
  10.  * This library 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 GNU
  13.  * Lesser General Public License for more details.
  14.  *
  15.  * You should have received a copy of the GNU Lesser General Public
  16.  * License along with this library; if not, write to the Free Software
  17.  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  18.  */
  19. /**
  20.  * @file wmadec.c
  21.  * WMA compatible decoder.
  22.  * This decoder handles Microsoft Windows Media Audio data, versions 1 & 2.
  23.  * WMA v1 is identified by audio format 0x160 in Microsoft media files 
  24.  * (ASF/AVI/WAV). WMA v2 is identified by audio format 0x161.
  25.  *
  26.  * To use this decoder, a calling application must supply the extra data
  27.  * bytes provided with the WMA data. These are the extra, codec-specific
  28.  * bytes at the end of a WAVEFORMATEX data structure. Transmit these bytes 
  29.  * to the decoder using the extradata[_size] fields in AVCodecContext. There 
  30.  * should be 4 extra bytes for v1 data and 6 extra bytes for v2 data.
  31.  */
  32. #include "avcodec.h"
  33. #include "bitstream.h"
  34. #include "dsputil.h"
  35. /* size of blocks */
  36. #define BLOCK_MIN_BITS 7
  37. #define BLOCK_MAX_BITS 11
  38. #define BLOCK_MAX_SIZE (1 << BLOCK_MAX_BITS)
  39. #define BLOCK_NB_SIZES (BLOCK_MAX_BITS - BLOCK_MIN_BITS + 1)
  40. /* XXX: find exact max size */
  41. #define HIGH_BAND_MAX_SIZE 16
  42. #define NB_LSP_COEFS 10
  43. /* XXX: is it a suitable value ? */
  44. #define MAX_CODED_SUPERFRAME_SIZE 16384
  45. #define MAX_CHANNELS 2
  46. #define NOISE_TAB_SIZE 8192
  47. #define LSP_POW_BITS 7
  48. typedef struct WMADecodeContext {
  49.     GetBitContext gb;
  50.     int sample_rate;
  51.     int nb_channels;
  52.     int bit_rate;
  53.     int version; /* 1 = 0x160 (WMAV1), 2 = 0x161 (WMAV2) */
  54.     int block_align;
  55.     int use_bit_reservoir;
  56.     int use_variable_block_len;
  57.     int use_exp_vlc;  /* exponent coding: 0 = lsp, 1 = vlc + delta */
  58.     int use_noise_coding; /* true if perceptual noise is added */
  59.     int byte_offset_bits;
  60.     VLC exp_vlc;
  61.     int exponent_sizes[BLOCK_NB_SIZES];
  62.     uint16_t exponent_bands[BLOCK_NB_SIZES][25];
  63.     int high_band_start[BLOCK_NB_SIZES]; /* index of first coef in high band */
  64.     int coefs_start;               /* first coded coef */
  65.     int coefs_end[BLOCK_NB_SIZES]; /* max number of coded coefficients */
  66.     int exponent_high_sizes[BLOCK_NB_SIZES];
  67.     int exponent_high_bands[BLOCK_NB_SIZES][HIGH_BAND_MAX_SIZE]; 
  68.     VLC hgain_vlc;
  69.     
  70.     /* coded values in high bands */
  71.     int high_band_coded[MAX_CHANNELS][HIGH_BAND_MAX_SIZE];
  72.     int high_band_values[MAX_CHANNELS][HIGH_BAND_MAX_SIZE];
  73.     /* there are two possible tables for spectral coefficients */
  74.     VLC coef_vlc[2];
  75.     uint16_t *run_table[2];
  76.     uint16_t *level_table[2];
  77.     /* frame info */
  78.     int frame_len;       /* frame length in samples */
  79.     int frame_len_bits;  /* frame_len = 1 << frame_len_bits */
  80.     int nb_block_sizes;  /* number of block sizes */
  81.     /* block info */
  82.     int reset_block_lengths;
  83.     int block_len_bits; /* log2 of current block length */
  84.     int next_block_len_bits; /* log2 of next block length */
  85.     int prev_block_len_bits; /* log2 of prev block length */
  86.     int block_len; /* block length in samples */
  87.     int block_num; /* block number in current frame */
  88.     int block_pos; /* current position in frame */
  89.     uint8_t ms_stereo; /* true if mid/side stereo mode */
  90.     uint8_t channel_coded[MAX_CHANNELS]; /* true if channel is coded */
  91.     float exponents[MAX_CHANNELS][BLOCK_MAX_SIZE] __attribute__((aligned(16)));
  92.     float max_exponent[MAX_CHANNELS];
  93.     int16_t coefs1[MAX_CHANNELS][BLOCK_MAX_SIZE];
  94.     float coefs[MAX_CHANNELS][BLOCK_MAX_SIZE] __attribute__((aligned(16)));
  95.     MDCTContext mdct_ctx[BLOCK_NB_SIZES];
  96.     float *windows[BLOCK_NB_SIZES];
  97.     FFTSample mdct_tmp[BLOCK_MAX_SIZE] __attribute__((aligned(16))); /* temporary storage for imdct */
  98.     /* output buffer for one frame and the last for IMDCT windowing */
  99.     float frame_out[MAX_CHANNELS][BLOCK_MAX_SIZE * 2] __attribute__((aligned(16)));
  100.     /* last frame info */
  101.     uint8_t last_superframe[MAX_CODED_SUPERFRAME_SIZE + 4]; /* padding added */
  102.     int last_bitoffset;
  103.     int last_superframe_len;
  104.     float noise_table[NOISE_TAB_SIZE];
  105.     int noise_index;
  106.     float noise_mult; /* XXX: suppress that and integrate it in the noise array */
  107.     /* lsp_to_curve tables */
  108.     float lsp_cos_table[BLOCK_MAX_SIZE];
  109.     float lsp_pow_e_table[256];
  110.     float lsp_pow_m_table1[(1 << LSP_POW_BITS)];
  111.     float lsp_pow_m_table2[(1 << LSP_POW_BITS)];
  112. #ifdef TRACE
  113.     int frame_count;
  114. #endif
  115. } WMADecodeContext;
  116. typedef struct CoefVLCTable {
  117.     int n; /* total number of codes */
  118.     const uint32_t *huffcodes; /* VLC bit values */
  119.     const uint8_t *huffbits;   /* VLC bit size */
  120.     const uint16_t *levels; /* table to build run/level tables */
  121. } CoefVLCTable;
  122. static void wma_lsp_to_curve_init(WMADecodeContext *s, int frame_len);
  123. #include "wmadata.h"
  124. #ifdef TRACE
  125. static void dump_shorts(const char *name, const short *tab, int n)
  126. {
  127.     int i;
  128.     tprintf("%s[%d]:n", name, n);
  129.     for(i=0;i<n;i++) {
  130.         if ((i & 7) == 0)
  131.             tprintf("%4d: ", i);
  132.         tprintf(" %5d.0", tab[i]);
  133.         if ((i & 7) == 7)
  134.             tprintf("n");
  135.     }
  136. }
  137. static void dump_floats(const char *name, int prec, const float *tab, int n)
  138. {
  139.     int i;
  140.     tprintf("%s[%d]:n", name, n);
  141.     for(i=0;i<n;i++) {
  142.         if ((i & 7) == 0)
  143.             tprintf("%4d: ", i);
  144.         tprintf(" %8.*f", prec, tab[i]);
  145.         if ((i & 7) == 7)
  146.             tprintf("n");
  147.     }
  148.     if ((i & 7) != 0)
  149.         tprintf("n");
  150. }
  151. #endif
  152. /* XXX: use same run/length optimization as mpeg decoders */
  153. static void init_coef_vlc(VLC *vlc, 
  154.                           uint16_t **prun_table, uint16_t **plevel_table,
  155.                           const CoefVLCTable *vlc_table)
  156. {
  157.     int n = vlc_table->n;
  158.     const uint8_t *table_bits = vlc_table->huffbits;
  159.     const uint32_t *table_codes = vlc_table->huffcodes;
  160.     const uint16_t *levels_table = vlc_table->levels;
  161.     uint16_t *run_table, *level_table;
  162.     const uint16_t *p;
  163.     int i, l, j, level;
  164.     init_vlc(vlc, 9, n, table_bits, 1, 1, table_codes, 4, 4, 0);
  165.     run_table = av_malloc(n * sizeof(uint16_t));
  166.     level_table = av_malloc(n * sizeof(uint16_t));
  167.     p = levels_table;
  168.     i = 2;
  169.     level = 1;
  170.     while (i < n) {
  171.         l = *p++;
  172.         for(j=0;j<l;j++) {
  173.             run_table[i] = j;
  174.             level_table[i] = level;
  175.             i++;
  176.         }
  177.         level++;
  178.     }
  179.     *prun_table = run_table;
  180.     *plevel_table = level_table;
  181. }
  182. static int wma_decode_init(AVCodecContext * avctx)
  183. {
  184.     WMADecodeContext *s = avctx->priv_data;
  185.     int i, flags1, flags2;
  186.     float *window;
  187.     uint8_t *extradata;
  188.     float bps1, high_freq;
  189.     volatile float bps;
  190.     int sample_rate1;
  191.     int coef_vlc_table;
  192.     
  193.     s->sample_rate = avctx->sample_rate;
  194.     s->nb_channels = avctx->channels;
  195.     s->bit_rate = avctx->bit_rate;
  196.     s->block_align = avctx->block_align;
  197.     if (avctx->codec->id == CODEC_ID_WMAV1) {
  198.         s->version = 1;
  199.     } else {
  200.         s->version = 2;
  201.     }
  202.     
  203.     /* extract flag infos */
  204.     flags1 = 0;
  205.     flags2 = 0;
  206.     extradata = avctx->extradata;
  207.     if (s->version == 1 && avctx->extradata_size >= 4) {
  208.         flags1 = extradata[0] | (extradata[1] << 8);
  209.         flags2 = extradata[2] | (extradata[3] << 8);
  210.     } else if (s->version == 2 && avctx->extradata_size >= 6) {
  211.         flags1 = extradata[0] | (extradata[1] << 8) | 
  212.             (extradata[2] << 16) | (extradata[3] << 24);
  213.         flags2 = extradata[4] | (extradata[5] << 8);
  214.     }
  215.     s->use_exp_vlc = flags2 & 0x0001;
  216.     s->use_bit_reservoir = flags2 & 0x0002;
  217.     s->use_variable_block_len = flags2 & 0x0004;
  218.     /* compute MDCT block size */
  219.     if (s->sample_rate <= 16000) {
  220.         s->frame_len_bits = 9;
  221.     } else if (s->sample_rate <= 22050 || 
  222.                (s->sample_rate <= 32000 && s->version == 1)) {
  223.         s->frame_len_bits = 10;
  224.     } else {
  225.         s->frame_len_bits = 11;
  226.     }
  227.     s->frame_len = 1 << s->frame_len_bits;
  228.     if (s->use_variable_block_len) {
  229.         int nb_max, nb;
  230.         nb = ((flags2 >> 3) & 3) + 1;
  231.         if ((s->bit_rate / s->nb_channels) >= 32000)
  232.             nb += 2;
  233.         nb_max = s->frame_len_bits - BLOCK_MIN_BITS;
  234.         if (nb > nb_max)
  235.             nb = nb_max;
  236.         s->nb_block_sizes = nb + 1;
  237.     } else {
  238.         s->nb_block_sizes = 1;
  239.     }
  240.     /* init rate dependant parameters */
  241.     s->use_noise_coding = 1;
  242.     high_freq = s->sample_rate * 0.5;
  243.     /* if version 2, then the rates are normalized */
  244.     sample_rate1 = s->sample_rate;
  245.     if (s->version == 2) {
  246.         if (sample_rate1 >= 44100) 
  247.             sample_rate1 = 44100;
  248.         else if (sample_rate1 >= 22050) 
  249.             sample_rate1 = 22050;
  250.         else if (sample_rate1 >= 16000) 
  251.             sample_rate1 = 16000;
  252.         else if (sample_rate1 >= 11025) 
  253.             sample_rate1 = 11025;
  254.         else if (sample_rate1 >= 8000) 
  255.             sample_rate1 = 8000;
  256.     }
  257.     bps = (float)s->bit_rate / (float)(s->nb_channels * s->sample_rate);
  258.     s->byte_offset_bits = av_log2((int)(bps * s->frame_len / 8.0)) + 2;
  259.     /* compute high frequency value and choose if noise coding should
  260.        be activated */
  261.     bps1 = bps;
  262.     if (s->nb_channels == 2)
  263.         bps1 = bps * 1.6;
  264.     if (sample_rate1 == 44100) {
  265.         if (bps1 >= 0.61)
  266.             s->use_noise_coding = 0;
  267.         else
  268.             high_freq = high_freq * 0.4;
  269.     } else if (sample_rate1 == 22050) {
  270.         if (bps1 >= 1.16)
  271.             s->use_noise_coding = 0;
  272.         else if (bps1 >= 0.72) 
  273.             high_freq = high_freq * 0.7;
  274.         else
  275.             high_freq = high_freq * 0.6;
  276.     } else if (sample_rate1 == 16000) {
  277.         if (bps > 0.5)
  278.             high_freq = high_freq * 0.5;
  279.         else
  280.             high_freq = high_freq * 0.3;
  281.     } else if (sample_rate1 == 11025) {
  282.         high_freq = high_freq * 0.7;
  283.     } else if (sample_rate1 == 8000) {
  284.         if (bps <= 0.625) {
  285.             high_freq = high_freq * 0.5;
  286.         } else if (bps > 0.75) {
  287.             s->use_noise_coding = 0;
  288.         } else {
  289.             high_freq = high_freq * 0.65;
  290.         }
  291.     } else {
  292.         if (bps >= 0.8) {
  293.             high_freq = high_freq * 0.75;
  294.         } else if (bps >= 0.6) {
  295.             high_freq = high_freq * 0.6;
  296.         } else {
  297.             high_freq = high_freq * 0.5;
  298.         }
  299.     }
  300.     dprintf("flags1=0x%x flags2=0x%xn", flags1, flags2);
  301.     dprintf("version=%d channels=%d sample_rate=%d bitrate=%d block_align=%dn",
  302.            s->version, s->nb_channels, s->sample_rate, s->bit_rate, 
  303.            s->block_align);
  304.     dprintf("bps=%f bps1=%f high_freq=%f bitoffset=%dn", 
  305.            bps, bps1, high_freq, s->byte_offset_bits);
  306.     dprintf("use_noise_coding=%d use_exp_vlc=%d nb_block_sizes=%dn",
  307.            s->use_noise_coding, s->use_exp_vlc, s->nb_block_sizes);
  308.     /* compute the scale factor band sizes for each MDCT block size */
  309.     {
  310.         int a, b, pos, lpos, k, block_len, i, j, n;
  311.         const uint8_t *table;
  312.         
  313.         if (s->version == 1) {
  314.             s->coefs_start = 3;
  315.         } else {
  316.             s->coefs_start = 0;
  317.         }
  318.         for(k = 0; k < s->nb_block_sizes; k++) {
  319.             block_len = s->frame_len >> k;
  320.             if (s->version == 1) {
  321.                 lpos = 0;
  322.                 for(i=0;i<25;i++) {
  323.                     a = wma_critical_freqs[i];
  324.                     b = s->sample_rate;
  325.                     pos = ((block_len * 2 * a)  + (b >> 1)) / b;
  326.                     if (pos > block_len) 
  327.                         pos = block_len;
  328.                     s->exponent_bands[0][i] = pos - lpos;
  329.                     if (pos >= block_len) {
  330.                         i++;
  331.                         break;
  332.                     }
  333.                     lpos = pos;
  334.                 }
  335.                 s->exponent_sizes[0] = i;
  336.             } else {
  337.                 /* hardcoded tables */
  338.                 table = NULL;
  339.                 a = s->frame_len_bits - BLOCK_MIN_BITS - k;
  340.                 if (a < 3) {
  341.                     if (s->sample_rate >= 44100)
  342.                         table = exponent_band_44100[a];
  343.                     else if (s->sample_rate >= 32000)
  344.                         table = exponent_band_32000[a];
  345.                     else if (s->sample_rate >= 22050)
  346.                         table = exponent_band_22050[a];
  347.                 }
  348.                 if (table) {
  349.                     n = *table++;
  350.                     for(i=0;i<n;i++)
  351.                         s->exponent_bands[k][i] = table[i];
  352.                     s->exponent_sizes[k] = n;
  353.                 } else {
  354.                     j = 0;
  355.                     lpos = 0;
  356.                     for(i=0;i<25;i++) {
  357.                         a = wma_critical_freqs[i];
  358.                         b = s->sample_rate;
  359.                         pos = ((block_len * 2 * a)  + (b << 1)) / (4 * b);
  360.                         pos <<= 2;
  361.                         if (pos > block_len) 
  362.                             pos = block_len;
  363.                         if (pos > lpos)
  364.                             s->exponent_bands[k][j++] = pos - lpos;
  365.                         if (pos >= block_len)
  366.                             break;
  367.                         lpos = pos;
  368.                     }
  369.                     s->exponent_sizes[k] = j;
  370.                 }
  371.             }
  372.             /* max number of coefs */
  373.             s->coefs_end[k] = (s->frame_len - ((s->frame_len * 9) / 100)) >> k;
  374.             /* high freq computation */
  375.             s->high_band_start[k] = (int)((block_len * 2 * high_freq) / 
  376.                                           s->sample_rate + 0.5);
  377.             n = s->exponent_sizes[k];
  378.             j = 0;
  379.             pos = 0;
  380.             for(i=0;i<n;i++) {
  381.                 int start, end;
  382.                 start = pos;
  383.                 pos += s->exponent_bands[k][i];
  384.                 end = pos;
  385.                 if (start < s->high_band_start[k])
  386.                     start = s->high_band_start[k];
  387.                 if (end > s->coefs_end[k])
  388.                     end = s->coefs_end[k];
  389.                 if (end > start)
  390.                     s->exponent_high_bands[k][j++] = end - start;
  391.             }
  392.             s->exponent_high_sizes[k] = j;
  393. #if 0
  394.             tprintf("%5d: coefs_end=%d high_band_start=%d nb_high_bands=%d: ",
  395.                   s->frame_len >> k, 
  396.                   s->coefs_end[k],
  397.                   s->high_band_start[k],
  398.                   s->exponent_high_sizes[k]);
  399.             for(j=0;j<s->exponent_high_sizes[k];j++)
  400.                 tprintf(" %d", s->exponent_high_bands[k][j]);
  401.             tprintf("n");
  402. #endif
  403.         }
  404.     }
  405. #ifdef TRACE
  406.     {
  407.         int i, j;
  408.         for(i = 0; i < s->nb_block_sizes; i++) {
  409.             tprintf("%5d: n=%2d:", 
  410.                    s->frame_len >> i, 
  411.                    s->exponent_sizes[i]);
  412.             for(j=0;j<s->exponent_sizes[i];j++)
  413.                 tprintf(" %d", s->exponent_bands[i][j]);
  414.             tprintf("n");
  415.         }
  416.     }
  417. #endif
  418.     /* init MDCT */
  419.     for(i = 0; i < s->nb_block_sizes; i++)
  420.         ff_mdct_init(&s->mdct_ctx[i], s->frame_len_bits - i + 1, 1);
  421.     
  422.     /* init MDCT windows : simple sinus window */
  423.     for(i = 0; i < s->nb_block_sizes; i++) {
  424.         int n, j;
  425.         float alpha;
  426.         n = 1 << (s->frame_len_bits - i);
  427.         window = av_malloc(sizeof(float) * n);
  428.         alpha = M_PI / (2.0 * n);
  429.         for(j=0;j<n;j++) {
  430.             window[n - j - 1] = sin((j + 0.5) * alpha);
  431.         }
  432.         s->windows[i] = window;
  433.     }
  434.     s->reset_block_lengths = 1;
  435.     
  436.     if (s->use_noise_coding) {
  437.         /* init the noise generator */
  438.         if (s->use_exp_vlc)
  439.             s->noise_mult = 0.02;
  440.         else
  441.             s->noise_mult = 0.04;
  442.                
  443. #ifdef TRACE
  444.         for(i=0;i<NOISE_TAB_SIZE;i++)
  445.             s->noise_table[i] = 1.0 * s->noise_mult;
  446. #else
  447.         {
  448.             unsigned int seed;
  449.             float norm;
  450.             seed = 1;
  451.             norm = (1.0 / (float)(1LL << 31)) * sqrt(3) * s->noise_mult;
  452.             for(i=0;i<NOISE_TAB_SIZE;i++) {
  453.                 seed = seed * 314159 + 1;
  454.                 s->noise_table[i] = (float)((int)seed) * norm;
  455.             }
  456.         }
  457. #endif
  458.         init_vlc(&s->hgain_vlc, 9, sizeof(hgain_huffbits), 
  459.                  hgain_huffbits, 1, 1,
  460.                  hgain_huffcodes, 2, 2, 0);
  461.     }
  462.     if (s->use_exp_vlc) {
  463.         init_vlc(&s->exp_vlc, 9, sizeof(scale_huffbits), 
  464.                  scale_huffbits, 1, 1,
  465.                  scale_huffcodes, 4, 4, 0);
  466.     } else {
  467.         wma_lsp_to_curve_init(s, s->frame_len);
  468.     }
  469.     /* choose the VLC tables for the coefficients */
  470.     coef_vlc_table = 2;
  471.     if (s->sample_rate >= 32000) {
  472.         if (bps1 < 0.72)
  473.             coef_vlc_table = 0;
  474.         else if (bps1 < 1.16)
  475.             coef_vlc_table = 1;
  476.     }
  477.     init_coef_vlc(&s->coef_vlc[0], &s->run_table[0], &s->level_table[0],
  478.                   &coef_vlcs[coef_vlc_table * 2]);
  479.     init_coef_vlc(&s->coef_vlc[1], &s->run_table[1], &s->level_table[1],
  480.                   &coef_vlcs[coef_vlc_table * 2 + 1]);
  481.     return 0;
  482. }
  483. /* interpolate values for a bigger or smaller block. The block must
  484.    have multiple sizes */
  485. static void interpolate_array(float *scale, int old_size, int new_size)
  486. {
  487.     int i, j, jincr, k;
  488.     float v;
  489.     if (new_size > old_size) {
  490.         jincr = new_size / old_size;
  491.         j = new_size;
  492.         for(i = old_size - 1; i >=0; i--) {
  493.             v = scale[i];
  494.             k = jincr;
  495.             do {
  496.                 scale[--j] = v;
  497.             } while (--k);
  498.         }
  499.     } else if (new_size < old_size) {
  500.         j = 0;
  501.         jincr = old_size / new_size;
  502.         for(i = 0; i < new_size; i++) {
  503.             scale[i] = scale[j];
  504.             j += jincr;
  505.         }
  506.     }
  507. }
  508. /* compute x^-0.25 with an exponent and mantissa table. We use linear
  509.    interpolation to reduce the mantissa table size at a small speed
  510.    expense (linear interpolation approximately doubles the number of
  511.    bits of precision). */
  512. static inline float pow_m1_4(WMADecodeContext *s, float x)
  513. {
  514.     union {
  515.         float f;
  516.         unsigned int v;
  517.     } u, t;
  518.     unsigned int e, m;
  519.     float a, b;
  520.     u.f = x;
  521.     e = u.v >> 23;
  522.     m = (u.v >> (23 - LSP_POW_BITS)) & ((1 << LSP_POW_BITS) - 1);
  523.     /* build interpolation scale: 1 <= t < 2. */
  524.     t.v = ((u.v << LSP_POW_BITS) & ((1 << 23) - 1)) | (127 << 23);
  525.     a = s->lsp_pow_m_table1[m];
  526.     b = s->lsp_pow_m_table2[m];
  527.     return s->lsp_pow_e_table[e] * (a + b * t.f);
  528. }
  529. static void wma_lsp_to_curve_init(WMADecodeContext *s, int frame_len)
  530. {  
  531.     float wdel, a, b;
  532.     int i, e, m;
  533.     wdel = M_PI / frame_len;
  534.     for(i=0;i<frame_len;i++)
  535.         s->lsp_cos_table[i] = 2.0f * cos(wdel * i);
  536.     /* tables for x^-0.25 computation */
  537.     for(i=0;i<256;i++) {
  538.         e = i - 126;
  539.         s->lsp_pow_e_table[i] = pow(2.0, e * -0.25);
  540.     }
  541.     /* NOTE: these two tables are needed to avoid two operations in
  542.        pow_m1_4 */
  543.     b = 1.0;
  544.     for(i=(1 << LSP_POW_BITS) - 1;i>=0;i--) {
  545.         m = (1 << LSP_POW_BITS) + i;
  546.         a = (float)m * (0.5 / (1 << LSP_POW_BITS));
  547.         a = pow(a, -0.25);
  548.         s->lsp_pow_m_table1[i] = 2 * a - b;
  549.         s->lsp_pow_m_table2[i] = b - a;
  550.         b = a;
  551.     }
  552. #if 0
  553.     for(i=1;i<20;i++) {
  554.         float v, r1, r2;
  555.         v = 5.0 / i;
  556.         r1 = pow_m1_4(s, v);
  557.         r2 = pow(v,-0.25);
  558.         printf("%f^-0.25=%f e=%fn", v, r1, r2 - r1);
  559.     }
  560. #endif
  561. }
  562. /* NOTE: We use the same code as Vorbis here */
  563. /* XXX: optimize it further with SSE/3Dnow */
  564. static void wma_lsp_to_curve(WMADecodeContext *s, 
  565.                              float *out, float *val_max_ptr, 
  566.                              int n, float *lsp)
  567. {
  568.     int i, j;
  569.     float p, q, w, v, val_max;
  570.     val_max = 0;
  571.     for(i=0;i<n;i++) {
  572.         p = 0.5f;
  573.         q = 0.5f;
  574.         w = s->lsp_cos_table[i];
  575.         for(j=1;j<NB_LSP_COEFS;j+=2){
  576.             q *= w - lsp[j - 1];
  577.             p *= w - lsp[j];
  578.         }
  579.         p *= p * (2.0f - w);
  580.         q *= q * (2.0f + w);
  581.         v = p + q;
  582.         v = pow_m1_4(s, v);
  583.         if (v > val_max)
  584.             val_max = v;
  585.         out[i] = v;
  586.     }
  587.     *val_max_ptr = val_max;
  588. }
  589. /* decode exponents coded with LSP coefficients (same idea as Vorbis) */
  590. static void decode_exp_lsp(WMADecodeContext *s, int ch)
  591. {
  592.     float lsp_coefs[NB_LSP_COEFS];
  593.     int val, i;
  594.     for(i = 0; i < NB_LSP_COEFS; i++) {
  595.         if (i == 0 || i >= 8)
  596.             val = get_bits(&s->gb, 3);
  597.         else
  598.             val = get_bits(&s->gb, 4);
  599.         lsp_coefs[i] = lsp_codebook[i][val];
  600.     }
  601.     wma_lsp_to_curve(s, s->exponents[ch], &s->max_exponent[ch],
  602.                      s->block_len, lsp_coefs);
  603. }
  604. /* decode exponents coded with VLC codes */
  605. static int decode_exp_vlc(WMADecodeContext *s, int ch)
  606. {
  607.     int last_exp, n, code;
  608.     const uint16_t *ptr, *band_ptr;
  609.     float v, *q, max_scale, *q_end;
  610.     
  611.     band_ptr = s->exponent_bands[s->frame_len_bits - s->block_len_bits];
  612.     ptr = band_ptr;
  613.     q = s->exponents[ch];
  614.     q_end = q + s->block_len;
  615.     max_scale = 0;
  616.     if (s->version == 1) {
  617.         last_exp = get_bits(&s->gb, 5) + 10;
  618.         /* XXX: use a table */
  619.         v = pow(10, last_exp * (1.0 / 16.0));
  620.         max_scale = v;
  621.         n = *ptr++;
  622.         do {
  623.             *q++ = v;
  624.         } while (--n);
  625.     }
  626.     last_exp = 36;
  627.     while (q < q_end) {
  628.         code = get_vlc(&s->gb, &s->exp_vlc);
  629.         if (code < 0)
  630.             return -1;
  631.         /* NOTE: this offset is the same as MPEG4 AAC ! */
  632.         last_exp += code - 60;
  633.         /* XXX: use a table */
  634.         v = pow(10, last_exp * (1.0 / 16.0));
  635.         if (v > max_scale)
  636.             max_scale = v;
  637.         n = *ptr++;
  638.         do {
  639.             *q++ = v;
  640.         } while (--n);
  641.     }
  642.     s->max_exponent[ch] = max_scale;
  643.     return 0;
  644. }
  645. /* return 0 if OK. return 1 if last block of frame. return -1 if
  646.    unrecorrable error. */
  647. static int wma_decode_block(WMADecodeContext *s)
  648. {
  649.     int n, v, a, ch, code, bsize;
  650.     int coef_nb_bits, total_gain, parse_exponents;
  651.     float window[BLOCK_MAX_SIZE * 2];
  652. // XXX: FIXME!! there's a bug somewhere which makes this mandatory under altivec
  653. #ifdef HAVE_ALTIVEC
  654.     volatile int nb_coefs[MAX_CHANNELS] __attribute__((aligned(16)));
  655. #else
  656.     int nb_coefs[MAX_CHANNELS];
  657. #endif
  658.     float mdct_norm;
  659. #ifdef TRACE
  660.     tprintf("***decode_block: %d:%dn", s->frame_count - 1, s->block_num);
  661. #endif
  662.     /* compute current block length */
  663.     if (s->use_variable_block_len) {
  664.         n = av_log2(s->nb_block_sizes - 1) + 1;
  665.     
  666.         if (s->reset_block_lengths) {
  667.             s->reset_block_lengths = 0;
  668.             v = get_bits(&s->gb, n);
  669.             if (v >= s->nb_block_sizes)
  670.                 return -1;
  671.             s->prev_block_len_bits = s->frame_len_bits - v;
  672.             v = get_bits(&s->gb, n);
  673.             if (v >= s->nb_block_sizes)
  674.                 return -1;
  675.             s->block_len_bits = s->frame_len_bits - v;
  676.         } else {
  677.             /* update block lengths */
  678.             s->prev_block_len_bits = s->block_len_bits;
  679.             s->block_len_bits = s->next_block_len_bits;
  680.         }
  681.         v = get_bits(&s->gb, n);
  682.         if (v >= s->nb_block_sizes)
  683.             return -1;
  684.         s->next_block_len_bits = s->frame_len_bits - v;
  685.     } else {
  686.         /* fixed block len */
  687.         s->next_block_len_bits = s->frame_len_bits;
  688.         s->prev_block_len_bits = s->frame_len_bits;
  689.         s->block_len_bits = s->frame_len_bits;
  690.     }
  691.     /* now check if the block length is coherent with the frame length */
  692.     s->block_len = 1 << s->block_len_bits;
  693.     if ((s->block_pos + s->block_len) > s->frame_len)
  694.         return -1;
  695.     if (s->nb_channels == 2) {
  696.         s->ms_stereo = get_bits(&s->gb, 1);
  697.     }
  698.     v = 0;
  699.     for(ch = 0; ch < s->nb_channels; ch++) {
  700.         a = get_bits(&s->gb, 1);
  701.         s->channel_coded[ch] = a;
  702.         v |= a;
  703.     }
  704.     /* if no channel coded, no need to go further */
  705.     /* XXX: fix potential framing problems */
  706.     if (!v)
  707.         goto next;
  708.     bsize = s->frame_len_bits - s->block_len_bits;
  709.     /* read total gain and extract corresponding number of bits for
  710.        coef escape coding */
  711.     total_gain = 1;
  712.     for(;;) {
  713.         a = get_bits(&s->gb, 7);
  714.         total_gain += a;
  715.         if (a != 127)
  716.             break;
  717.     }
  718.     
  719.     if (total_gain < 15)
  720.         coef_nb_bits = 13;
  721.     else if (total_gain < 32)
  722.         coef_nb_bits = 12;
  723.     else if (total_gain < 40)
  724.         coef_nb_bits = 11;
  725.     else if (total_gain < 45)
  726.         coef_nb_bits = 10;
  727.     else
  728.         coef_nb_bits = 9;
  729.     /* compute number of coefficients */
  730.     n = s->coefs_end[bsize] - s->coefs_start;
  731.     for(ch = 0; ch < s->nb_channels; ch++)
  732.         nb_coefs[ch] = n;
  733.     /* complex coding */
  734.     if (s->use_noise_coding) {
  735.         for(ch = 0; ch < s->nb_channels; ch++) {
  736.             if (s->channel_coded[ch]) {
  737.                 int i, n, a;
  738.                 n = s->exponent_high_sizes[bsize];
  739.                 for(i=0;i<n;i++) {
  740.                     a = get_bits(&s->gb, 1);
  741.                     s->high_band_coded[ch][i] = a;
  742.                     /* if noise coding, the coefficients are not transmitted */
  743.                     if (a)
  744.                         nb_coefs[ch] -= s->exponent_high_bands[bsize][i];
  745.                 }
  746.             }
  747.         }
  748.         for(ch = 0; ch < s->nb_channels; ch++) {
  749.             if (s->channel_coded[ch]) {
  750.                 int i, n, val, code;
  751.                 n = s->exponent_high_sizes[bsize];
  752.                 val = (int)0x80000000;
  753.                 for(i=0;i<n;i++) {
  754.                     if (s->high_band_coded[ch][i]) {
  755.                         if (val == (int)0x80000000) {
  756.                             val = get_bits(&s->gb, 7) - 19;
  757.                         } else {
  758.                             code = get_vlc(&s->gb, &s->hgain_vlc);
  759.                             if (code < 0)
  760.                                 return -1;
  761.                             val += code - 18;
  762.                         }
  763.                         s->high_band_values[ch][i] = val;
  764.                     }
  765.                 }
  766.             }
  767.         }
  768.     }
  769.            
  770.     /* exposant can be interpolated in short blocks. */
  771.     parse_exponents = 1;
  772.     if (s->block_len_bits != s->frame_len_bits) {
  773.         parse_exponents = get_bits(&s->gb, 1);
  774.     }
  775.     
  776.     if (parse_exponents) {
  777.         for(ch = 0; ch < s->nb_channels; ch++) {
  778.             if (s->channel_coded[ch]) {
  779.                 if (s->use_exp_vlc) {
  780.                     if (decode_exp_vlc(s, ch) < 0)
  781.                         return -1;
  782.                 } else {
  783.                     decode_exp_lsp(s, ch);
  784.                 }
  785.             }
  786.         }
  787.     } else {
  788.         for(ch = 0; ch < s->nb_channels; ch++) {
  789.             if (s->channel_coded[ch]) {
  790.                 interpolate_array(s->exponents[ch], 1 << s->prev_block_len_bits, 
  791.                                   s->block_len);
  792.             }
  793.         }
  794.     }
  795.     /* parse spectral coefficients : just RLE encoding */
  796.     for(ch = 0; ch < s->nb_channels; ch++) {
  797.         if (s->channel_coded[ch]) {
  798.             VLC *coef_vlc;
  799.             int level, run, sign, tindex;
  800.             int16_t *ptr, *eptr;
  801.             const int16_t *level_table, *run_table;
  802.             /* special VLC tables are used for ms stereo because
  803.                there is potentially less energy there */
  804.             tindex = (ch == 1 && s->ms_stereo);
  805.             coef_vlc = &s->coef_vlc[tindex];
  806.             run_table = s->run_table[tindex];
  807.             level_table = s->level_table[tindex];
  808.             /* XXX: optimize */
  809.             ptr = &s->coefs1[ch][0];
  810.             eptr = ptr + nb_coefs[ch];
  811.             memset(ptr, 0, s->block_len * sizeof(int16_t));
  812.             for(;;) {
  813.                 code = get_vlc(&s->gb, coef_vlc);
  814.                 if (code < 0)
  815.                     return -1;
  816.                 if (code == 1) {
  817.                     /* EOB */
  818.                     break;
  819.                 } else if (code == 0) {
  820.                     /* escape */
  821.                     level = get_bits(&s->gb, coef_nb_bits);
  822.                     /* NOTE: this is rather suboptimal. reading
  823.                        block_len_bits would be better */
  824.                     run = get_bits(&s->gb, s->frame_len_bits);
  825.                 } else {
  826.                     /* normal code */
  827.                     run = run_table[code];
  828.                     level = level_table[code];
  829.                 }
  830.                 sign = get_bits(&s->gb, 1);
  831.                 if (!sign)
  832.                     level = -level;
  833.                 ptr += run;
  834.                 if (ptr >= eptr)
  835.                     return -1;
  836.                 *ptr++ = level;
  837.                 /* NOTE: EOB can be omitted */
  838.                 if (ptr >= eptr)
  839.                     break;
  840.             }
  841.         }
  842.         if (s->version == 1 && s->nb_channels >= 2) {
  843.             align_get_bits(&s->gb);
  844.         }
  845.     }
  846.      
  847.     /* normalize */
  848.     {
  849.         int n4 = s->block_len / 2;
  850.         mdct_norm = 1.0 / (float)n4;
  851.         if (s->version == 1) {
  852.             mdct_norm *= sqrt(n4);
  853.         }
  854.     }
  855.     /* finally compute the MDCT coefficients */
  856.     for(ch = 0; ch < s->nb_channels; ch++) {
  857.         if (s->channel_coded[ch]) {
  858.             int16_t *coefs1;
  859.             float *coefs, *exponents, mult, mult1, noise, *exp_ptr;
  860.             int i, j, n, n1, last_high_band;
  861.             float exp_power[HIGH_BAND_MAX_SIZE];
  862.             coefs1 = s->coefs1[ch];
  863.             exponents = s->exponents[ch];
  864.             mult = pow(10, total_gain * 0.05) / s->max_exponent[ch];
  865.             mult *= mdct_norm;
  866.             coefs = s->coefs[ch];
  867.             if (s->use_noise_coding) {
  868.                 mult1 = mult;
  869.                 /* very low freqs : noise */
  870.                 for(i = 0;i < s->coefs_start; i++) {
  871.                     *coefs++ = s->noise_table[s->noise_index] * (*exponents++) * mult1;
  872.                     s->noise_index = (s->noise_index + 1) & (NOISE_TAB_SIZE - 1);
  873.                 }
  874.                 
  875.                 n1 = s->exponent_high_sizes[bsize];
  876.                 /* compute power of high bands */
  877.                 exp_ptr = exponents + 
  878.                     s->high_band_start[bsize] - 
  879.                     s->coefs_start;
  880.                 last_high_band = 0; /* avoid warning */
  881.                 for(j=0;j<n1;j++) {
  882.                     n = s->exponent_high_bands[s->frame_len_bits - 
  883.                                               s->block_len_bits][j];
  884.                     if (s->high_band_coded[ch][j]) {
  885.                         float e2, v;
  886.                         e2 = 0;
  887.                         for(i = 0;i < n; i++) {
  888.                             v = exp_ptr[i];
  889.                             e2 += v * v;
  890.                         }
  891.                         exp_power[j] = e2 / n;
  892.                         last_high_band = j;
  893.                         tprintf("%d: power=%f (%d)n", j, exp_power[j], n);
  894.                     }
  895.                     exp_ptr += n;
  896.                 }
  897.                 /* main freqs and high freqs */
  898.                 for(j=-1;j<n1;j++) {
  899.                     if (j < 0) {
  900.                         n = s->high_band_start[bsize] - 
  901.                             s->coefs_start;
  902.                     } else {
  903.                         n = s->exponent_high_bands[s->frame_len_bits - 
  904.                                                   s->block_len_bits][j];
  905.                     }
  906.                     if (j >= 0 && s->high_band_coded[ch][j]) {
  907.                         /* use noise with specified power */
  908.                         mult1 = sqrt(exp_power[j] / exp_power[last_high_band]);
  909.                         /* XXX: use a table */
  910.                         mult1 = mult1 * pow(10, s->high_band_values[ch][j] * 0.05);
  911.                         mult1 = mult1 / (s->max_exponent[ch] * s->noise_mult);
  912.                         mult1 *= mdct_norm;
  913.                         for(i = 0;i < n; i++) {
  914.                             noise = s->noise_table[s->noise_index];
  915.                             s->noise_index = (s->noise_index + 1) & (NOISE_TAB_SIZE - 1);
  916.                             *coefs++ = (*exponents++) * noise * mult1;
  917.                         }
  918.                     } else {
  919.                         /* coded values + small noise */
  920.                         for(i = 0;i < n; i++) {
  921.                             noise = s->noise_table[s->noise_index];
  922.                             s->noise_index = (s->noise_index + 1) & (NOISE_TAB_SIZE - 1);
  923.                             *coefs++ = ((*coefs1++) + noise) * (*exponents++) * mult;
  924.                         }
  925.                     }
  926.                 }
  927.                 /* very high freqs : noise */
  928.                 n = s->block_len - s->coefs_end[bsize];
  929.                 mult1 = mult * exponents[-1];
  930.                 for(i = 0; i < n; i++) {
  931.                     *coefs++ = s->noise_table[s->noise_index] * mult1;
  932.                     s->noise_index = (s->noise_index + 1) & (NOISE_TAB_SIZE - 1);
  933.                 }
  934.             } else {
  935.                 /* XXX: optimize more */
  936.                 for(i = 0;i < s->coefs_start; i++)
  937.                     *coefs++ = 0.0;
  938.                 n = nb_coefs[ch];
  939.                 for(i = 0;i < n; i++) {
  940.                     *coefs++ = coefs1[i] * exponents[i] * mult;
  941.                 }
  942.                 n = s->block_len - s->coefs_end[bsize];
  943.                 for(i = 0;i < n; i++)
  944.                     *coefs++ = 0.0;
  945.             }
  946.         }
  947.     }
  948. #ifdef TRACE
  949.     for(ch = 0; ch < s->nb_channels; ch++) {
  950.         if (s->channel_coded[ch]) {
  951.             dump_floats("exponents", 3, s->exponents[ch], s->block_len);
  952.             dump_floats("coefs", 1, s->coefs[ch], s->block_len);
  953.         }
  954.     }
  955. #endif
  956.     
  957.     if (s->ms_stereo && s->channel_coded[1]) {
  958.         float a, b;
  959.         int i;
  960.         /* nominal case for ms stereo: we do it before mdct */
  961.         /* no need to optimize this case because it should almost
  962.            never happen */
  963.         if (!s->channel_coded[0]) {
  964.             tprintf("rare ms-stereo case happenedn");
  965.             memset(s->coefs[0], 0, sizeof(float) * s->block_len);
  966.             s->channel_coded[0] = 1;
  967.         }
  968.         
  969.         for(i = 0; i < s->block_len; i++) {
  970.             a = s->coefs[0][i];
  971.             b = s->coefs[1][i];
  972.             s->coefs[0][i] = a + b;
  973.             s->coefs[1][i] = a - b;
  974.         }
  975.     }
  976.     /* build the window : we ensure that when the windows overlap
  977.        their squared sum is always 1 (MDCT reconstruction rule) */
  978.     /* XXX: merge with output */
  979.     {
  980.         int i, next_block_len, block_len, prev_block_len, n;
  981.         float *wptr;
  982.         block_len = s->block_len;
  983.         prev_block_len = 1 << s->prev_block_len_bits;
  984.         next_block_len = 1 << s->next_block_len_bits;
  985.         /* right part */
  986.         wptr = window + block_len;
  987.         if (block_len <= next_block_len) {
  988.             for(i=0;i<block_len;i++)
  989.                 *wptr++ = s->windows[bsize][i];
  990.         } else {
  991.             /* overlap */
  992.             n = (block_len / 2) - (next_block_len / 2);
  993.             for(i=0;i<n;i++)
  994.                 *wptr++ = 1.0;
  995.             for(i=0;i<next_block_len;i++)
  996.                 *wptr++ = s->windows[s->frame_len_bits - s->next_block_len_bits][i];
  997.             for(i=0;i<n;i++)
  998.                 *wptr++ = 0.0;
  999.         }
  1000.         /* left part */
  1001.         wptr = window + block_len;
  1002.         if (block_len <= prev_block_len) {
  1003.             for(i=0;i<block_len;i++)
  1004.                 *--wptr = s->windows[bsize][i];
  1005.         } else {
  1006.             /* overlap */
  1007.             n = (block_len / 2) - (prev_block_len / 2);
  1008.             for(i=0;i<n;i++)
  1009.                 *--wptr = 1.0;
  1010.             for(i=0;i<prev_block_len;i++)
  1011.                 *--wptr = s->windows[s->frame_len_bits - s->prev_block_len_bits][i];
  1012.             for(i=0;i<n;i++)
  1013.                 *--wptr = 0.0;
  1014.         }
  1015.     }
  1016.     
  1017.     for(ch = 0; ch < s->nb_channels; ch++) {
  1018.         if (s->channel_coded[ch]) {
  1019.             FFTSample output[BLOCK_MAX_SIZE * 2] __attribute__((aligned(16)));
  1020.             float *ptr;
  1021.             int i, n4, index, n;
  1022.             n = s->block_len;
  1023.             n4 = s->block_len / 2;
  1024.             ff_imdct_calc(&s->mdct_ctx[bsize], 
  1025.                           output, s->coefs[ch], s->mdct_tmp);
  1026.             /* XXX: optimize all that by build the window and
  1027.                multipying/adding at the same time */
  1028.             /* multiply by the window */
  1029.             for(i=0;i<n * 2;i++) {
  1030.                 output[i] *= window[i];
  1031.             }
  1032.             /* add in the frame */
  1033.             index = (s->frame_len / 2) + s->block_pos - n4;
  1034.             ptr = &s->frame_out[ch][index];
  1035.             for(i=0;i<n * 2;i++) {
  1036.                 *ptr += output[i];
  1037.                 ptr++;
  1038.             }
  1039.             /* specific fast case for ms-stereo : add to second
  1040.                channel if it is not coded */
  1041.             if (s->ms_stereo && !s->channel_coded[1]) {
  1042.                 ptr = &s->frame_out[1][index];
  1043.                 for(i=0;i<n * 2;i++) {
  1044.                     *ptr += output[i];
  1045.                     ptr++;
  1046.                 }
  1047.             }
  1048.         }
  1049.     }
  1050.  next:
  1051.     /* update block number */
  1052.     s->block_num++;
  1053.     s->block_pos += s->block_len;
  1054.     if (s->block_pos >= s->frame_len)
  1055.         return 1;
  1056.     else
  1057.         return 0;
  1058. }
  1059. /* decode a frame of frame_len samples */
  1060. static int wma_decode_frame(WMADecodeContext *s, int16_t *samples)
  1061. {
  1062.     int ret, i, n, a, ch, incr;
  1063.     int16_t *ptr;
  1064.     float *iptr;
  1065. #ifdef TRACE
  1066.     tprintf("***decode_frame: %d size=%dn", s->frame_count++, s->frame_len);
  1067. #endif
  1068.     /* read each block */
  1069.     s->block_num = 0;
  1070.     s->block_pos = 0;
  1071.     for(;;) {
  1072.         ret = wma_decode_block(s);
  1073.         if (ret < 0) 
  1074.             return -1;
  1075.         if (ret)
  1076.             break;
  1077.     }
  1078.     /* convert frame to integer */
  1079.     n = s->frame_len;
  1080.     incr = s->nb_channels;
  1081.     for(ch = 0; ch < s->nb_channels; ch++) {
  1082.         ptr = samples + ch;
  1083.         iptr = s->frame_out[ch];
  1084.         for(i=0;i<n;i++) {
  1085.             a = lrintf(*iptr++);
  1086.             if (a > 32767)
  1087.                 a = 32767;
  1088.             else if (a < -32768)
  1089.                 a = -32768;
  1090.             *ptr = a;
  1091.             ptr += incr;
  1092.         }
  1093.         /* prepare for next block */
  1094.         memmove(&s->frame_out[ch][0], &s->frame_out[ch][s->frame_len],
  1095.                 s->frame_len * sizeof(float));
  1096.         /* XXX: suppress this */
  1097.         memset(&s->frame_out[ch][s->frame_len], 0, 
  1098.                s->frame_len * sizeof(float));
  1099.     }
  1100. #ifdef TRACE
  1101.     dump_shorts("samples", samples, n * s->nb_channels);
  1102. #endif
  1103.     return 0;
  1104. }
  1105. static int wma_decode_superframe(AVCodecContext *avctx, 
  1106.                                  void *data, int *data_size,
  1107.                                  uint8_t *buf, int buf_size)
  1108. {
  1109.     WMADecodeContext *s = avctx->priv_data;
  1110.     int nb_frames, bit_offset, i, pos, len;
  1111.     uint8_t *q;
  1112.     int16_t *samples;
  1113.     
  1114.     tprintf("***decode_superframe:n");
  1115.     if(buf_size==0){
  1116.         s->last_superframe_len = 0;
  1117.         return 0;
  1118.     }
  1119.     
  1120.     samples = data;
  1121.     init_get_bits(&s->gb, buf, buf_size*8);
  1122.     
  1123.     if (s->use_bit_reservoir) {
  1124.         /* read super frame header */
  1125.         get_bits(&s->gb, 4); /* super frame index */
  1126.         nb_frames = get_bits(&s->gb, 4) - 1;
  1127.         bit_offset = get_bits(&s->gb, s->byte_offset_bits + 3);
  1128.         if (s->last_superframe_len > 0) {
  1129.             //        printf("skip=%dn", s->last_bitoffset);
  1130.             /* add bit_offset bits to last frame */
  1131.             if ((s->last_superframe_len + ((bit_offset + 7) >> 3)) > 
  1132.                 MAX_CODED_SUPERFRAME_SIZE)
  1133.                 goto fail;
  1134.             q = s->last_superframe + s->last_superframe_len;
  1135.             len = bit_offset;
  1136.             while (len > 0) {
  1137.                 *q++ = (get_bits)(&s->gb, 8);
  1138.                 len -= 8;
  1139.             }
  1140.             if (len > 0) {
  1141.                 *q++ = (get_bits)(&s->gb, len) << (8 - len);
  1142.             }
  1143.             
  1144.             /* XXX: bit_offset bits into last frame */
  1145.             init_get_bits(&s->gb, s->last_superframe, MAX_CODED_SUPERFRAME_SIZE*8);
  1146.             /* skip unused bits */
  1147.             if (s->last_bitoffset > 0)
  1148.                 skip_bits(&s->gb, s->last_bitoffset);
  1149.             /* this frame is stored in the last superframe and in the
  1150.                current one */
  1151.             if (wma_decode_frame(s, samples) < 0)
  1152.                 goto fail;
  1153.             samples += s->nb_channels * s->frame_len;
  1154.         }
  1155.         /* read each frame starting from bit_offset */
  1156.         pos = bit_offset + 4 + 4 + s->byte_offset_bits + 3;
  1157.         init_get_bits(&s->gb, buf + (pos >> 3), (MAX_CODED_SUPERFRAME_SIZE - (pos >> 3))*8);
  1158.         len = pos & 7;
  1159.         if (len > 0)
  1160.             skip_bits(&s->gb, len);
  1161.     
  1162.         s->reset_block_lengths = 1;
  1163.         for(i=0;i<nb_frames;i++) {
  1164.             if (wma_decode_frame(s, samples) < 0)
  1165.                 goto fail;
  1166.             samples += s->nb_channels * s->frame_len;
  1167.         }
  1168.         /* we copy the end of the frame in the last frame buffer */
  1169.         pos = get_bits_count(&s->gb) + ((bit_offset + 4 + 4 + s->byte_offset_bits + 3) & ~7);
  1170.         s->last_bitoffset = pos & 7;
  1171.         pos >>= 3;
  1172.         len = buf_size - pos;
  1173.         if (len > MAX_CODED_SUPERFRAME_SIZE || len < 0) {
  1174.             goto fail;
  1175.         }
  1176.         s->last_superframe_len = len;
  1177.         memcpy(s->last_superframe, buf + pos, len);
  1178.     } else {
  1179.         /* single frame decode */
  1180.         if (wma_decode_frame(s, samples) < 0)
  1181.             goto fail;
  1182.         samples += s->nb_channels * s->frame_len;
  1183.     }
  1184.     *data_size = (int8_t *)samples - (int8_t *)data;
  1185.     return s->block_align;
  1186.  fail:
  1187.     /* when error, we reset the bit reservoir */
  1188.     s->last_superframe_len = 0;
  1189.     return -1;
  1190. }
  1191. static int wma_decode_end(AVCodecContext *avctx)
  1192. {
  1193.     WMADecodeContext *s = avctx->priv_data;
  1194.     int i;
  1195.     for(i = 0; i < s->nb_block_sizes; i++)
  1196.         ff_mdct_end(&s->mdct_ctx[i]);
  1197.     for(i = 0; i < s->nb_block_sizes; i++)
  1198.         av_free(s->windows[i]);
  1199.     if (s->use_exp_vlc) {
  1200.         free_vlc(&s->exp_vlc);
  1201.     }
  1202.     if (s->use_noise_coding) {
  1203.         free_vlc(&s->hgain_vlc);
  1204.     }
  1205.     for(i = 0;i < 2; i++) {
  1206.         free_vlc(&s->coef_vlc[i]);
  1207.         av_free(s->run_table[i]);
  1208.         av_free(s->level_table[i]);
  1209.     }
  1210.     
  1211.     return 0;
  1212. }
  1213. AVCodec wmav1_decoder =
  1214. {
  1215.     "wmav1",
  1216.     CODEC_TYPE_AUDIO,
  1217.     CODEC_ID_WMAV1,
  1218.     sizeof(WMADecodeContext),
  1219.     wma_decode_init,
  1220.     NULL,
  1221.     wma_decode_end,
  1222.     wma_decode_superframe,
  1223. };
  1224. AVCodec wmav2_decoder =
  1225. {
  1226.     "wmav2",
  1227.     CODEC_TYPE_AUDIO,
  1228.     CODEC_ID_WMAV2,
  1229.     sizeof(WMADecodeContext),
  1230.     wma_decode_init,
  1231.     NULL,
  1232.     wma_decode_end,
  1233.     wma_decode_superframe,
  1234. };