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

Windows CE

开发平台:

C/C++

  1. /*
  2.  * bit_allocate.c
  3.  * Copyright (C) 2000-2003 Michel Lespinasse <walken@zoy.org>
  4.  * Copyright (C) 1999-2000 Aaron Holtzman <aholtzma@ess.engr.uvic.ca>
  5.  *
  6.  * This file is part of a52dec, a free ATSC A-52 stream decoder.
  7.  * See http://liba52.sourceforge.net/ for updates.
  8.  *
  9.  * a52dec is free software; you can redistribute it and/or modify
  10.  * it under the terms of the GNU General Public License as published by
  11.  * the Free Software Foundation; either version 2 of the License, or
  12.  * (at your option) any later version.
  13.  *
  14.  * a52dec is distributed in the hope that it will be useful,
  15.  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16.  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17.  * GNU General Public License for more details.
  18.  *
  19.  * You should have received a copy of the GNU General Public License
  20.  * along with this program; if not, write to the Free Software
  21.  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  22.  */
  23. #include "a52.h"
  24. #include "a52_internal.h"
  25. static int hthtab[3][50] = {
  26.     {0x730, 0x730, 0x7c0, 0x800, 0x820, 0x840, 0x850, 0x850, 0x860, 0x860,
  27.      0x860, 0x860, 0x860, 0x870, 0x870, 0x870, 0x880, 0x880, 0x890, 0x890,
  28.      0x8a0, 0x8a0, 0x8b0, 0x8b0, 0x8c0, 0x8c0, 0x8d0, 0x8e0, 0x8f0, 0x900,
  29.      0x910, 0x910, 0x910, 0x910, 0x900, 0x8f0, 0x8c0, 0x870, 0x820, 0x7e0,
  30.      0x7a0, 0x770, 0x760, 0x7a0, 0x7c0, 0x7c0, 0x6e0, 0x400, 0x3c0, 0x3c0},
  31.     {0x710, 0x710, 0x7a0, 0x7f0, 0x820, 0x830, 0x840, 0x850, 0x850, 0x860,
  32.      0x860, 0x860, 0x860, 0x860, 0x870, 0x870, 0x870, 0x880, 0x880, 0x880,
  33.      0x890, 0x890, 0x8a0, 0x8a0, 0x8b0, 0x8b0, 0x8c0, 0x8c0, 0x8e0, 0x8f0,
  34.      0x900, 0x910, 0x910, 0x910, 0x910, 0x900, 0x8e0, 0x8b0, 0x870, 0x820,
  35.      0x7e0, 0x7b0, 0x760, 0x770, 0x7a0, 0x7c0, 0x780, 0x5d0, 0x3c0, 0x3c0},
  36.     {0x680, 0x680, 0x750, 0x7b0, 0x7e0, 0x810, 0x820, 0x830, 0x840, 0x850,
  37.      0x850, 0x850, 0x860, 0x860, 0x860, 0x860, 0x860, 0x860, 0x860, 0x860,
  38.      0x870, 0x870, 0x870, 0x870, 0x880, 0x880, 0x880, 0x890, 0x8a0, 0x8b0,
  39.      0x8c0, 0x8d0, 0x8e0, 0x8f0, 0x900, 0x910, 0x910, 0x910, 0x900, 0x8f0,
  40.      0x8d0, 0x8b0, 0x840, 0x7f0, 0x790, 0x760, 0x7a0, 0x7c0, 0x7b0, 0x720}
  41. };
  42. static int8_t baptab[305] = {
  43.     16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16,
  44.     16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16,
  45.     16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16,
  46.     16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16,
  47.     16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16,
  48.     16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, /* 93 padding elems */
  49.     16, 16, 16, 16, 16, 16, 16, 16, 16, 14, 14, 14, 14, 14, 14, 14,
  50.     14, 12, 12, 12, 12, 11, 11, 11, 11, 10, 10, 10, 10,  9,  9,  9,
  51.      9,  8,  8,  8,  8,  7,  7,  7,  7,  6,  6,  6,  6,  5,  5,  5,
  52.      5,  4,  4, -3, -3,  3,  3,  3, -2, -2, -1, -1, -1, -1, -1,  0,
  53.      0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,
  54.      0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,
  55.      0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,
  56.      0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,
  57.      0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,
  58.      0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,
  59.      0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,
  60.      0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,
  61.      0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,
  62.      0,  0,  0,  0 /* 148 padding elems */
  63. };
  64. static int bndtab[30] = {21, 22,  23,  24,  25,  26,  27,  28,  31,  34,
  65.  37, 40,  43,  46,  49,  55,  61,  67,  73,  79,
  66.  85, 97, 109, 121, 133, 157, 181, 205, 229, 253};
  67. static int8_t latab[256] = {
  68.     -64, -63, -62, -61, -60, -59, -58, -57, -56, -55, -54, -53,
  69.     -52, -52, -51, -50, -49, -48, -47, -47, -46, -45, -44, -44,
  70.     -43, -42, -41, -41, -40, -39, -38, -38, -37, -36, -36, -35,
  71.     -35, -34, -33, -33, -32, -32, -31, -30, -30, -29, -29, -28,
  72.     -28, -27, -27, -26, -26, -25, -25, -24, -24, -23, -23, -22,
  73.     -22, -21, -21, -21, -20, -20, -19, -19, -19, -18, -18, -18,
  74.     -17, -17, -17, -16, -16, -16, -15, -15, -15, -14, -14, -14,
  75.     -13, -13, -13, -13, -12, -12, -12, -12, -11, -11, -11, -11,
  76.     -10, -10, -10, -10, -10,  -9,  -9,  -9,  -9,  -9,  -8,  -8,
  77.      -8,  -8,  -8,  -8,  -7,  -7,  -7,  -7,  -7,  -7,  -6,  -6,
  78.      -6,  -6,  -6,  -6,  -6,  -6,  -5,  -5,  -5,  -5,  -5,  -5,
  79.      -5,  -5,  -4,  -4,  -4,  -4,  -4,  -4,  -4,  -4,  -4,  -4,
  80.      -4,  -3,  -3,  -3,  -3,  -3,  -3,  -3,  -3,  -3,  -3,  -3,
  81.      -3,  -3,  -3,  -2,  -2,  -2,  -2,  -2,  -2,  -2,  -2,  -2,
  82.      -2,  -2,  -2,  -2,  -2,  -2,  -2,  -2,  -2,  -2,  -1,  -1,
  83.      -1,  -1,  -1,  -1,  -1,  -1,  -1,  -1,  -1,  -1,  -1,  -1,
  84.      -1,  -1,  -1,  -1,  -1,  -1,  -1,  -1,  -1,  -1,  -1,  -1,
  85.      -1,  -1,  -1,  -1,  -1,  -1,   0,   0,   0,   0,   0,   0,
  86.       0,   0,   0,   0,   0,   0,   0,   0,   0,   0,   0,   0,
  87.       0,   0,   0,   0,   0,   0,   0,   0,   0,   0,   0,   0,
  88.       0,   0,   0,   0,   0,   0,   0,   0,   0,   0,   0,   0,
  89.       0,   0,   0,   0
  90. };
  91. #define UPDATE_LEAK() 
  92. do {
  93.     fastleak += fdecay;
  94.     if (fastleak > psd + fgain)
  95. fastleak = psd + fgain;
  96.     slowleak += sdecay;
  97.     if (slowleak > psd + sgain)
  98. slowleak = psd + sgain;
  99. } while (0)
  100. #define COMPUTE_MASK()
  101. do {
  102.     if (psd > dbknee)
  103. mask -= (psd - dbknee) >> 2;
  104.     if (mask > hth [i >> halfrate])
  105. mask = hth [i >> halfrate];
  106.     mask -= snroffset + 128 * deltba[i];
  107.     mask = (mask > 0) ? 0 : ((-mask) >> 5);
  108.     mask -= floor;
  109. } while (0)
  110. void a52_bit_allocate (a52_state_t * state, ba_t * ba, int bndstart,
  111.        int start, int end, int fastleak, int slowleak,
  112.        expbap_t * expbap)
  113. {
  114.     static int slowgain[4] = {0x540, 0x4d8, 0x478, 0x410};
  115.     static int dbpbtab[4]  = {0xc00, 0x500, 0x300, 0x100};
  116.     static int floortab[8] = {0x910, 0x950, 0x990, 0x9d0,
  117.       0xa10, 0xa90, 0xb10, 0x1400};
  118.     int i, j;
  119.     uint8_t * exp;
  120.     int8_t * bap;
  121.     int fdecay, fgain, sdecay, sgain, dbknee, floor, snroffset;
  122.     int psd, mask;
  123.     int8_t * deltba;
  124.     int * hth;
  125.     int halfrate;
  126.     halfrate = state->halfrate;
  127.     fdecay = (63 + 20 * ((state->bai >> 7) & 3)) >> halfrate; /* fdcycod */
  128.     fgain = 128 + 128 * (ba->bai & 7); /* fgaincod */
  129.     sdecay = (15 + 2 * (state->bai >> 9)) >> halfrate; /* sdcycod */
  130.     sgain = slowgain[(state->bai >> 5) & 3]; /* sgaincod */
  131.     dbknee = dbpbtab[(state->bai >> 3) & 3]; /* dbpbcod */
  132.     hth = hthtab[state->fscod];
  133.     /*
  134.      * if there is no delta bit allocation, make deltba point to an area
  135.      * known to contain zeroes. baptab+156 here.
  136.      */
  137.     deltba = (ba->deltbae == DELTA_BIT_NONE) ? baptab + 156 : ba->deltba;
  138.     floor = floortab[state->bai & 7]; /* floorcod */
  139.     snroffset = 960 - 64 * state->csnroffst - 4 * (ba->bai >> 3) + floor;
  140.     floor >>= 5;
  141.     exp = expbap->exp;
  142.     bap = expbap->bap;
  143.     i = bndstart;
  144.     j = start;
  145.     if (start == 0) { /* not the coupling channel */
  146. int lowcomp;
  147. lowcomp = 0;
  148. j = end - 1;
  149. do {
  150.     if (i < j) {
  151. if (exp[i+1] == exp[i] - 2)
  152.     lowcomp = 384;
  153. else if (lowcomp && (exp[i+1] > exp[i]))
  154.     lowcomp -= 64;
  155.     }
  156.     psd = 128 * exp[i];
  157.     mask = psd + fgain + lowcomp;
  158.     COMPUTE_MASK ();
  159.     bap[i] = (baptab+156)[mask + 4 * exp[i]];
  160.     i++;
  161. } while ((i < 3) || ((i < 7) && (exp[i] > exp[i-1])));
  162. fastleak = psd + fgain;
  163. slowleak = psd + sgain;
  164. while (i < 7) {
  165.     if (i < j) {
  166. if (exp[i+1] == exp[i] - 2)
  167.     lowcomp = 384;
  168. else if (lowcomp && (exp[i+1] > exp[i]))
  169.     lowcomp -= 64;
  170.     }
  171.     psd = 128 * exp[i];
  172.     UPDATE_LEAK ();
  173.     mask = ((fastleak + lowcomp < slowleak) ?
  174.     fastleak + lowcomp : slowleak);
  175.     COMPUTE_MASK ();
  176.     bap[i] = (baptab+156)[mask + 4 * exp[i]];
  177.     i++;
  178. }
  179. if (end == 7) /* lfe channel */
  180.     return;
  181. do {
  182.     if (exp[i+1] == exp[i] - 2)
  183. lowcomp = 320;
  184.     else if (lowcomp && (exp[i+1] > exp[i]))
  185. lowcomp -= 64;
  186.     psd = 128 * exp[i];
  187.     UPDATE_LEAK ();
  188.     mask = ((fastleak + lowcomp < slowleak) ?
  189.     fastleak + lowcomp : slowleak);
  190.     COMPUTE_MASK ();
  191.     bap[i] = (baptab+156)[mask + 4 * exp[i]];
  192.     i++;
  193. } while (i < 20);
  194. while (lowcomp > 128) { /* two iterations maximum */
  195.     lowcomp -= 128;
  196.     psd = 128 * exp[i];
  197.     UPDATE_LEAK ();
  198.     mask = ((fastleak + lowcomp < slowleak) ?
  199.     fastleak + lowcomp : slowleak);
  200.     COMPUTE_MASK ();
  201.     bap[i] = (baptab+156)[mask + 4 * exp[i]];
  202.     i++;
  203. }
  204. j = i;
  205.     }
  206.     do {
  207. int startband, endband;
  208. startband = j;
  209. endband = (bndtab[i-20] < end) ? bndtab[i-20] : end;
  210. psd = 128 * exp[j++];
  211. while (j < endband) {
  212.     int next, delta;
  213.     next = 128 * exp[j++];
  214.     delta = next - psd;
  215.     switch (delta >> 9) {
  216.     case -6: case -5: case -4: case -3: case -2:
  217. psd = next;
  218. break;
  219.     case -1:
  220. psd = next + latab[(-delta) >> 1];
  221. break;
  222.     case 0:
  223. psd += latab[delta >> 1];
  224. break;
  225.     }
  226. }
  227. /* minpsd = -289 */
  228. UPDATE_LEAK ();
  229. mask = (fastleak < slowleak) ? fastleak : slowleak;
  230. COMPUTE_MASK ();
  231. i++;
  232. j = startband;
  233. do {
  234.     /* max(mask+4*exp)=147=-(minpsd+fgain-deltba-snroffset)>>5+4*exp */
  235.     /* min(mask+4*exp)=-156=-(sgain-deltba-snroffset)>>5 */
  236.     bap[j] = (baptab+156)[mask + 4 * exp[j]];
  237. } while (++j < endband);
  238.     } while (j < end);
  239. }