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.

446 lines
15KB

  1. /*
  2. * Musepack SV8 decoder
  3. * Copyright (c) 2007 Konstantin Shishkov
  4. *
  5. * This file is part of Libav.
  6. *
  7. * Libav is free software; you can redistribute it and/or
  8. * modify it under the terms of the GNU Lesser General Public
  9. * License as published by the Free Software Foundation; either
  10. * version 2.1 of the License, or (at your option) any later version.
  11. *
  12. * Libav is distributed in the hope that it will be useful,
  13. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  15. * Lesser General Public License for more details.
  16. *
  17. * You should have received a copy of the GNU Lesser General Public
  18. * License along with Libav; if not, write to the Free Software
  19. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  20. */
  21. /**
  22. * @file
  23. * MPEG Audio Layer 1/2 -like codec with frames of 1152 samples
  24. * divided into 32 subbands.
  25. */
  26. #include "libavutil/channel_layout.h"
  27. #include "libavutil/lfg.h"
  28. #include "avcodec.h"
  29. #include "get_bits.h"
  30. #include "dsputil.h"
  31. #include "internal.h"
  32. #include "mpegaudiodsp.h"
  33. #include "mpc.h"
  34. #include "mpc8data.h"
  35. #include "mpc8huff.h"
  36. static VLC band_vlc, scfi_vlc[2], dscf_vlc[2], res_vlc[2];
  37. static VLC q1_vlc, q2_vlc[2], q3_vlc[2], quant_vlc[4][2], q9up_vlc;
  38. static const int q3_offsets[2] = { MPC8_Q3_OFFSET, MPC8_Q4_OFFSET };
  39. static const int quant_offsets[6] = { MPC8_Q5_OFFSET, MPC8_Q6_OFFSET, MPC8_Q7_OFFSET, MPC8_Q8_OFFSET };
  40. static inline int mpc8_dec_base(GetBitContext *gb, int k, int n)
  41. {
  42. int len = mpc8_cnk_len[k-1][n-1] - 1;
  43. int code = len ? get_bits_long(gb, len) : 0;
  44. if (code >= mpc8_cnk_lost[k-1][n-1])
  45. code = ((code << 1) | get_bits1(gb)) - mpc8_cnk_lost[k-1][n-1];
  46. return code;
  47. }
  48. static inline int mpc8_dec_enum(GetBitContext *gb, int k, int n)
  49. {
  50. int bits = 0;
  51. const uint32_t * C = mpc8_cnk[k-1];
  52. int code = mpc8_dec_base(gb, k, n);
  53. do {
  54. n--;
  55. if (code >= C[n]) {
  56. bits |= 1 << n;
  57. code -= C[n];
  58. C -= 32;
  59. k--;
  60. }
  61. } while(k > 0);
  62. return bits;
  63. }
  64. static inline int mpc8_get_mod_golomb(GetBitContext *gb, int m)
  65. {
  66. if(mpc8_cnk_len[0][m] < 1) return 0;
  67. return mpc8_dec_base(gb, 1, m+1);
  68. }
  69. static int mpc8_get_mask(GetBitContext *gb, int size, int t)
  70. {
  71. int mask = 0;
  72. if(t && t != size)
  73. mask = mpc8_dec_enum(gb, FFMIN(t, size - t), size);
  74. if((t << 1) > size) mask = ~mask;
  75. return mask;
  76. }
  77. static const uint16_t vlc_offsets[13] = {
  78. 0, 640, 1184, 1748, 2298, 2426, 2554, 3066, 3578, 4106, 4618, 5196, 5708
  79. };
  80. static av_cold int mpc8_decode_init(AVCodecContext * avctx)
  81. {
  82. int i;
  83. MPCContext *c = avctx->priv_data;
  84. GetBitContext gb;
  85. static int vlc_initialized = 0;
  86. int channels;
  87. static VLC_TYPE band_table[542][2];
  88. static VLC_TYPE q1_table[520][2];
  89. static VLC_TYPE q9up_table[524][2];
  90. static VLC_TYPE scfi0_table[1 << MPC8_SCFI0_BITS][2];
  91. static VLC_TYPE scfi1_table[1 << MPC8_SCFI1_BITS][2];
  92. static VLC_TYPE dscf0_table[560][2];
  93. static VLC_TYPE dscf1_table[598][2];
  94. static VLC_TYPE q3_0_table[512][2];
  95. static VLC_TYPE q3_1_table[516][2];
  96. static VLC_TYPE codes_table[5708][2];
  97. if(avctx->extradata_size < 2){
  98. av_log(avctx, AV_LOG_ERROR, "Too small extradata size (%i)!\n", avctx->extradata_size);
  99. return -1;
  100. }
  101. memset(c->oldDSCF, 0, sizeof(c->oldDSCF));
  102. av_lfg_init(&c->rnd, 0xDEADBEEF);
  103. ff_dsputil_init(&c->dsp, avctx);
  104. ff_mpadsp_init(&c->mpadsp);
  105. ff_mpc_init();
  106. init_get_bits(&gb, avctx->extradata, 16);
  107. skip_bits(&gb, 3);//sample rate
  108. c->maxbands = get_bits(&gb, 5) + 1;
  109. channels = get_bits(&gb, 4) + 1;
  110. if (channels > 2) {
  111. av_log_missing_feature(avctx, "Multichannel MPC SV8", 1);
  112. return AVERROR_PATCHWELCOME;
  113. }
  114. c->MSS = get_bits1(&gb);
  115. c->frames = 1 << (get_bits(&gb, 3) * 2);
  116. avctx->sample_fmt = AV_SAMPLE_FMT_S16P;
  117. avctx->channel_layout = (avctx->channels==2) ? AV_CH_LAYOUT_STEREO : AV_CH_LAYOUT_MONO;
  118. if(vlc_initialized) return 0;
  119. av_log(avctx, AV_LOG_DEBUG, "Initing VLC\n");
  120. band_vlc.table = band_table;
  121. band_vlc.table_allocated = 542;
  122. init_vlc(&band_vlc, MPC8_BANDS_BITS, MPC8_BANDS_SIZE,
  123. mpc8_bands_bits, 1, 1,
  124. mpc8_bands_codes, 1, 1, INIT_VLC_USE_NEW_STATIC);
  125. q1_vlc.table = q1_table;
  126. q1_vlc.table_allocated = 520;
  127. init_vlc(&q1_vlc, MPC8_Q1_BITS, MPC8_Q1_SIZE,
  128. mpc8_q1_bits, 1, 1,
  129. mpc8_q1_codes, 1, 1, INIT_VLC_USE_NEW_STATIC);
  130. q9up_vlc.table = q9up_table;
  131. q9up_vlc.table_allocated = 524;
  132. init_vlc(&q9up_vlc, MPC8_Q9UP_BITS, MPC8_Q9UP_SIZE,
  133. mpc8_q9up_bits, 1, 1,
  134. mpc8_q9up_codes, 1, 1, INIT_VLC_USE_NEW_STATIC);
  135. scfi_vlc[0].table = scfi0_table;
  136. scfi_vlc[0].table_allocated = 1 << MPC8_SCFI0_BITS;
  137. init_vlc(&scfi_vlc[0], MPC8_SCFI0_BITS, MPC8_SCFI0_SIZE,
  138. mpc8_scfi0_bits, 1, 1,
  139. mpc8_scfi0_codes, 1, 1, INIT_VLC_USE_NEW_STATIC);
  140. scfi_vlc[1].table = scfi1_table;
  141. scfi_vlc[1].table_allocated = 1 << MPC8_SCFI1_BITS;
  142. init_vlc(&scfi_vlc[1], MPC8_SCFI1_BITS, MPC8_SCFI1_SIZE,
  143. mpc8_scfi1_bits, 1, 1,
  144. mpc8_scfi1_codes, 1, 1, INIT_VLC_USE_NEW_STATIC);
  145. dscf_vlc[0].table = dscf0_table;
  146. dscf_vlc[0].table_allocated = 560;
  147. init_vlc(&dscf_vlc[0], MPC8_DSCF0_BITS, MPC8_DSCF0_SIZE,
  148. mpc8_dscf0_bits, 1, 1,
  149. mpc8_dscf0_codes, 1, 1, INIT_VLC_USE_NEW_STATIC);
  150. dscf_vlc[1].table = dscf1_table;
  151. dscf_vlc[1].table_allocated = 598;
  152. init_vlc(&dscf_vlc[1], MPC8_DSCF1_BITS, MPC8_DSCF1_SIZE,
  153. mpc8_dscf1_bits, 1, 1,
  154. mpc8_dscf1_codes, 1, 1, INIT_VLC_USE_NEW_STATIC);
  155. q3_vlc[0].table = q3_0_table;
  156. q3_vlc[0].table_allocated = 512;
  157. ff_init_vlc_sparse(&q3_vlc[0], MPC8_Q3_BITS, MPC8_Q3_SIZE,
  158. mpc8_q3_bits, 1, 1,
  159. mpc8_q3_codes, 1, 1,
  160. mpc8_q3_syms, 1, 1, INIT_VLC_USE_NEW_STATIC);
  161. q3_vlc[1].table = q3_1_table;
  162. q3_vlc[1].table_allocated = 516;
  163. ff_init_vlc_sparse(&q3_vlc[1], MPC8_Q4_BITS, MPC8_Q4_SIZE,
  164. mpc8_q4_bits, 1, 1,
  165. mpc8_q4_codes, 1, 1,
  166. mpc8_q4_syms, 1, 1, INIT_VLC_USE_NEW_STATIC);
  167. for(i = 0; i < 2; i++){
  168. res_vlc[i].table = &codes_table[vlc_offsets[0+i]];
  169. res_vlc[i].table_allocated = vlc_offsets[1+i] - vlc_offsets[0+i];
  170. init_vlc(&res_vlc[i], MPC8_RES_BITS, MPC8_RES_SIZE,
  171. &mpc8_res_bits[i], 1, 1,
  172. &mpc8_res_codes[i], 1, 1, INIT_VLC_USE_NEW_STATIC);
  173. q2_vlc[i].table = &codes_table[vlc_offsets[2+i]];
  174. q2_vlc[i].table_allocated = vlc_offsets[3+i] - vlc_offsets[2+i];
  175. init_vlc(&q2_vlc[i], MPC8_Q2_BITS, MPC8_Q2_SIZE,
  176. &mpc8_q2_bits[i], 1, 1,
  177. &mpc8_q2_codes[i], 1, 1, INIT_VLC_USE_NEW_STATIC);
  178. quant_vlc[0][i].table = &codes_table[vlc_offsets[4+i]];
  179. quant_vlc[0][i].table_allocated = vlc_offsets[5+i] - vlc_offsets[4+i];
  180. init_vlc(&quant_vlc[0][i], MPC8_Q5_BITS, MPC8_Q5_SIZE,
  181. &mpc8_q5_bits[i], 1, 1,
  182. &mpc8_q5_codes[i], 1, 1, INIT_VLC_USE_NEW_STATIC);
  183. quant_vlc[1][i].table = &codes_table[vlc_offsets[6+i]];
  184. quant_vlc[1][i].table_allocated = vlc_offsets[7+i] - vlc_offsets[6+i];
  185. init_vlc(&quant_vlc[1][i], MPC8_Q6_BITS, MPC8_Q6_SIZE,
  186. &mpc8_q6_bits[i], 1, 1,
  187. &mpc8_q6_codes[i], 1, 1, INIT_VLC_USE_NEW_STATIC);
  188. quant_vlc[2][i].table = &codes_table[vlc_offsets[8+i]];
  189. quant_vlc[2][i].table_allocated = vlc_offsets[9+i] - vlc_offsets[8+i];
  190. init_vlc(&quant_vlc[2][i], MPC8_Q7_BITS, MPC8_Q7_SIZE,
  191. &mpc8_q7_bits[i], 1, 1,
  192. &mpc8_q7_codes[i], 1, 1, INIT_VLC_USE_NEW_STATIC);
  193. quant_vlc[3][i].table = &codes_table[vlc_offsets[10+i]];
  194. quant_vlc[3][i].table_allocated = vlc_offsets[11+i] - vlc_offsets[10+i];
  195. init_vlc(&quant_vlc[3][i], MPC8_Q8_BITS, MPC8_Q8_SIZE,
  196. &mpc8_q8_bits[i], 1, 1,
  197. &mpc8_q8_codes[i], 1, 1, INIT_VLC_USE_NEW_STATIC);
  198. }
  199. vlc_initialized = 1;
  200. avcodec_get_frame_defaults(&c->frame);
  201. avctx->coded_frame = &c->frame;
  202. return 0;
  203. }
  204. static int mpc8_decode_frame(AVCodecContext * avctx, void *data,
  205. int *got_frame_ptr, AVPacket *avpkt)
  206. {
  207. const uint8_t *buf = avpkt->data;
  208. int buf_size = avpkt->size;
  209. MPCContext *c = avctx->priv_data;
  210. GetBitContext gb2, *gb = &gb2;
  211. int i, j, k, ch, cnt, res, t;
  212. Band *bands = c->bands;
  213. int off;
  214. int maxband, keyframe;
  215. int last[2];
  216. /* get output buffer */
  217. c->frame.nb_samples = MPC_FRAME_SIZE;
  218. if ((res = ff_get_buffer(avctx, &c->frame)) < 0) {
  219. av_log(avctx, AV_LOG_ERROR, "get_buffer() failed\n");
  220. return res;
  221. }
  222. keyframe = c->cur_frame == 0;
  223. if(keyframe){
  224. memset(c->Q, 0, sizeof(c->Q));
  225. c->last_bits_used = 0;
  226. }
  227. init_get_bits(gb, buf, buf_size * 8);
  228. skip_bits(gb, c->last_bits_used & 7);
  229. if(keyframe)
  230. maxband = mpc8_get_mod_golomb(gb, c->maxbands + 1);
  231. else{
  232. maxband = c->last_max_band + get_vlc2(gb, band_vlc.table, MPC8_BANDS_BITS, 2);
  233. if(maxband > 32) maxband -= 33;
  234. }
  235. if(maxband > c->maxbands + 1)
  236. return AVERROR_INVALIDDATA;
  237. c->last_max_band = maxband;
  238. /* read subband indexes */
  239. if(maxband){
  240. last[0] = last[1] = 0;
  241. for(i = maxband - 1; i >= 0; i--){
  242. for(ch = 0; ch < 2; ch++){
  243. last[ch] = get_vlc2(gb, res_vlc[last[ch] > 2].table, MPC8_RES_BITS, 2) + last[ch];
  244. if(last[ch] > 15) last[ch] -= 17;
  245. bands[i].res[ch] = last[ch];
  246. }
  247. }
  248. if(c->MSS){
  249. int mask;
  250. cnt = 0;
  251. for(i = 0; i < maxband; i++)
  252. if(bands[i].res[0] || bands[i].res[1])
  253. cnt++;
  254. t = mpc8_get_mod_golomb(gb, cnt);
  255. mask = mpc8_get_mask(gb, cnt, t);
  256. for(i = maxband - 1; i >= 0; i--)
  257. if(bands[i].res[0] || bands[i].res[1]){
  258. bands[i].msf = mask & 1;
  259. mask >>= 1;
  260. }
  261. }
  262. }
  263. for(i = maxband; i < c->maxbands; i++)
  264. bands[i].res[0] = bands[i].res[1] = 0;
  265. if(keyframe){
  266. for(i = 0; i < 32; i++)
  267. c->oldDSCF[0][i] = c->oldDSCF[1][i] = 1;
  268. }
  269. for(i = 0; i < maxband; i++){
  270. if(bands[i].res[0] || bands[i].res[1]){
  271. cnt = !!bands[i].res[0] + !!bands[i].res[1] - 1;
  272. if(cnt >= 0){
  273. t = get_vlc2(gb, scfi_vlc[cnt].table, scfi_vlc[cnt].bits, 1);
  274. if(bands[i].res[0]) bands[i].scfi[0] = t >> (2 * cnt);
  275. if(bands[i].res[1]) bands[i].scfi[1] = t & 3;
  276. }
  277. }
  278. }
  279. for(i = 0; i < maxband; i++){
  280. for(ch = 0; ch < 2; ch++){
  281. if(!bands[i].res[ch]) continue;
  282. if(c->oldDSCF[ch][i]){
  283. bands[i].scf_idx[ch][0] = get_bits(gb, 7) - 6;
  284. c->oldDSCF[ch][i] = 0;
  285. }else{
  286. t = get_vlc2(gb, dscf_vlc[1].table, MPC8_DSCF1_BITS, 2);
  287. if(t == 64)
  288. t += get_bits(gb, 6);
  289. bands[i].scf_idx[ch][0] = ((bands[i].scf_idx[ch][2] + t - 25) & 0x7F) - 6;
  290. }
  291. for(j = 0; j < 2; j++){
  292. if((bands[i].scfi[ch] << j) & 2)
  293. bands[i].scf_idx[ch][j + 1] = bands[i].scf_idx[ch][j];
  294. else{
  295. t = get_vlc2(gb, dscf_vlc[0].table, MPC8_DSCF0_BITS, 2);
  296. if(t == 31)
  297. t = 64 + get_bits(gb, 6);
  298. bands[i].scf_idx[ch][j + 1] = ((bands[i].scf_idx[ch][j] + t - 25) & 0x7F) - 6;
  299. }
  300. }
  301. }
  302. }
  303. for(i = 0, off = 0; i < maxband; i++, off += SAMPLES_PER_BAND){
  304. for(ch = 0; ch < 2; ch++){
  305. res = bands[i].res[ch];
  306. switch(res){
  307. case -1:
  308. for(j = 0; j < SAMPLES_PER_BAND; j++)
  309. c->Q[ch][off + j] = (av_lfg_get(&c->rnd) & 0x3FC) - 510;
  310. break;
  311. case 0:
  312. break;
  313. case 1:
  314. for(j = 0; j < SAMPLES_PER_BAND; j += SAMPLES_PER_BAND / 2){
  315. cnt = get_vlc2(gb, q1_vlc.table, MPC8_Q1_BITS, 2);
  316. t = mpc8_get_mask(gb, 18, cnt);
  317. for(k = 0; k < SAMPLES_PER_BAND / 2; k++, t <<= 1)
  318. c->Q[ch][off + j + k] = (t & 0x20000) ? (get_bits1(gb) << 1) - 1 : 0;
  319. }
  320. break;
  321. case 2:
  322. cnt = 6;//2*mpc8_thres[res]
  323. for(j = 0; j < SAMPLES_PER_BAND; j += 3){
  324. t = get_vlc2(gb, q2_vlc[cnt > 3].table, MPC8_Q2_BITS, 2);
  325. c->Q[ch][off + j + 0] = mpc8_idx50[t];
  326. c->Q[ch][off + j + 1] = mpc8_idx51[t];
  327. c->Q[ch][off + j + 2] = mpc8_idx52[t];
  328. cnt = (cnt >> 1) + mpc8_huffq2[t];
  329. }
  330. break;
  331. case 3:
  332. case 4:
  333. for(j = 0; j < SAMPLES_PER_BAND; j += 2){
  334. t = get_vlc2(gb, q3_vlc[res - 3].table, MPC8_Q3_BITS, 2) + q3_offsets[res - 3];
  335. c->Q[ch][off + j + 1] = t >> 4;
  336. c->Q[ch][off + j + 0] = (t & 8) ? (t & 0xF) - 16 : (t & 0xF);
  337. }
  338. break;
  339. case 5:
  340. case 6:
  341. case 7:
  342. case 8:
  343. cnt = 2 * mpc8_thres[res];
  344. for(j = 0; j < SAMPLES_PER_BAND; j++){
  345. t = get_vlc2(gb, quant_vlc[res - 5][cnt > mpc8_thres[res]].table, quant_vlc[res - 5][cnt > mpc8_thres[res]].bits, 2) + quant_offsets[res - 5];
  346. c->Q[ch][off + j] = t;
  347. cnt = (cnt >> 1) + FFABS(c->Q[ch][off + j]);
  348. }
  349. break;
  350. default:
  351. for(j = 0; j < SAMPLES_PER_BAND; j++){
  352. c->Q[ch][off + j] = get_vlc2(gb, q9up_vlc.table, MPC8_Q9UP_BITS, 2);
  353. if(res != 9){
  354. c->Q[ch][off + j] <<= res - 9;
  355. c->Q[ch][off + j] |= get_bits(gb, res - 9);
  356. }
  357. c->Q[ch][off + j] -= (1 << (res - 2)) - 1;
  358. }
  359. }
  360. }
  361. }
  362. ff_mpc_dequantize_and_synth(c, maxband - 1,
  363. (int16_t **)c->frame.extended_data,
  364. avctx->channels);
  365. c->cur_frame++;
  366. c->last_bits_used = get_bits_count(gb);
  367. if(get_bits_left(gb) < 8) // we have only padding left
  368. c->last_bits_used = buf_size << 3;
  369. if(c->cur_frame >= c->frames)
  370. c->cur_frame = 0;
  371. *got_frame_ptr = 1;
  372. *(AVFrame *)data = c->frame;
  373. return c->cur_frame ? c->last_bits_used >> 3 : buf_size;
  374. }
  375. static av_cold void mpc8_decode_flush(AVCodecContext *avctx)
  376. {
  377. MPCContext *c = avctx->priv_data;
  378. c->cur_frame = 0;
  379. }
  380. AVCodec ff_mpc8_decoder = {
  381. .name = "mpc8",
  382. .type = AVMEDIA_TYPE_AUDIO,
  383. .id = AV_CODEC_ID_MUSEPACK8,
  384. .priv_data_size = sizeof(MPCContext),
  385. .init = mpc8_decode_init,
  386. .decode = mpc8_decode_frame,
  387. .flush = mpc8_decode_flush,
  388. .capabilities = CODEC_CAP_DR1,
  389. .long_name = NULL_IF_CONFIG_SMALL("Musepack SV8"),
  390. .sample_fmts = (const enum AVSampleFormat[]) { AV_SAMPLE_FMT_S16P,
  391. AV_SAMPLE_FMT_NONE },
  392. };