You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

266 lines
9.3KB

  1. /*
  2. * bit_allocate.c
  3. * Copyright (C) 2000-2002 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 "config.h"
  24. #include <inttypes.h>
  25. #include "a52.h"
  26. #include "a52_internal.h"
  27. static int hthtab[3][50] = {
  28. {0x730, 0x730, 0x7c0, 0x800, 0x820, 0x840, 0x850, 0x850, 0x860, 0x860,
  29. 0x860, 0x860, 0x860, 0x870, 0x870, 0x870, 0x880, 0x880, 0x890, 0x890,
  30. 0x8a0, 0x8a0, 0x8b0, 0x8b0, 0x8c0, 0x8c0, 0x8d0, 0x8e0, 0x8f0, 0x900,
  31. 0x910, 0x910, 0x910, 0x910, 0x900, 0x8f0, 0x8c0, 0x870, 0x820, 0x7e0,
  32. 0x7a0, 0x770, 0x760, 0x7a0, 0x7c0, 0x7c0, 0x6e0, 0x400, 0x3c0, 0x3c0},
  33. {0x710, 0x710, 0x7a0, 0x7f0, 0x820, 0x830, 0x840, 0x850, 0x850, 0x860,
  34. 0x860, 0x860, 0x860, 0x860, 0x870, 0x870, 0x870, 0x880, 0x880, 0x880,
  35. 0x890, 0x890, 0x8a0, 0x8a0, 0x8b0, 0x8b0, 0x8c0, 0x8c0, 0x8e0, 0x8f0,
  36. 0x900, 0x910, 0x910, 0x910, 0x910, 0x900, 0x8e0, 0x8b0, 0x870, 0x820,
  37. 0x7e0, 0x7b0, 0x760, 0x770, 0x7a0, 0x7c0, 0x780, 0x5d0, 0x3c0, 0x3c0},
  38. {0x680, 0x680, 0x750, 0x7b0, 0x7e0, 0x810, 0x820, 0x830, 0x840, 0x850,
  39. 0x850, 0x850, 0x860, 0x860, 0x860, 0x860, 0x860, 0x860, 0x860, 0x860,
  40. 0x870, 0x870, 0x870, 0x870, 0x880, 0x880, 0x880, 0x890, 0x8a0, 0x8b0,
  41. 0x8c0, 0x8d0, 0x8e0, 0x8f0, 0x900, 0x910, 0x910, 0x910, 0x900, 0x8f0,
  42. 0x8d0, 0x8b0, 0x840, 0x7f0, 0x790, 0x760, 0x7a0, 0x7c0, 0x7b0, 0x720}
  43. };
  44. static int8_t baptab[305] = {
  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, 16, 16, 16,
  49. 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16,
  50. 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, 16, /* 93 padding elems */
  51. 16, 16, 16, 16, 16, 16, 16, 16, 16, 14, 14, 14, 14, 14, 14, 14,
  52. 14, 12, 12, 12, 12, 11, 11, 11, 11, 10, 10, 10, 10, 9, 9, 9,
  53. 9, 8, 8, 8, 8, 7, 7, 7, 7, 6, 6, 6, 6, 5, 5, 5,
  54. 5, 4, 4, -3, -3, 3, 3, 3, -2, -2, -1, -1, -1, -1, -1, 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, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  63. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  64. 0, 0, 0, 0 /* 148 padding elems */
  65. };
  66. static int bndtab[30] = {21, 22, 23, 24, 25, 26, 27, 28, 31, 34,
  67. 37, 40, 43, 46, 49, 55, 61, 67, 73, 79,
  68. 85, 97, 109, 121, 133, 157, 181, 205, 229, 253};
  69. static int8_t latab[256] = {
  70. -64, -63, -62, -61, -60, -59, -58, -57, -56, -55, -54, -53,
  71. -52, -52, -51, -50, -49, -48, -47, -47, -46, -45, -44, -44,
  72. -43, -42, -41, -41, -40, -39, -38, -38, -37, -36, -36, -35,
  73. -35, -34, -33, -33, -32, -32, -31, -30, -30, -29, -29, -28,
  74. -28, -27, -27, -26, -26, -25, -25, -24, -24, -23, -23, -22,
  75. -22, -21, -21, -21, -20, -20, -19, -19, -19, -18, -18, -18,
  76. -17, -17, -17, -16, -16, -16, -15, -15, -15, -14, -14, -14,
  77. -13, -13, -13, -13, -12, -12, -12, -12, -11, -11, -11, -11,
  78. -10, -10, -10, -10, -10, -9, -9, -9, -9, -9, -8, -8,
  79. -8, -8, -8, -8, -7, -7, -7, -7, -7, -7, -6, -6,
  80. -6, -6, -6, -6, -6, -6, -5, -5, -5, -5, -5, -5,
  81. -5, -5, -4, -4, -4, -4, -4, -4, -4, -4, -4, -4,
  82. -4, -3, -3, -3, -3, -3, -3, -3, -3, -3, -3, -3,
  83. -3, -3, -3, -2, -2, -2, -2, -2, -2, -2, -2, -2,
  84. -2, -2, -2, -2, -2, -2, -2, -2, -2, -2, -1, -1,
  85. -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1,
  86. -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1,
  87. -1, -1, -1, -1, -1, -1, 0, 0, 0, 0, 0, 0,
  88. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  89. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  90. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  91. 0, 0, 0, 0
  92. };
  93. #define UPDATE_LEAK() \
  94. do { \
  95. fastleak += fdecay; \
  96. if (fastleak > psd + fgain) \
  97. fastleak = psd + fgain; \
  98. slowleak += sdecay; \
  99. if (slowleak > psd + sgain) \
  100. slowleak = psd + sgain; \
  101. } while (0)
  102. #define COMPUTE_MASK() \
  103. do { \
  104. if (psd > dbknee) \
  105. mask -= (psd - dbknee) >> 2; \
  106. if (mask > hth [i >> halfrate]) \
  107. mask = hth [i >> halfrate]; \
  108. mask -= snroffset + 128 * deltba[i]; \
  109. mask = (mask > 0) ? 0 : ((-mask) >> 5); \
  110. mask -= floor; \
  111. } while (0)
  112. void a52_bit_allocate (a52_state_t * state, ba_t * ba, int bndstart,
  113. int start, int end, int fastleak, int slowleak,
  114. expbap_t * expbap)
  115. {
  116. static int slowgain[4] = {0x540, 0x4d8, 0x478, 0x410};
  117. static int dbpbtab[4] = {0xc00, 0x500, 0x300, 0x100};
  118. static int floortab[8] = {0x910, 0x950, 0x990, 0x9d0,
  119. 0xa10, 0xa90, 0xb10, 0x1400};
  120. int i, j;
  121. uint8_t * exp;
  122. int8_t * bap;
  123. int fdecay, fgain, sdecay, sgain, dbknee, floor, snroffset;
  124. int psd, mask;
  125. int8_t * deltba;
  126. int * hth;
  127. int halfrate;
  128. halfrate = state->halfrate;
  129. fdecay = (63 + 20 * ((state->bai >> 7) & 3)) >> halfrate; /* fdcycod */
  130. fgain = 128 + 128 * (ba->bai & 7); /* fgaincod */
  131. sdecay = (15 + 2 * (state->bai >> 9)) >> halfrate; /* sdcycod */
  132. sgain = slowgain[(state->bai >> 5) & 3]; /* sgaincod */
  133. dbknee = dbpbtab[(state->bai >> 3) & 3]; /* dbpbcod */
  134. hth = hthtab[state->fscod];
  135. /*
  136. * if there is no delta bit allocation, make deltba point to an area
  137. * known to contain zeroes. baptab+156 here.
  138. */
  139. deltba = (ba->deltbae == DELTA_BIT_NONE) ? baptab + 156 : ba->deltba;
  140. floor = floortab[state->bai & 7]; /* floorcod */
  141. snroffset = 960 - 64 * state->csnroffst - 4 * (ba->bai >> 3) + floor;
  142. floor >>= 5;
  143. exp = expbap->exp;
  144. bap = expbap->bap;
  145. i = bndstart;
  146. j = start;
  147. if (start == 0) { /* not the coupling channel */
  148. int lowcomp;
  149. lowcomp = 0;
  150. j = end - 1;
  151. do {
  152. if (i < j) {
  153. if (exp[i+1] == exp[i] - 2)
  154. lowcomp = 384;
  155. else if (lowcomp && (exp[i+1] > exp[i]))
  156. lowcomp -= 64;
  157. }
  158. psd = 128 * exp[i];
  159. mask = psd + fgain + lowcomp;
  160. COMPUTE_MASK ();
  161. bap[i] = (baptab+156)[mask + 4 * exp[i]];
  162. i++;
  163. } while ((i < 3) || ((i < 7) && (exp[i] > exp[i-1])));
  164. fastleak = psd + fgain;
  165. slowleak = psd + sgain;
  166. while (i < 7) {
  167. if (i < j) {
  168. if (exp[i+1] == exp[i] - 2)
  169. lowcomp = 384;
  170. else if (lowcomp && (exp[i+1] > exp[i]))
  171. lowcomp -= 64;
  172. }
  173. psd = 128 * exp[i];
  174. UPDATE_LEAK ();
  175. mask = ((fastleak + lowcomp < slowleak) ?
  176. fastleak + lowcomp : slowleak);
  177. COMPUTE_MASK ();
  178. bap[i] = (baptab+156)[mask + 4 * exp[i]];
  179. i++;
  180. }
  181. if (end == 7) /* lfe channel */
  182. return;
  183. do {
  184. if (exp[i+1] == exp[i] - 2)
  185. lowcomp = 320;
  186. else if (lowcomp && (exp[i+1] > exp[i]))
  187. lowcomp -= 64;
  188. psd = 128 * exp[i];
  189. UPDATE_LEAK ();
  190. mask = ((fastleak + lowcomp < slowleak) ?
  191. fastleak + lowcomp : slowleak);
  192. COMPUTE_MASK ();
  193. bap[i] = (baptab+156)[mask + 4 * exp[i]];
  194. i++;
  195. } while (i < 20);
  196. while (lowcomp > 128) { /* two iterations maximum */
  197. lowcomp -= 128;
  198. psd = 128 * exp[i];
  199. UPDATE_LEAK ();
  200. mask = ((fastleak + lowcomp < slowleak) ?
  201. fastleak + lowcomp : slowleak);
  202. COMPUTE_MASK ();
  203. bap[i] = (baptab+156)[mask + 4 * exp[i]];
  204. i++;
  205. }
  206. j = i;
  207. }
  208. do {
  209. int startband, endband;
  210. startband = j;
  211. endband = ((bndtab-20)[i] < end) ? (bndtab-20)[i] : end;
  212. psd = 128 * exp[j++];
  213. while (j < endband) {
  214. int next, delta;
  215. next = 128 * exp[j++];
  216. delta = next - psd;
  217. switch (delta >> 9) {
  218. case -6: case -5: case -4: case -3: case -2:
  219. psd = next;
  220. break;
  221. case -1:
  222. psd = next + latab[(-delta) >> 1];
  223. break;
  224. case 0:
  225. psd += latab[delta >> 1];
  226. break;
  227. }
  228. }
  229. /* minpsd = -289 */
  230. UPDATE_LEAK ();
  231. mask = (fastleak < slowleak) ? fastleak : slowleak;
  232. COMPUTE_MASK ();
  233. i++;
  234. j = startband;
  235. do {
  236. /* max(mask+4*exp)=147=-(minpsd+fgain-deltba-snroffset)>>5+4*exp */
  237. /* min(mask+4*exp)=-156=-(sgain-deltba-snroffset)>>5 */
  238. bap[j] = (baptab+156)[mask + 4 * exp[j]];
  239. } while (++j < endband);
  240. } while (j < end);
  241. }