tta: use skip_bits_long()
[libav.git] / libavcodec / tta.c
1 /*
2 * TTA (The Lossless True Audio) decoder
3 * Copyright (c) 2006 Alex Beregszaszi
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 /**
23 * @file
24 * TTA (The Lossless True Audio) decoder
25 * @see http://www.true-audio.com/
26 * @see http://tta.corecodec.org/
27 * @author Alex Beregszaszi
28 */
29
30 #define BITSTREAM_READER_LE
31 //#define DEBUG
32 #include <limits.h>
33 #include "avcodec.h"
34 #include "get_bits.h"
35
36 #define FORMAT_SIMPLE 1
37 #define FORMAT_ENCRYPTED 2
38
39 #define MAX_ORDER 16
40 typedef struct TTAFilter {
41 int32_t shift, round, error, mode;
42 int32_t qm[MAX_ORDER];
43 int32_t dx[MAX_ORDER];
44 int32_t dl[MAX_ORDER];
45 } TTAFilter;
46
47 typedef struct TTARice {
48 uint32_t k0, k1, sum0, sum1;
49 } TTARice;
50
51 typedef struct TTAChannel {
52 int32_t predictor;
53 TTAFilter filter;
54 TTARice rice;
55 } TTAChannel;
56
57 typedef struct TTAContext {
58 AVCodecContext *avctx;
59 AVFrame frame;
60 GetBitContext gb;
61
62 int format, channels, bps, data_length;
63 int frame_length, last_frame_length, total_frames;
64
65 int32_t *decode_buffer;
66
67 TTAChannel *ch_ctx;
68 } TTAContext;
69
70 static const uint32_t shift_1[] = {
71 0x00000001, 0x00000002, 0x00000004, 0x00000008,
72 0x00000010, 0x00000020, 0x00000040, 0x00000080,
73 0x00000100, 0x00000200, 0x00000400, 0x00000800,
74 0x00001000, 0x00002000, 0x00004000, 0x00008000,
75 0x00010000, 0x00020000, 0x00040000, 0x00080000,
76 0x00100000, 0x00200000, 0x00400000, 0x00800000,
77 0x01000000, 0x02000000, 0x04000000, 0x08000000,
78 0x10000000, 0x20000000, 0x40000000, 0x80000000,
79 0x80000000, 0x80000000, 0x80000000, 0x80000000,
80 0x80000000, 0x80000000, 0x80000000, 0x80000000
81 };
82
83 static const uint32_t * const shift_16 = shift_1 + 4;
84
85 static const int32_t ttafilter_configs[4][2] = {
86 {10, 1},
87 {9, 1},
88 {10, 1},
89 {12, 0}
90 };
91
92 static void ttafilter_init(TTAFilter *c, int32_t shift, int32_t mode) {
93 memset(c, 0, sizeof(TTAFilter));
94 c->shift = shift;
95 c->round = shift_1[shift-1];
96 // c->round = 1 << (shift - 1);
97 c->mode = mode;
98 }
99
100 // FIXME: copy paste from original
101 static inline void memshl(register int32_t *a, register int32_t *b) {
102 *a++ = *b++;
103 *a++ = *b++;
104 *a++ = *b++;
105 *a++ = *b++;
106 *a++ = *b++;
107 *a++ = *b++;
108 *a++ = *b++;
109 *a = *b;
110 }
111
112 // FIXME: copy paste from original
113 // mode=1 encoder, mode=0 decoder
114 static inline void ttafilter_process(TTAFilter *c, int32_t *in, int32_t mode) {
115 register int32_t *dl = c->dl, *qm = c->qm, *dx = c->dx, sum = c->round;
116
117 if (!c->error) {
118 sum += *dl++ * *qm, qm++;
119 sum += *dl++ * *qm, qm++;
120 sum += *dl++ * *qm, qm++;
121 sum += *dl++ * *qm, qm++;
122 sum += *dl++ * *qm, qm++;
123 sum += *dl++ * *qm, qm++;
124 sum += *dl++ * *qm, qm++;
125 sum += *dl++ * *qm, qm++;
126 dx += 8;
127 } else if(c->error < 0) {
128 sum += *dl++ * (*qm -= *dx++), qm++;
129 sum += *dl++ * (*qm -= *dx++), qm++;
130 sum += *dl++ * (*qm -= *dx++), qm++;
131 sum += *dl++ * (*qm -= *dx++), qm++;
132 sum += *dl++ * (*qm -= *dx++), qm++;
133 sum += *dl++ * (*qm -= *dx++), qm++;
134 sum += *dl++ * (*qm -= *dx++), qm++;
135 sum += *dl++ * (*qm -= *dx++), qm++;
136 } else {
137 sum += *dl++ * (*qm += *dx++), qm++;
138 sum += *dl++ * (*qm += *dx++), qm++;
139 sum += *dl++ * (*qm += *dx++), qm++;
140 sum += *dl++ * (*qm += *dx++), qm++;
141 sum += *dl++ * (*qm += *dx++), qm++;
142 sum += *dl++ * (*qm += *dx++), qm++;
143 sum += *dl++ * (*qm += *dx++), qm++;
144 sum += *dl++ * (*qm += *dx++), qm++;
145 }
146
147 *(dx-0) = ((*(dl-1) >> 30) | 1) << 2;
148 *(dx-1) = ((*(dl-2) >> 30) | 1) << 1;
149 *(dx-2) = ((*(dl-3) >> 30) | 1) << 1;
150 *(dx-3) = ((*(dl-4) >> 30) | 1);
151
152 // compress
153 if (mode) {
154 *dl = *in;
155 *in -= (sum >> c->shift);
156 c->error = *in;
157 } else {
158 c->error = *in;
159 *in += (sum >> c->shift);
160 *dl = *in;
161 }
162
163 if (c->mode) {
164 *(dl-1) = *dl - *(dl-1);
165 *(dl-2) = *(dl-1) - *(dl-2);
166 *(dl-3) = *(dl-2) - *(dl-3);
167 }
168
169 memshl(c->dl, c->dl + 1);
170 memshl(c->dx, c->dx + 1);
171 }
172
173 static void rice_init(TTARice *c, uint32_t k0, uint32_t k1)
174 {
175 c->k0 = k0;
176 c->k1 = k1;
177 c->sum0 = shift_16[k0];
178 c->sum1 = shift_16[k1];
179 }
180
181 static int tta_get_unary(GetBitContext *gb)
182 {
183 int ret = 0;
184
185 // count ones
186 while (get_bits_left(gb) > 0 && get_bits1(gb))
187 ret++;
188 return ret;
189 }
190
191 static av_cold int tta_decode_init(AVCodecContext * avctx)
192 {
193 TTAContext *s = avctx->priv_data;
194
195 s->avctx = avctx;
196
197 // 30bytes includes a seektable with one frame
198 if (avctx->extradata_size < 30)
199 return -1;
200
201 init_get_bits(&s->gb, avctx->extradata, avctx->extradata_size * 8);
202 if (show_bits_long(&s->gb, 32) == AV_RL32("TTA1"))
203 {
204 /* signature */
205 skip_bits_long(&s->gb, 32);
206
207 s->format = get_bits(&s->gb, 16);
208 if (s->format > 2) {
209 av_log(s->avctx, AV_LOG_ERROR, "Invalid format\n");
210 return -1;
211 }
212 if (s->format == FORMAT_ENCRYPTED) {
213 av_log_missing_feature(s->avctx, "Encrypted TTA", 0);
214 return AVERROR(EINVAL);
215 }
216 avctx->channels = s->channels = get_bits(&s->gb, 16);
217 avctx->bits_per_coded_sample = get_bits(&s->gb, 16);
218 s->bps = (avctx->bits_per_coded_sample + 7) / 8;
219 avctx->sample_rate = get_bits_long(&s->gb, 32);
220 s->data_length = get_bits_long(&s->gb, 32);
221 skip_bits_long(&s->gb, 32); // CRC32 of header
222
223 if (s->channels == 0) {
224 av_log(s->avctx, AV_LOG_ERROR, "Invalid number of channels\n");
225 return AVERROR_INVALIDDATA;
226 }
227
228 switch(s->bps) {
229 case 2:
230 avctx->sample_fmt = AV_SAMPLE_FMT_S16;
231 avctx->bits_per_raw_sample = 16;
232 break;
233 case 3:
234 avctx->sample_fmt = AV_SAMPLE_FMT_S32;
235 avctx->bits_per_raw_sample = 24;
236 break;
237 default:
238 av_log(avctx, AV_LOG_ERROR, "Invalid/unsupported sample format.\n");
239 return AVERROR_INVALIDDATA;
240 }
241
242 // prevent overflow
243 if (avctx->sample_rate > 0x7FFFFF) {
244 av_log(avctx, AV_LOG_ERROR, "sample_rate too large\n");
245 return AVERROR(EINVAL);
246 }
247 s->frame_length = 256 * avctx->sample_rate / 245;
248
249 s->last_frame_length = s->data_length % s->frame_length;
250 s->total_frames = s->data_length / s->frame_length +
251 (s->last_frame_length ? 1 : 0);
252
253 av_log(s->avctx, AV_LOG_DEBUG, "format: %d chans: %d bps: %d rate: %d block: %d\n",
254 s->format, avctx->channels, avctx->bits_per_coded_sample, avctx->sample_rate,
255 avctx->block_align);
256 av_log(s->avctx, AV_LOG_DEBUG, "data_length: %d frame_length: %d last: %d total: %d\n",
257 s->data_length, s->frame_length, s->last_frame_length, s->total_frames);
258
259 // FIXME: seek table
260 skip_bits_long(&s->gb, 32 * s->total_frames);
261 skip_bits_long(&s->gb, 32); // CRC32 of seektable
262
263 if(s->frame_length >= UINT_MAX / (s->channels * sizeof(int32_t))){
264 av_log(avctx, AV_LOG_ERROR, "frame_length too large\n");
265 return -1;
266 }
267
268 if (s->bps == 2) {
269 s->decode_buffer = av_mallocz(sizeof(int32_t)*s->frame_length*s->channels);
270 if (!s->decode_buffer)
271 return AVERROR(ENOMEM);
272 }
273 s->ch_ctx = av_malloc(avctx->channels * sizeof(*s->ch_ctx));
274 if (!s->ch_ctx) {
275 av_freep(&s->decode_buffer);
276 return AVERROR(ENOMEM);
277 }
278 } else {
279 av_log(avctx, AV_LOG_ERROR, "Wrong extradata present\n");
280 return -1;
281 }
282
283 avcodec_get_frame_defaults(&s->frame);
284 avctx->coded_frame = &s->frame;
285
286 return 0;
287 }
288
289 static int tta_decode_frame(AVCodecContext *avctx, void *data,
290 int *got_frame_ptr, AVPacket *avpkt)
291 {
292 const uint8_t *buf = avpkt->data;
293 int buf_size = avpkt->size;
294 TTAContext *s = avctx->priv_data;
295 int i, ret;
296 int cur_chan = 0, framelen = s->frame_length;
297 int32_t *p;
298
299 init_get_bits(&s->gb, buf, buf_size*8);
300
301 // FIXME: seeking
302 s->total_frames--;
303 if (!s->total_frames && s->last_frame_length)
304 framelen = s->last_frame_length;
305
306 /* get output buffer */
307 s->frame.nb_samples = framelen;
308 if ((ret = avctx->get_buffer(avctx, &s->frame)) < 0) {
309 av_log(avctx, AV_LOG_ERROR, "get_buffer() failed\n");
310 return ret;
311 }
312
313 // decode directly to output buffer for 24-bit sample format
314 if (s->bps == 3)
315 s->decode_buffer = (int32_t *)s->frame.data[0];
316
317 // init per channel states
318 for (i = 0; i < s->channels; i++) {
319 s->ch_ctx[i].predictor = 0;
320 ttafilter_init(&s->ch_ctx[i].filter, ttafilter_configs[s->bps-1][0], ttafilter_configs[s->bps-1][1]);
321 rice_init(&s->ch_ctx[i].rice, 10, 10);
322 }
323
324 for (p = s->decode_buffer; p < s->decode_buffer + (framelen * s->channels); p++) {
325 int32_t *predictor = &s->ch_ctx[cur_chan].predictor;
326 TTAFilter *filter = &s->ch_ctx[cur_chan].filter;
327 TTARice *rice = &s->ch_ctx[cur_chan].rice;
328 uint32_t unary, depth, k;
329 int32_t value;
330
331 unary = tta_get_unary(&s->gb);
332
333 if (unary == 0) {
334 depth = 0;
335 k = rice->k0;
336 } else {
337 depth = 1;
338 k = rice->k1;
339 unary--;
340 }
341
342 if (get_bits_left(&s->gb) < k)
343 return -1;
344
345 if (k) {
346 if (k > MIN_CACHE_BITS)
347 return -1;
348 value = (unary << k) + get_bits(&s->gb, k);
349 } else
350 value = unary;
351
352 // FIXME: copy paste from original
353 switch (depth) {
354 case 1:
355 rice->sum1 += value - (rice->sum1 >> 4);
356 if (rice->k1 > 0 && rice->sum1 < shift_16[rice->k1])
357 rice->k1--;
358 else if(rice->sum1 > shift_16[rice->k1 + 1])
359 rice->k1++;
360 value += shift_1[rice->k0];
361 default:
362 rice->sum0 += value - (rice->sum0 >> 4);
363 if (rice->k0 > 0 && rice->sum0 < shift_16[rice->k0])
364 rice->k0--;
365 else if(rice->sum0 > shift_16[rice->k0 + 1])
366 rice->k0++;
367 }
368
369 // extract coded value
370 #define UNFOLD(x) (((x)&1) ? (++(x)>>1) : (-(x)>>1))
371 *p = UNFOLD(value);
372
373 // run hybrid filter
374 ttafilter_process(filter, p, 0);
375
376 // fixed order prediction
377 #define PRED(x, k) (int32_t)((((uint64_t)x << k) - x) >> k)
378 switch (s->bps) {
379 case 1: *p += PRED(*predictor, 4); break;
380 case 2:
381 case 3: *p += PRED(*predictor, 5); break;
382 case 4: *p += *predictor; break;
383 }
384 *predictor = *p;
385
386 // flip channels
387 if (cur_chan < (s->channels-1))
388 cur_chan++;
389 else {
390 // decorrelate in case of stereo integer
391 if (s->channels > 1) {
392 int32_t *r = p - 1;
393 for (*p += *r / 2; r > p - s->channels; r--)
394 *r = *(r + 1) - *r;
395 }
396 cur_chan = 0;
397 }
398 }
399
400 if (get_bits_left(&s->gb) < 32)
401 return -1;
402 skip_bits_long(&s->gb, 32); // frame crc
403
404 // convert to output buffer
405 if (s->bps == 2) {
406 int16_t *samples = (int16_t *)s->frame.data[0];
407 for (p = s->decode_buffer; p < s->decode_buffer + (framelen * s->channels); p++)
408 *samples++ = *p;
409 } else {
410 // shift samples for 24-bit sample format
411 int32_t *samples = (int32_t *)s->frame.data[0];
412 for (i = 0; i < framelen * s->channels; i++)
413 *samples++ <<= 8;
414 // reset decode buffer
415 s->decode_buffer = NULL;
416 }
417
418 *got_frame_ptr = 1;
419 *(AVFrame *)data = s->frame;
420
421 return buf_size;
422 }
423
424 static av_cold int tta_decode_close(AVCodecContext *avctx) {
425 TTAContext *s = avctx->priv_data;
426
427 av_free(s->decode_buffer);
428 av_freep(&s->ch_ctx);
429
430 return 0;
431 }
432
433 AVCodec ff_tta_decoder = {
434 .name = "tta",
435 .type = AVMEDIA_TYPE_AUDIO,
436 .id = CODEC_ID_TTA,
437 .priv_data_size = sizeof(TTAContext),
438 .init = tta_decode_init,
439 .close = tta_decode_close,
440 .decode = tta_decode_frame,
441 .capabilities = CODEC_CAP_DR1,
442 .long_name = NULL_IF_CONFIG_SMALL("True Audio (TTA)"),
443 };