prevent assert failure with negative quant_offset
[libav.git] / libavcodec / pcm.c
CommitLineData
a96b68b7
FB
1/*
2 * PCM codecs
ff4ec49e 3 * Copyright (c) 2001 Fabrice Bellard.
a96b68b7 4 *
b78e7197
DB
5 * This file is part of FFmpeg.
6 *
7 * FFmpeg is free software; you can redistribute it and/or
ff4ec49e
FB
8 * modify it under the terms of the GNU Lesser General Public
9 * License as published by the Free Software Foundation; either
b78e7197 10 * version 2.1 of the License, or (at your option) any later version.
a96b68b7 11 *
b78e7197 12 * FFmpeg is distributed in the hope that it will be useful,
a96b68b7 13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
ff4ec49e
FB
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 * Lesser General Public License for more details.
a96b68b7 16 *
ff4ec49e 17 * You should have received a copy of the GNU Lesser General Public
b78e7197 18 * License along with FFmpeg; if not, write to the Free Software
5509bffa 19 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
a96b68b7 20 */
115329f1 21
1ab3d669
MN
22/**
23 * @file pcm.c
24 * PCM codecs
25 */
115329f1 26
a96b68b7 27#include "avcodec.h"
b461b3bc 28#include "bitstream.h" // for ff_reverse
5a2f421a 29#include "bytestream.h"
a96b68b7
FB
30
31/* from g711.c by SUN microsystems (unrestricted use) */
32
bb270c08
DB
33#define SIGN_BIT (0x80) /* Sign bit for a A-law byte. */
34#define QUANT_MASK (0xf) /* Quantization field mask. */
35#define NSEGS (8) /* Number of A-law segments. */
36#define SEG_SHIFT (4) /* Left shift for segment number. */
37#define SEG_MASK (0x70) /* Segment field mask. */
a96b68b7 38
bb270c08 39#define BIAS (0x84) /* Bias for linear code. */
a96b68b7
FB
40
41/*
42 * alaw2linear() - Convert an A-law value to 16-bit linear PCM
43 *
44 */
bb270c08 45static int alaw2linear(unsigned char a_val)
a96b68b7 46{
bb270c08
DB
47 int t;
48 int seg;
a96b68b7 49
bb270c08 50 a_val ^= 0x55;
a96b68b7 51
bb270c08
DB
52 t = a_val & QUANT_MASK;
53 seg = ((unsigned)a_val & SEG_MASK) >> SEG_SHIFT;
54 if(seg) t= (t + t + 1 + 32) << (seg + 2);
55 else t= (t + t + 1 ) << 3;
cd1f22f9 56
bb270c08 57 return ((a_val & SIGN_BIT) ? t : -t);
a96b68b7
FB
58}
59
bb270c08 60static int ulaw2linear(unsigned char u_val)
a96b68b7 61{
bb270c08 62 int t;
a96b68b7 63
bb270c08
DB
64 /* Complement to obtain normal u-law value. */
65 u_val = ~u_val;
a96b68b7 66
bb270c08
DB
67 /*
68 * Extract and bias the quantization bits. Then
69 * shift up by the segment number and subtract out the bias.
70 */
71 t = ((u_val & QUANT_MASK) << 3) + BIAS;
72 t <<= ((unsigned)u_val & SEG_MASK) >> SEG_SHIFT;
a96b68b7 73
bb270c08 74 return ((u_val & SIGN_BIT) ? (BIAS - t) : (t - BIAS));
a96b68b7
FB
75}
76
77/* 16384 entries per table */
e2e712e7
MN
78static uint8_t linear_to_alaw[16384];
79static uint8_t linear_to_ulaw[16384];
a96b68b7 80
115329f1 81static void build_xlaw_table(uint8_t *linear_to_xlaw,
a96b68b7 82 int (*xlaw2linear)(unsigned char),
115329f1 83 int mask)
a96b68b7
FB
84{
85 int i, j, v, v1, v2;
86
87 j = 0;
88 for(i=0;i<128;i++) {
89 if (i != 127) {
90 v1 = xlaw2linear(i ^ mask);
91 v2 = xlaw2linear((i + 1) ^ mask);
92 v = (v1 + v2 + 4) >> 3;
93 } else {
94 v = 8192;
95 }
96 for(;j<v;j++) {
97 linear_to_xlaw[8192 + j] = (i ^ mask);
98 if (j > 0)
99 linear_to_xlaw[8192 - j] = (i ^ (mask ^ 0x80));
100 }
101 }
102 linear_to_xlaw[0] = linear_to_xlaw[1];
103}
104
cd4af68a 105static int pcm_encode_init(AVCodecContext *avctx)
a96b68b7
FB
106{
107 avctx->frame_size = 1;
108 switch(avctx->codec->id) {
109 case CODEC_ID_PCM_ALAW:
e2e712e7 110 build_xlaw_table(linear_to_alaw, alaw2linear, 0xd5);
a96b68b7
FB
111 break;
112 case CODEC_ID_PCM_MULAW:
e2e712e7 113 build_xlaw_table(linear_to_ulaw, ulaw2linear, 0xff);
a96b68b7
FB
114 break;
115 default:
116 break;
117 }
115329f1 118
359fa0fe 119 switch(avctx->codec->id) {
b461b3bc
RD
120 case CODEC_ID_PCM_S32LE:
121 case CODEC_ID_PCM_S32BE:
122 case CODEC_ID_PCM_U32LE:
123 case CODEC_ID_PCM_U32BE:
124 avctx->block_align = 4 * avctx->channels;
125 break;
126 case CODEC_ID_PCM_S24LE:
127 case CODEC_ID_PCM_S24BE:
128 case CODEC_ID_PCM_U24LE:
129 case CODEC_ID_PCM_U24BE:
130 case CODEC_ID_PCM_S24DAUD:
131 avctx->block_align = 3 * avctx->channels;
132 break;
359fa0fe
MN
133 case CODEC_ID_PCM_S16LE:
134 case CODEC_ID_PCM_S16BE:
135 case CODEC_ID_PCM_U16LE:
136 case CODEC_ID_PCM_U16BE:
137 avctx->block_align = 2 * avctx->channels;
138 break;
139 case CODEC_ID_PCM_S8:
140 case CODEC_ID_PCM_U8:
141 case CODEC_ID_PCM_MULAW:
142 case CODEC_ID_PCM_ALAW:
143 avctx->block_align = avctx->channels;
144 break;
145 default:
146 break;
147 }
148
492cd3a9
MN
149 avctx->coded_frame= avcodec_alloc_frame();
150 avctx->coded_frame->key_frame= 1;
115329f1 151
a96b68b7
FB
152 return 0;
153}
154
cd4af68a 155static int pcm_encode_close(AVCodecContext *avctx)
a96b68b7 156{
492cd3a9
MN
157 av_freep(&avctx->coded_frame);
158
a96b68b7
FB
159 return 0;
160}
161
b461b3bc
RD
162/**
163 * \brief convert samples from 16 bit
164 * \param bps byte per sample for the destination format, must be >= 2
165 * \param le 0 for big-, 1 for little-endian
6c0d6064 166 * \param us 0 for signed, 1 for unsigned output
b461b3bc
RD
167 * \param samples input samples
168 * \param dst output samples
169 * \param n number of samples in samples buffer.
170 */
171static inline void encode_from16(int bps, int le, int us,
172 short **samples, uint8_t **dst, int n) {
7d5aaa04 173 int usum = us ? 0x8000 : 0;
b461b3bc
RD
174 if (bps > 2)
175 memset(*dst, 0, n * bps);
176 if (le) *dst += bps - 2;
177 for(;n>0;n--) {
178 register int v = *(*samples)++;
7d5aaa04 179 v += usum;
b3a257af
RP
180 if (le) AV_WL16(*dst, v);
181 else AV_WB16(*dst, v);
b461b3bc
RD
182 *dst += bps;
183 }
184 if (le) *dst -= bps - 2;
185}
186
cd4af68a 187static int pcm_encode_frame(AVCodecContext *avctx,
bb270c08 188 unsigned char *frame, int buf_size, void *data)
a96b68b7
FB
189{
190 int n, sample_size, v;
191 short *samples;
192 unsigned char *dst;
193
194 switch(avctx->codec->id) {
b461b3bc
RD
195 case CODEC_ID_PCM_S32LE:
196 case CODEC_ID_PCM_S32BE:
197 case CODEC_ID_PCM_U32LE:
198 case CODEC_ID_PCM_U32BE:
199 sample_size = 4;
200 break;
201 case CODEC_ID_PCM_S24LE:
202 case CODEC_ID_PCM_S24BE:
203 case CODEC_ID_PCM_U24LE:
204 case CODEC_ID_PCM_U24BE:
205 case CODEC_ID_PCM_S24DAUD:
206 sample_size = 3;
207 break;
a96b68b7
FB
208 case CODEC_ID_PCM_S16LE:
209 case CODEC_ID_PCM_S16BE:
210 case CODEC_ID_PCM_U16LE:
211 case CODEC_ID_PCM_U16BE:
212 sample_size = 2;
213 break;
214 default:
215 sample_size = 1;
216 break;
217 }
218 n = buf_size / sample_size;
219 samples = data;
220 dst = frame;
221
222 switch(avctx->codec->id) {
b461b3bc
RD
223 case CODEC_ID_PCM_S32LE:
224 encode_from16(4, 1, 0, &samples, &dst, n);
225 break;
226 case CODEC_ID_PCM_S32BE:
227 encode_from16(4, 0, 0, &samples, &dst, n);
228 break;
229 case CODEC_ID_PCM_U32LE:
230 encode_from16(4, 1, 1, &samples, &dst, n);
231 break;
232 case CODEC_ID_PCM_U32BE:
233 encode_from16(4, 0, 1, &samples, &dst, n);
234 break;
235 case CODEC_ID_PCM_S24LE:
236 encode_from16(3, 1, 0, &samples, &dst, n);
237 break;
238 case CODEC_ID_PCM_S24BE:
239 encode_from16(3, 0, 0, &samples, &dst, n);
240 break;
241 case CODEC_ID_PCM_U24LE:
242 encode_from16(3, 1, 1, &samples, &dst, n);
243 break;
244 case CODEC_ID_PCM_U24BE:
245 encode_from16(3, 0, 1, &samples, &dst, n);
246 break;
247 case CODEC_ID_PCM_S24DAUD:
248 for(;n>0;n--) {
249 uint32_t tmp = ff_reverse[*samples >> 8] +
250 (ff_reverse[*samples & 0xff] << 8);
251 tmp <<= 4; // sync flags would go here
5a2f421a 252 bytestream_put_be24(&dst, tmp);
b461b3bc 253 samples++;
b461b3bc
RD
254 }
255 break;
a96b68b7
FB
256 case CODEC_ID_PCM_S16LE:
257 for(;n>0;n--) {
258 v = *samples++;
5a2f421a 259 bytestream_put_le16(&dst, v);
a96b68b7
FB
260 }
261 break;
262 case CODEC_ID_PCM_S16BE:
263 for(;n>0;n--) {
264 v = *samples++;
5a2f421a 265 bytestream_put_be16(&dst, v);
a96b68b7
FB
266 }
267 break;
268 case CODEC_ID_PCM_U16LE:
269 for(;n>0;n--) {
270 v = *samples++;
271 v += 0x8000;
5a2f421a 272 bytestream_put_le16(&dst, v);
a96b68b7
FB
273 }
274 break;
275 case CODEC_ID_PCM_U16BE:
276 for(;n>0;n--) {
277 v = *samples++;
278 v += 0x8000;
5a2f421a 279 bytestream_put_be16(&dst, v);
a96b68b7
FB
280 }
281 break;
282 case CODEC_ID_PCM_S8:
283 for(;n>0;n--) {
284 v = *samples++;
a4461664 285 *dst++ = v >> 8;
a96b68b7
FB
286 }
287 break;
288 case CODEC_ID_PCM_U8:
289 for(;n>0;n--) {
290 v = *samples++;
a4461664 291 *dst++ = (v >> 8) + 128;
a96b68b7
FB
292 }
293 break;
294 case CODEC_ID_PCM_ALAW:
295 for(;n>0;n--) {
296 v = *samples++;
a4461664 297 *dst++ = linear_to_alaw[(v + 32768) >> 2];
a96b68b7
FB
298 }
299 break;
300 case CODEC_ID_PCM_MULAW:
301 for(;n>0;n--) {
302 v = *samples++;
a4461664 303 *dst++ = linear_to_ulaw[(v + 32768) >> 2];
a96b68b7
FB
304 }
305 break;
306 default:
307 return -1;
308 }
13a0314f 309 //avctx->frame_size = (dst - frame) / (sample_size * avctx->channels);
4c3d2e5f 310
a96b68b7
FB
311 return dst - frame;
312}
313
314typedef struct PCMDecode {
315 short table[256];
316} PCMDecode;
317
cd4af68a 318static int pcm_decode_init(AVCodecContext * avctx)
a96b68b7
FB
319{
320 PCMDecode *s = avctx->priv_data;
321 int i;
322
323 switch(avctx->codec->id) {
324 case CODEC_ID_PCM_ALAW:
325 for(i=0;i<256;i++)
326 s->table[i] = alaw2linear(i);
327 break;
328 case CODEC_ID_PCM_MULAW:
329 for(i=0;i<256;i++)
330 s->table[i] = ulaw2linear(i);
331 break;
332 default:
333 break;
334 }
335 return 0;
336}
337
b461b3bc
RD
338/**
339 * \brief convert samples to 16 bit
340 * \param bps byte per sample for the source format, must be >= 2
341 * \param le 0 for big-, 1 for little-endian
6c0d6064 342 * \param us 0 for signed, 1 for unsigned input
b461b3bc
RD
343 * \param src input samples
344 * \param samples output samples
345 * \param src_len number of bytes in src
346 */
347static inline void decode_to16(int bps, int le, int us,
348 uint8_t **src, short **samples, int src_len)
349{
7d5aaa04 350 int usum = us ? -0x8000 : 0;
b461b3bc
RD
351 register int n = src_len / bps;
352 if (le) *src += bps - 2;
353 for(;n>0;n--) {
a32c2ce4
RP
354 register int v;
355 if (le) v = AV_RL16(*src);
356 else v = AV_RB16(*src);
357 v += usum;
358 *(*samples)++ = v;
b461b3bc
RD
359 *src += bps;
360 }
361 if (le) *src -= bps - 2;
362}
363
cd4af68a 364static int pcm_decode_frame(AVCodecContext *avctx,
bb270c08
DB
365 void *data, int *data_size,
366 uint8_t *buf, int buf_size)
a96b68b7
FB
367{
368 PCMDecode *s = avctx->priv_data;
369 int n;
370 short *samples;
0c1a9eda 371 uint8_t *src;
a96b68b7
FB
372
373 samples = data;
374 src = buf;
375
b2a581dc
MN
376 n= av_get_bits_per_sample(avctx->codec_id)/8;
377 if(n && buf_size % n){
378 av_log(avctx, AV_LOG_ERROR, "invalid PCM packet\n");
379 return -1;
380 }
381
ac66834c
MN
382 buf_size= FFMIN(buf_size, *data_size/2);
383 *data_size=0;
a8d02f2b 384
a96b68b7 385 switch(avctx->codec->id) {
b461b3bc
RD
386 case CODEC_ID_PCM_S32LE:
387 decode_to16(4, 1, 0, &src, &samples, buf_size);
388 break;
389 case CODEC_ID_PCM_S32BE:
390 decode_to16(4, 0, 0, &src, &samples, buf_size);
391 break;
392 case CODEC_ID_PCM_U32LE:
393 decode_to16(4, 1, 1, &src, &samples, buf_size);
394 break;
395 case CODEC_ID_PCM_U32BE:
396 decode_to16(4, 0, 1, &src, &samples, buf_size);
397 break;
398 case CODEC_ID_PCM_S24LE:
399 decode_to16(3, 1, 0, &src, &samples, buf_size);
400 break;
401 case CODEC_ID_PCM_S24BE:
402 decode_to16(3, 0, 0, &src, &samples, buf_size);
403 break;
404 case CODEC_ID_PCM_U24LE:
405 decode_to16(3, 1, 1, &src, &samples, buf_size);
406 break;
407 case CODEC_ID_PCM_U24BE:
408 decode_to16(3, 0, 1, &src, &samples, buf_size);
409 break;
410 case CODEC_ID_PCM_S24DAUD:
411 n = buf_size / 3;
412 for(;n>0;n--) {
5a2f421a 413 uint32_t v = bytestream_get_be24(&src);
b461b3bc
RD
414 v >>= 4; // sync flags are here
415 *samples++ = ff_reverse[(v >> 8) & 0xff] +
416 (ff_reverse[v & 0xff] << 8);
b461b3bc
RD
417 }
418 break;
a96b68b7
FB
419 case CODEC_ID_PCM_S16LE:
420 n = buf_size >> 1;
421 for(;n>0;n--) {
5a2f421a 422 *samples++ = bytestream_get_le16(&src);
a96b68b7
FB
423 }
424 break;
425 case CODEC_ID_PCM_S16BE:
426 n = buf_size >> 1;
427 for(;n>0;n--) {
5a2f421a 428 *samples++ = bytestream_get_be16(&src);
a96b68b7
FB
429 }
430 break;
431 case CODEC_ID_PCM_U16LE:
432 n = buf_size >> 1;
433 for(;n>0;n--) {
5a2f421a 434 *samples++ = bytestream_get_le16(&src) - 0x8000;
a96b68b7
FB
435 }
436 break;
437 case CODEC_ID_PCM_U16BE:
438 n = buf_size >> 1;
439 for(;n>0;n--) {
5a2f421a 440 *samples++ = bytestream_get_be16(&src) - 0x8000;
a96b68b7
FB
441 }
442 break;
443 case CODEC_ID_PCM_S8:
444 n = buf_size;
445 for(;n>0;n--) {
a4461664 446 *samples++ = *src++ << 8;
a96b68b7
FB
447 }
448 break;
449 case CODEC_ID_PCM_U8:
450 n = buf_size;
451 for(;n>0;n--) {
a4461664 452 *samples++ = ((int)*src++ - 128) << 8;
a96b68b7
FB
453 }
454 break;
455 case CODEC_ID_PCM_ALAW:
456 case CODEC_ID_PCM_MULAW:
457 n = buf_size;
458 for(;n>0;n--) {
a4461664 459 *samples++ = s->table[*src++];
a96b68b7
FB
460 }
461 break;
462 default:
a96b68b7
FB
463 return -1;
464 }
0c1a9eda 465 *data_size = (uint8_t *)samples - (uint8_t *)data;
a96b68b7
FB
466 return src - buf;
467}
468
469#define PCM_CODEC(id, name) \
470AVCodec name ## _encoder = { \
471 #name, \
472 CODEC_TYPE_AUDIO, \
473 id, \
474 0, \
bb270c08
DB
475 pcm_encode_init, \
476 pcm_encode_frame, \
477 pcm_encode_close, \
a96b68b7
FB
478 NULL, \
479}; \
480AVCodec name ## _decoder = { \
481 #name, \
482 CODEC_TYPE_AUDIO, \
483 id, \
484 sizeof(PCMDecode), \
bb270c08 485 pcm_decode_init, \
a96b68b7
FB
486 NULL, \
487 NULL, \
cd4af68a 488 pcm_decode_frame, \
ef9f7306 489}
a96b68b7 490
b461b3bc
RD
491PCM_CODEC(CODEC_ID_PCM_S32LE, pcm_s32le);
492PCM_CODEC(CODEC_ID_PCM_S32BE, pcm_s32be);
493PCM_CODEC(CODEC_ID_PCM_U32LE, pcm_u32le);
494PCM_CODEC(CODEC_ID_PCM_U32BE, pcm_u32be);
495PCM_CODEC(CODEC_ID_PCM_S24LE, pcm_s24le);
496PCM_CODEC(CODEC_ID_PCM_S24BE, pcm_s24be);
497PCM_CODEC(CODEC_ID_PCM_U24LE, pcm_u24le);
498PCM_CODEC(CODEC_ID_PCM_U24BE, pcm_u24be);
499PCM_CODEC(CODEC_ID_PCM_S24DAUD, pcm_s24daud);
a96b68b7
FB
500PCM_CODEC(CODEC_ID_PCM_S16LE, pcm_s16le);
501PCM_CODEC(CODEC_ID_PCM_S16BE, pcm_s16be);
502PCM_CODEC(CODEC_ID_PCM_U16LE, pcm_u16le);
503PCM_CODEC(CODEC_ID_PCM_U16BE, pcm_u16be);
504PCM_CODEC(CODEC_ID_PCM_S8, pcm_s8);
505PCM_CODEC(CODEC_ID_PCM_U8, pcm_u8);
506PCM_CODEC(CODEC_ID_PCM_ALAW, pcm_alaw);
507PCM_CODEC(CODEC_ID_PCM_MULAW, pcm_mulaw);
cd4af68a
ZK
508
509#undef PCM_CODEC