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.

261 lines
9.2KB

  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 "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-20)[i] < end) ? (bndtab-20)[i] : 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. }