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

多媒体编程

开发平台:

Visual C++

  1. /*
  2. ** FAAD2 - Freeware Advanced Audio (AAC) Decoder including SBR decoding
  3. ** Copyright (C) 2003-2005 M. Bakker, Ahead Software AG, http://www.nero.com
  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. ** Any non-GPL usage of this software or parts of this software is strictly
  20. ** forbidden.
  21. **
  22. ** Software using this code must display the following message visibly in the
  23. ** software:
  24. ** "FAAD2 AAC/HE-AAC/HE-AACv2/DRM decoder (c) Ahead Software, www.nero.com"
  25. ** in, for example, the about-box or help/startup screen.
  26. **
  27. ** Commercial non-GPL licensing of this software is possible.
  28. ** For more info contact Ahead Software through Mpeg4AAClicense@nero.com.
  29. **
  30. ** $Id: hcr.c,v 1.2 2005/11/01 21:41:43 gabest Exp $
  31. **/
  32. #include "common.h"
  33. #include "structs.h"
  34. #include <stdlib.h>
  35. #include <string.h>
  36. #include "specrec.h"
  37. #include "huffman.h"
  38. /* ISO/IEC 14496-3/Amd.1 
  39.  * 8.5.3.3: Huffman Codeword Reordering for AAC spectral data (HCR) 
  40.  *
  41.  * HCR devides the spectral data in known fixed size segments, and 
  42.  * sorts it by the importance of the data. The importance is firstly 
  43.  * the (lower) position in the spectrum, and secondly the largest 
  44.  * value in the used codebook. 
  45.  * The most important data is written at the start of each segment
  46.  * (at known positions), the remaining data is interleaved inbetween, 
  47.  * with the writing direction alternating.
  48.  * Data length is not increased.
  49. */
  50. #ifdef ERROR_RESILIENCE
  51. /* 8.5.3.3.1 Pre-sorting */
  52. #define NUM_CB      6
  53. #define NUM_CB_ER   22
  54. #define MAX_CB      32
  55. #define VCB11_FIRST 16
  56. #define VCB11_LAST  31
  57. static const uint8_t PreSortCB_STD[NUM_CB] = 
  58.     { 11, 9, 7, 5, 3, 1};
  59. static const uint8_t PreSortCB_ER[NUM_CB_ER] = 
  60.     { 11, 31, 30, 29, 28, 27, 26, 25, 24, 23, 22, 21, 20, 19, 18, 17, 16, 9, 7, 5, 3, 1};
  61. /* 8.5.3.3.2 Derivation of segment width */
  62. static const uint8_t maxCwLen[MAX_CB] = {0, 11, 9, 20, 16, 13, 11, 14, 12, 17, 14, 49,
  63.     0, 0, 0, 0, 14, 17, 21, 21, 25, 25, 29, 29, 29, 29, 33, 33, 33, 37, 37, 41};
  64. #define segmentWidth(cb)    min(maxCwLen[cb], ics->length_of_longest_codeword)
  65. /* bit-twiddling helpers */
  66. static const uint8_t  S[] = {1, 2, 4, 8, 16};    
  67. static const uint32_t B[] = {0x55555555, 0x33333333, 0x0F0F0F0F, 0x00FF00FF, 0x0000FFFF};
  68. typedef struct
  69. {
  70.     uint8_t     cb;
  71.     uint8_t     decoded;
  72.     uint16_t sp_offset;
  73.     bits_t      bits;
  74. } codeword_t;
  75. /* rewind and reverse */
  76. /* 32 bit version */
  77. static uint32_t rewrev_word(uint32_t v, const uint8_t len)
  78. {  
  79.     /* 32 bit reverse */
  80.     v = ((v >> S[0]) & B[0]) | ((v << S[0]) & ~B[0]); 
  81.     v = ((v >> S[1]) & B[1]) | ((v << S[1]) & ~B[1]); 
  82.     v = ((v >> S[2]) & B[2]) | ((v << S[2]) & ~B[2]); 
  83.     v = ((v >> S[3]) & B[3]) | ((v << S[3]) & ~B[3]);
  84.     v = ((v >> S[4]) & B[4]) | ((v << S[4]) & ~B[4]);
  85.     /* shift off low bits */
  86.     v >>= (32 - len);
  87.     return v;
  88. }
  89. /* 64 bit version */
  90. static void rewrev_lword(uint32_t *hi, uint32_t *lo, const uint8_t len)
  91. {   
  92.     if (len <= 32) {
  93.         *hi = 0;
  94.         *lo = rewrev_word(*lo, len);
  95.     } else
  96.     {
  97.         uint32_t t = *hi, v = *lo;
  98.         /* double 32 bit reverse */
  99.         v = ((v >> S[0]) & B[0]) | ((v << S[0]) & ~B[0]); 
  100.         t = ((t >> S[0]) & B[0]) | ((t << S[0]) & ~B[0]); 
  101.         v = ((v >> S[1]) & B[1]) | ((v << S[1]) & ~B[1]); 
  102.         t = ((t >> S[1]) & B[1]) | ((t << S[1]) & ~B[1]); 
  103.         v = ((v >> S[2]) & B[2]) | ((v << S[2]) & ~B[2]); 
  104.         t = ((t >> S[2]) & B[2]) | ((t << S[2]) & ~B[2]); 
  105.         v = ((v >> S[3]) & B[3]) | ((v << S[3]) & ~B[3]);
  106.         t = ((t >> S[3]) & B[3]) | ((t << S[3]) & ~B[3]);
  107.         v = ((v >> S[4]) & B[4]) | ((v << S[4]) & ~B[4]);                
  108.         t = ((t >> S[4]) & B[4]) | ((t << S[4]) & ~B[4]);
  109.         /* last 32<>32 bit swap is implicit below */
  110.         
  111.         /* shift off low bits (this is really only one 64 bit shift) */
  112.         *lo = (t >> (64 - len)) | (v << (len - 32));
  113.         *hi = v >> (64 - len);          
  114.     }
  115. }
  116. /* bits_t version */
  117. static void rewrev_bits(bits_t *bits)
  118. {
  119.     if (bits->len == 0) return;
  120.     rewrev_lword(&bits->bufb, &bits->bufa,  bits->len);
  121. }
  122. /* merge bits of a to b */
  123. static void concat_bits(bits_t *b, bits_t *a)
  124. {
  125.     uint32_t bl, bh, al, ah;
  126.     if (a->len == 0) return;
  127.     al = a->bufa;
  128.     ah = a->bufb;
  129.     
  130.     if (b->len > 32)
  131.     {
  132.         /* maskoff superfluous high b bits */
  133.         bl = b->bufa;
  134.         bh = b->bufb & ((1 << (b->len-32)) - 1);
  135.         /* left shift a b->len bits */
  136.         ah = al << (b->len - 32);
  137.         al = 0;
  138.     } else {
  139.         bl = b->bufa & ((1 << (b->len)) - 1);
  140.         bh = 0;   
  141.         ah = (ah << (b->len)) | (al >> (32 - b->len));
  142.         al = al << b->len;
  143.     }
  144.     /* merge */
  145.     b->bufa = bl | al;
  146.     b->bufb = bh | ah;
  147.     b->len += a->len;
  148. }
  149.      
  150. uint8_t is_good_cb(uint8_t this_CB, uint8_t this_sec_CB)
  151. {
  152.     /* only want spectral data CB's */
  153.     if ((this_sec_CB > ZERO_HCB && this_sec_CB <= ESC_HCB) || (this_sec_CB >= VCB11_FIRST && this_sec_CB <= VCB11_LAST))
  154.     {
  155.         if (this_CB < ESC_HCB)
  156.         {
  157.             /* normal codebook pairs */
  158.             return ((this_sec_CB == this_CB) || (this_sec_CB == this_CB + 1));
  159.         } else
  160.         {
  161.             /* escape codebook */
  162.             return (this_sec_CB == this_CB);
  163.         }
  164.     }
  165.     return 0;
  166. }
  167.                     
  168. void read_segment(bits_t *segment, uint8_t segwidth, bitfile *ld)
  169. {
  170.     segment->len = segwidth;
  171.      if (segwidth > 32)
  172.      {
  173.         segment->bufb = faad_getbits(ld, segwidth - 32);        
  174.         segment->bufa = faad_getbits(ld, 32);        
  175.     } else {
  176.         segment->bufa = faad_getbits(ld, segwidth);
  177.         segment->bufb = 0;        
  178.     }    
  179. }
  180. void fill_in_codeword(codeword_t *codeword, uint16_t index, uint16_t sp, uint8_t cb)
  181. {
  182.     codeword[index].sp_offset = sp;
  183.     codeword[index].cb = cb;
  184.     codeword[index].decoded = 0;
  185.     codeword[index].bits.len = 0;
  186. }
  187. uint8_t reordered_spectral_data(NeAACDecHandle hDecoder, ic_stream *ics, 
  188.                                 bitfile *ld, int16_t *spectral_data)
  189. {   
  190.     uint16_t PCWs_done;
  191.     uint16_t numberOfSegments, numberOfSets, numberOfCodewords;  
  192.     codeword_t codeword[512];
  193.     bits_t segment[512];
  194.     uint16_t sp_offset[8];
  195.     uint16_t g, i, sortloop, set, bitsread;
  196.     uint16_t bitsleft, codewordsleft;
  197.     uint8_t w_idx, sfb, this_CB, last_CB, this_sec_CB; 
  198.     
  199.     const uint16_t nshort = hDecoder->frameLength/8;
  200.     const uint16_t sp_data_len = ics->length_of_reordered_spectral_data;
  201.     
  202.     const uint8_t *PreSortCb;
  203.     /* no data (e.g. silence) */
  204.     if (sp_data_len == 0)
  205.         return 0;
  206.     /* since there is spectral data, at least one codeword has nonzero length */
  207.     if (ics->length_of_longest_codeword == 0)
  208.         return 10;
  209.     if (sp_data_len < ics->length_of_longest_codeword)
  210.         return 10; 
  211.     sp_offset[0] = 0;
  212.     for (g = 1; g < ics->num_window_groups; g++)
  213.     {
  214.         sp_offset[g] = sp_offset[g-1] + nshort*ics->window_group_length[g-1];
  215.     }
  216.     PCWs_done = 0;
  217.     numberOfSegments = 0;
  218.     numberOfCodewords = 0;
  219.     bitsread = 0;
  220.     /* VCB11 code books in use */
  221.     if (hDecoder->aacSectionDataResilienceFlag)
  222.     {
  223.         PreSortCb = PreSortCB_ER;
  224.         last_CB = NUM_CB_ER;
  225.     } else
  226.     {
  227.         PreSortCb = PreSortCB_STD;
  228.         last_CB = NUM_CB;
  229.     }
  230.  
  231.     /* step 1: decode PCW's (set 0), and stuff data in easier-to-use format */
  232.     for (sortloop = 0; sortloop < last_CB; sortloop++)
  233.     {
  234.         /* select codebook to process this pass */
  235.         this_CB = PreSortCb[sortloop];
  236.         
  237.         /* loop over sfbs */
  238.         for (sfb = 0; sfb < ics->max_sfb; sfb++)
  239.         {
  240.             /* loop over all in this sfb, 4 lines per loop */
  241.             for (w_idx = 0; 4*w_idx < (ics->swb_offset[sfb+1] - ics->swb_offset[sfb]); w_idx++)
  242.             {
  243.                 for(g = 0; g < ics->num_window_groups; g++)
  244.                 {
  245.                     for (i = 0; i < ics->num_sec[g]; i++)
  246.                     {
  247.                         /* check whether sfb used here is the one we want to process */
  248.                         if ((ics->sect_start[g][i] <= sfb) && (ics->sect_end[g][i] > sfb))
  249.                         {                            
  250.                             /* check whether codebook used here is the one we want to process */
  251.                             this_sec_CB = ics->sect_cb[g][i];
  252.                  
  253.                             if (is_good_cb(this_CB, this_sec_CB))                              
  254.                             {
  255.                                 /* precalculate some stuff */
  256.                                 uint16_t sect_sfb_size = ics->sect_sfb_offset[g][sfb+1] - ics->sect_sfb_offset[g][sfb];
  257.                                 uint8_t inc = (this_sec_CB < FIRST_PAIR_HCB) ? QUAD_LEN : PAIR_LEN;
  258.                                 uint16_t group_cws_count = (4*ics->window_group_length[g])/inc;
  259.                                 uint8_t segwidth = segmentWidth(this_sec_CB);
  260.                                 uint16_t cws;                                
  261.                                 /* read codewords until end of sfb or end of window group (shouldn't only 1 trigger?) */                                 
  262.                                 for (cws = 0; (cws < group_cws_count) && ((cws + w_idx*group_cws_count) < sect_sfb_size); cws++)
  263.                                 {
  264.                                     uint16_t sp = sp_offset[g] + ics->sect_sfb_offset[g][sfb] + inc * (cws + w_idx*group_cws_count);                                   
  265.                                     /* read and decode PCW */
  266.                                     if (!PCWs_done)
  267.                                     {         
  268.                                         /* read in normal segments */
  269.                                         if (bitsread + segwidth <= sp_data_len)
  270.                                         {                                            
  271.                                             read_segment(&segment[numberOfSegments], segwidth, ld);                          
  272.                                             bitsread += segwidth;
  273.                                             
  274.                                             huffman_spectral_data_2(this_sec_CB, &segment[numberOfSegments], &spectral_data[sp]);                                            
  275.                                             /* keep leftover bits */
  276.                                             rewrev_bits(&segment[numberOfSegments]);
  277.                                             numberOfSegments++;
  278.                                         } else {
  279.                                             /* remaining stuff after last segment, we unfortunately couldn't read
  280.                                                this in earlier because it might not fit in 64 bits. since we already
  281.                                                decoded (and removed) the PCW it is now guaranteed to fit */
  282.                                             if (bitsread < sp_data_len)
  283.                                             {                                                
  284.                                                 const uint8_t additional_bits = sp_data_len - bitsread;                                               
  285.                                                 read_segment(&segment[numberOfSegments], additional_bits, ld);                                                
  286.                                                 segment[numberOfSegments].len += segment[numberOfSegments-1].len;
  287.                                                 rewrev_bits(&segment[numberOfSegments]);                                               
  288.                                                 if (segment[numberOfSegments-1].len > 32)
  289.                                                 {
  290.                                                     segment[numberOfSegments-1].bufb = segment[numberOfSegments].bufb + 
  291.                                                         showbits_hcr(&segment[numberOfSegments-1], segment[numberOfSegments-1].len - 32);
  292.                                                     segment[numberOfSegments-1].bufa = segment[numberOfSegments].bufa + 
  293.                                                         showbits_hcr(&segment[numberOfSegments-1], 32);
  294.                                                 } else {
  295.                                                     segment[numberOfSegments-1].bufa = segment[numberOfSegments].bufa + 
  296.                                                         showbits_hcr(&segment[numberOfSegments-1], segment[numberOfSegments-1].len);
  297.                                                     segment[numberOfSegments-1].bufb = segment[numberOfSegments].bufb;
  298.                                                 }                                                
  299.                                                 segment[numberOfSegments-1].len += additional_bits;
  300.                                             }
  301.                                             bitsread = sp_data_len;
  302.                                             PCWs_done = 1;
  303.                                             fill_in_codeword(codeword, 0, sp, this_sec_CB);                                            
  304.                                         }
  305.                                     } else {    
  306.                                         fill_in_codeword(codeword, numberOfCodewords - numberOfSegments, sp, this_sec_CB);                                         
  307.                                     }
  308.                                     numberOfCodewords++;
  309.                                 }                             
  310.                             }
  311.                         }
  312.                     } 
  313.                  } 
  314.              }
  315.          }
  316.     }
  317.     if (numberOfSegments == 0)
  318.         return 10; 
  319.     numberOfSets = numberOfCodewords / numberOfSegments;     
  320.     /* step 2: decode nonPCWs */
  321.     for (set = 1; set <= numberOfSets; set++)
  322.     {
  323.         uint16_t trial;
  324.         for (trial = 0; trial < numberOfSegments; trial++)
  325.         {
  326.             uint16_t codewordBase;
  327.             for (codewordBase = 0; codewordBase < numberOfSegments; codewordBase++)
  328.             {
  329.                 const uint16_t segment_idx = (trial + codewordBase) % numberOfSegments;
  330.                 const uint16_t codeword_idx = codewordBase + set*numberOfSegments - numberOfSegments;
  331.                 /* data up */
  332.                 if (codeword_idx >= numberOfCodewords - numberOfSegments) break;
  333.                 if (!codeword[codeword_idx].decoded && segment[segment_idx].len > 0)
  334.                 {
  335.                     uint8_t tmplen;
  336.                     if (codeword[codeword_idx].bits.len != 0)                   
  337.                         concat_bits(&segment[segment_idx], &codeword[codeword_idx].bits);                            
  338.                     
  339.                     tmplen = segment[segment_idx].len;
  340.                     if (huffman_spectral_data_2(codeword[codeword_idx].cb, &segment[segment_idx],
  341.                                                &spectral_data[codeword[codeword_idx].sp_offset]) >= 0)
  342.                     {
  343.                         codeword[codeword_idx].decoded = 1;
  344.                     } else 
  345.                     {   
  346.                         codeword[codeword_idx].bits = segment[segment_idx];
  347.                         codeword[codeword_idx].bits.len = tmplen;                        
  348.                     }
  349.                                             
  350.                 }
  351.             }
  352.         }
  353.         for (i = 0; i < numberOfSegments; i++)
  354.             rewrev_bits(&segment[i]);
  355.     }
  356.     bitsleft = 0;    
  357.         
  358.     for (i = 0; i < numberOfSegments && !bitsleft; i++)
  359.         bitsleft += segment[i].len;
  360.     if (bitsleft) return 10;
  361.     codewordsleft = 0;
  362.     for (i = 0; (i < numberOfCodewords - numberOfSegments) && (!codewordsleft); i++)    
  363.         if (!codeword[i].decoded)            
  364.                 codewordsleft++; 
  365.         
  366.     if (codewordsleft) return 10;
  367.     return 0;
  368. }
  369. #endif