Merge remote-tracking branch 'qatar/master'
[ffmpeg.git] / libavcodec / pcm.c
1 /*
2  * PCM codecs
3  * Copyright (c) 2001 Fabrice Bellard
4  *
5  * This file is part of FFmpeg.
6  *
7  * FFmpeg 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  * FFmpeg 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 FFmpeg; 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  * PCM codecs
25  */
26
27 #include "avcodec.h"
28 #include "libavutil/common.h" /* for av_reverse */
29 #include "bytestream.h"
30 #include "pcm_tablegen.h"
31
32 #define MAX_CHANNELS 64
33
34 static av_cold int pcm_encode_init(AVCodecContext *avctx)
35 {
36     avctx->frame_size = 1;
37     switch(avctx->codec->id) {
38     case CODEC_ID_PCM_ALAW:
39         pcm_alaw_tableinit();
40         break;
41     case CODEC_ID_PCM_MULAW:
42         pcm_ulaw_tableinit();
43         break;
44     default:
45         break;
46     }
47
48     avctx->bits_per_coded_sample = av_get_bits_per_sample(avctx->codec->id);
49     avctx->block_align = avctx->channels * avctx->bits_per_coded_sample/8;
50     avctx->coded_frame= avcodec_alloc_frame();
51     avctx->coded_frame->key_frame= 1;
52
53     return 0;
54 }
55
56 static av_cold int pcm_encode_close(AVCodecContext *avctx)
57 {
58     av_freep(&avctx->coded_frame);
59
60     return 0;
61 }
62
63 /**
64  * Write PCM samples macro
65  * @param type Datatype of native machine format
66  * @param endian bytestream_put_xxx() suffix
67  * @param src Source pointer (variable name)
68  * @param dst Destination pointer (variable name)
69  * @param n Total number of samples (variable name)
70  * @param shift Bitshift (bits)
71  * @param offset Sample value offset
72  */
73 #define ENCODE(type, endian, src, dst, n, shift, offset) \
74     samples_##type = (const type*) src; \
75     for(;n>0;n--) { \
76         register type v = (*samples_##type++ >> shift) + offset; \
77         bytestream_put_##endian(&dst, v); \
78     }
79
80 static int pcm_encode_frame(AVCodecContext *avctx,
81                             unsigned char *frame, int buf_size, void *data)
82 {
83     int n, sample_size, v;
84     const short *samples;
85     unsigned char *dst;
86     const uint8_t *srcu8;
87     const int16_t *samples_int16_t;
88     const int32_t *samples_int32_t;
89     const int64_t *samples_int64_t;
90     const uint16_t *samples_uint16_t;
91     const uint32_t *samples_uint32_t;
92
93     sample_size = av_get_bits_per_sample(avctx->codec->id)/8;
94     n = buf_size / sample_size;
95     samples = data;
96     dst = frame;
97
98     switch(avctx->codec->id) {
99     case CODEC_ID_PCM_U32LE:
100         ENCODE(uint32_t, le32, samples, dst, n, 0, 0x80000000)
101         break;
102     case CODEC_ID_PCM_U32BE:
103         ENCODE(uint32_t, be32, samples, dst, n, 0, 0x80000000)
104         break;
105     case CODEC_ID_PCM_S24LE:
106         ENCODE(int32_t, le24, samples, dst, n, 8, 0)
107         break;
108     case CODEC_ID_PCM_S24BE:
109         ENCODE(int32_t, be24, samples, dst, n, 8, 0)
110         break;
111     case CODEC_ID_PCM_U24LE:
112         ENCODE(uint32_t, le24, samples, dst, n, 8, 0x800000)
113         break;
114     case CODEC_ID_PCM_U24BE:
115         ENCODE(uint32_t, be24, samples, dst, n, 8, 0x800000)
116         break;
117     case CODEC_ID_PCM_S24DAUD:
118         for(;n>0;n--) {
119             uint32_t tmp = av_reverse[(*samples >> 8) & 0xff] +
120                            (av_reverse[*samples & 0xff] << 8);
121             tmp <<= 4; // sync flags would go here
122             bytestream_put_be24(&dst, tmp);
123             samples++;
124         }
125         break;
126     case CODEC_ID_PCM_U16LE:
127         ENCODE(uint16_t, le16, samples, dst, n, 0, 0x8000)
128         break;
129     case CODEC_ID_PCM_U16BE:
130         ENCODE(uint16_t, be16, samples, dst, n, 0, 0x8000)
131         break;
132     case CODEC_ID_PCM_S8:
133         srcu8= data;
134         for(;n>0;n--) {
135             v = *srcu8++;
136             *dst++ = v - 128;
137         }
138         break;
139 #if HAVE_BIGENDIAN
140     case CODEC_ID_PCM_F64LE:
141         ENCODE(int64_t, le64, samples, dst, n, 0, 0)
142         break;
143     case CODEC_ID_PCM_S32LE:
144     case CODEC_ID_PCM_F32LE:
145         ENCODE(int32_t, le32, samples, dst, n, 0, 0)
146         break;
147     case CODEC_ID_PCM_S16LE:
148         ENCODE(int16_t, le16, samples, dst, n, 0, 0)
149         break;
150     case CODEC_ID_PCM_F64BE:
151     case CODEC_ID_PCM_F32BE:
152     case CODEC_ID_PCM_S32BE:
153     case CODEC_ID_PCM_S16BE:
154 #else
155     case CODEC_ID_PCM_F64BE:
156         ENCODE(int64_t, be64, samples, dst, n, 0, 0)
157         break;
158     case CODEC_ID_PCM_F32BE:
159     case CODEC_ID_PCM_S32BE:
160         ENCODE(int32_t, be32, samples, dst, n, 0, 0)
161         break;
162     case CODEC_ID_PCM_S16BE:
163         ENCODE(int16_t, be16, samples, dst, n, 0, 0)
164         break;
165     case CODEC_ID_PCM_F64LE:
166     case CODEC_ID_PCM_F32LE:
167     case CODEC_ID_PCM_S32LE:
168     case CODEC_ID_PCM_S16LE:
169 #endif /* HAVE_BIGENDIAN */
170     case CODEC_ID_PCM_U8:
171         memcpy(dst, samples, n*sample_size);
172         dst += n*sample_size;
173         break;
174     case CODEC_ID_PCM_ALAW:
175         for(;n>0;n--) {
176             v = *samples++;
177             *dst++ = linear_to_alaw[(v + 32768) >> 2];
178         }
179         break;
180     case CODEC_ID_PCM_MULAW:
181         for(;n>0;n--) {
182             v = *samples++;
183             *dst++ = linear_to_ulaw[(v + 32768) >> 2];
184         }
185         break;
186     default:
187         return -1;
188     }
189     //avctx->frame_size = (dst - frame) / (sample_size * avctx->channels);
190
191     return dst - frame;
192 }
193
194 typedef struct PCMDecode {
195     AVFrame frame;
196     short table[256];
197 } PCMDecode;
198
199 static av_cold int pcm_decode_init(AVCodecContext * avctx)
200 {
201     PCMDecode *s = avctx->priv_data;
202     int i;
203
204     if (avctx->channels <= 0 || avctx->channels > MAX_CHANNELS) {
205         av_log(avctx, AV_LOG_ERROR, "PCM channels out of bounds\n");
206         return AVERROR(EINVAL);
207     }
208
209     switch(avctx->codec->id) {
210     case CODEC_ID_PCM_ALAW:
211         for(i=0;i<256;i++)
212             s->table[i] = alaw2linear(i);
213         break;
214     case CODEC_ID_PCM_MULAW:
215         for(i=0;i<256;i++)
216             s->table[i] = ulaw2linear(i);
217         break;
218     default:
219         break;
220     }
221
222     avctx->sample_fmt = avctx->codec->sample_fmts[0];
223
224     if (avctx->sample_fmt == AV_SAMPLE_FMT_S32)
225         avctx->bits_per_raw_sample = av_get_bits_per_sample(avctx->codec->id);
226
227     avcodec_get_frame_defaults(&s->frame);
228     avctx->coded_frame = &s->frame;
229
230     return 0;
231 }
232
233 /**
234  * Read PCM samples macro
235  * @param size Data size of native machine format
236  * @param endian bytestream_get_xxx() endian suffix
237  * @param src Source pointer (variable name)
238  * @param dst Destination pointer (variable name)
239  * @param n Total number of samples (variable name)
240  * @param shift Bitshift (bits)
241  * @param offset Sample value offset
242  */
243 #define DECODE(size, endian, src, dst, n, shift, offset) \
244     for(;n>0;n--) { \
245         uint##size##_t v = bytestream_get_##endian(&src); \
246         AV_WN##size##A(dst, (v - offset) << shift); \
247         dst += size / 8; \
248     }
249
250 static int pcm_decode_frame(AVCodecContext *avctx, void *data,
251                             int *got_frame_ptr, AVPacket *avpkt)
252 {
253     const uint8_t *src = avpkt->data;
254     int buf_size = avpkt->size;
255     PCMDecode *s = avctx->priv_data;
256     int sample_size, c, n, ret, samples_per_block;
257     uint8_t *samples;
258     int32_t *dst_int32_t;
259
260     sample_size = av_get_bits_per_sample(avctx->codec_id)/8;
261
262     /* av_get_bits_per_sample returns 0 for CODEC_ID_PCM_DVD */
263     samples_per_block = 1;
264     if (CODEC_ID_PCM_DVD == avctx->codec_id) {
265         if (avctx->bits_per_coded_sample != 20 &&
266             avctx->bits_per_coded_sample != 24) {
267             av_log(avctx, AV_LOG_ERROR,
268                    "PCM DVD unsupported sample depth %i\n",
269                    avctx->bits_per_coded_sample);
270             return AVERROR(EINVAL);
271         }
272         /* 2 samples are interleaved per block in PCM_DVD */
273         samples_per_block = 2;
274         sample_size = avctx->bits_per_coded_sample * 2 / 8;
275     } else if (avctx->codec_id == CODEC_ID_PCM_LXF) {
276         /* we process 40-bit blocks per channel for LXF */
277         samples_per_block = 2;
278         sample_size = 5;
279     }
280
281     if (sample_size == 0) {
282         av_log(avctx, AV_LOG_ERROR, "Invalid sample_size\n");
283         return AVERROR(EINVAL);
284     }
285
286     n = avctx->channels * sample_size;
287
288     if(n && buf_size % n){
289         if (buf_size < n) {
290             av_log(avctx, AV_LOG_ERROR, "invalid PCM packet\n");
291             return -1;
292         }else
293             buf_size -= buf_size % n;
294     }
295
296     n = buf_size/sample_size;
297
298     /* get output buffer */
299     s->frame.nb_samples = n * samples_per_block / avctx->channels;
300     if ((ret = avctx->get_buffer(avctx, &s->frame)) < 0) {
301         av_log(avctx, AV_LOG_ERROR, "get_buffer() failed\n");
302         return ret;
303     }
304     samples = s->frame.data[0];
305
306     switch(avctx->codec->id) {
307     case CODEC_ID_PCM_U32LE:
308         DECODE(32, le32, src, samples, n, 0, 0x80000000)
309         break;
310     case CODEC_ID_PCM_U32BE:
311         DECODE(32, be32, src, samples, n, 0, 0x80000000)
312         break;
313     case CODEC_ID_PCM_S24LE:
314         DECODE(32, le24, src, samples, n, 8, 0)
315         break;
316     case CODEC_ID_PCM_S24BE:
317         DECODE(32, be24, src, samples, n, 8, 0)
318         break;
319     case CODEC_ID_PCM_U24LE:
320         DECODE(32, le24, src, samples, n, 8, 0x800000)
321         break;
322     case CODEC_ID_PCM_U24BE:
323         DECODE(32, be24, src, samples, n, 8, 0x800000)
324         break;
325     case CODEC_ID_PCM_S24DAUD:
326         for(;n>0;n--) {
327           uint32_t v = bytestream_get_be24(&src);
328           v >>= 4; // sync flags are here
329           AV_WN16A(samples, av_reverse[(v >> 8) & 0xff] +
330                            (av_reverse[v & 0xff] << 8));
331           samples += 2;
332         }
333         break;
334     case CODEC_ID_PCM_S16LE_PLANAR:
335     {
336         const uint8_t *src2[MAX_CHANNELS];
337         n /= avctx->channels;
338         for(c=0;c<avctx->channels;c++)
339             src2[c] = &src[c*n*2];
340         for(;n>0;n--)
341             for(c=0;c<avctx->channels;c++) {
342                 AV_WN16A(samples, bytestream_get_le16(&src2[c]));
343                 samples += 2;
344             }
345         break;
346     }
347     case CODEC_ID_PCM_U16LE:
348         DECODE(16, le16, src, samples, n, 0, 0x8000)
349         break;
350     case CODEC_ID_PCM_U16BE:
351         DECODE(16, be16, src, samples, n, 0, 0x8000)
352         break;
353     case CODEC_ID_PCM_S8:
354         for(;n>0;n--) {
355             *samples++ = *src++ + 128;
356         }
357         break;
358 #if HAVE_BIGENDIAN
359     case CODEC_ID_PCM_F64LE:
360         DECODE(64, le64, src, samples, n, 0, 0)
361         break;
362     case CODEC_ID_PCM_S32LE:
363     case CODEC_ID_PCM_F32LE:
364         DECODE(32, le32, src, samples, n, 0, 0)
365         break;
366     case CODEC_ID_PCM_S16LE:
367         DECODE(16, le16, src, samples, n, 0, 0)
368         break;
369     case CODEC_ID_PCM_F64BE:
370     case CODEC_ID_PCM_F32BE:
371     case CODEC_ID_PCM_S32BE:
372     case CODEC_ID_PCM_S16BE:
373 #else
374     case CODEC_ID_PCM_F64BE:
375         DECODE(64, be64, src, samples, n, 0, 0)
376         break;
377     case CODEC_ID_PCM_F32BE:
378     case CODEC_ID_PCM_S32BE:
379         DECODE(32, be32, src, samples, n, 0, 0)
380         break;
381     case CODEC_ID_PCM_S16BE:
382         DECODE(16, be16, src, samples, n, 0, 0)
383         break;
384     case CODEC_ID_PCM_F64LE:
385     case CODEC_ID_PCM_F32LE:
386     case CODEC_ID_PCM_S32LE:
387     case CODEC_ID_PCM_S16LE:
388 #endif /* HAVE_BIGENDIAN */
389     case CODEC_ID_PCM_U8:
390         memcpy(samples, src, n*sample_size);
391         break;
392     case CODEC_ID_PCM_ZORK:
393         for (; n > 0; n--) {
394             int v = *src++;
395             if (v < 128)
396                 v = 128 - v;
397             *samples++ = v;
398         }
399         break;
400     case CODEC_ID_PCM_ALAW:
401     case CODEC_ID_PCM_MULAW:
402         for(;n>0;n--) {
403             AV_WN16A(samples, s->table[*src++]);
404             samples += 2;
405         }
406         break;
407     case CODEC_ID_PCM_DVD:
408     {
409         const uint8_t *src8;
410         dst_int32_t = (int32_t *)s->frame.data[0];
411         n /= avctx->channels;
412         switch (avctx->bits_per_coded_sample) {
413         case 20:
414             while (n--) {
415                 c = avctx->channels;
416                 src8 = src + 4*c;
417                 while (c--) {
418                     *dst_int32_t++ = (bytestream_get_be16(&src) << 16) + ((*src8   &0xf0) << 8);
419                     *dst_int32_t++ = (bytestream_get_be16(&src) << 16) + ((*src8++ &0x0f) << 12);
420                 }
421                 src = src8;
422             }
423             break;
424         case 24:
425             while (n--) {
426                 c = avctx->channels;
427                 src8 = src + 4*c;
428                 while (c--) {
429                     *dst_int32_t++ = (bytestream_get_be16(&src) << 16) + ((*src8++) << 8);
430                     *dst_int32_t++ = (bytestream_get_be16(&src) << 16) + ((*src8++) << 8);
431                 }
432                 src = src8;
433             }
434             break;
435         }
436         break;
437     }
438     case CODEC_ID_PCM_LXF:
439     {
440         int i;
441         const uint8_t *src8;
442         dst_int32_t = (int32_t *)s->frame.data[0];
443         n /= avctx->channels;
444         //unpack and de-planerize
445         for (i = 0; i < n; i++) {
446             for (c = 0, src8 = src + i*5; c < avctx->channels; c++, src8 += n*5) {
447                 //extract low 20 bits and expand to 32 bits
448                 *dst_int32_t++ = (src8[2] << 28) | (src8[1] << 20) | (src8[0] << 12) |
449                                  ((src8[2] & 0xF) << 8) | src8[1];
450             }
451
452             for (c = 0, src8 = src + i*5; c < avctx->channels; c++, src8 += n*5) {
453                 //extract high 20 bits and expand to 32 bits
454                 *dst_int32_t++ = (src8[4] << 24) | (src8[3] << 16) |
455                                  ((src8[2] & 0xF0) << 8) | (src8[4] << 4) | (src8[3] >> 4);
456             }
457         }
458         break;
459     }
460     default:
461         return -1;
462     }
463
464     *got_frame_ptr   = 1;
465     *(AVFrame *)data = s->frame;
466
467     return buf_size;
468 }
469
470 #if CONFIG_ENCODERS
471 #define PCM_ENCODER(id_,sample_fmt_,name_,long_name_) \
472 AVCodec ff_ ## name_ ## _encoder = {            \
473     .name        = #name_,                      \
474     .type        = AVMEDIA_TYPE_AUDIO,          \
475     .id          = id_,                         \
476     .init        = pcm_encode_init,             \
477     .encode      = pcm_encode_frame,            \
478     .close       = pcm_encode_close,            \
479     .sample_fmts = (const enum AVSampleFormat[]){sample_fmt_,AV_SAMPLE_FMT_NONE}, \
480     .long_name = NULL_IF_CONFIG_SMALL(long_name_), \
481 }
482 #else
483 #define PCM_ENCODER(id,sample_fmt_,name,long_name_)
484 #endif
485
486 #if CONFIG_DECODERS
487 #define PCM_DECODER(id_,sample_fmt_,name_,long_name_)         \
488 AVCodec ff_ ## name_ ## _decoder = {            \
489     .name           = #name_,                   \
490     .type           = AVMEDIA_TYPE_AUDIO,       \
491     .id             = id_,                      \
492     .priv_data_size = sizeof(PCMDecode),        \
493     .init           = pcm_decode_init,          \
494     .decode         = pcm_decode_frame,         \
495     .capabilities   = CODEC_CAP_DR1,            \
496     .sample_fmts = (const enum AVSampleFormat[]){sample_fmt_,AV_SAMPLE_FMT_NONE}, \
497     .long_name = NULL_IF_CONFIG_SMALL(long_name_), \
498 }
499 #else
500 #define PCM_DECODER(id,sample_fmt_,name,long_name_)
501 #endif
502
503 #define PCM_CODEC(id, sample_fmt_, name, long_name_)         \
504     PCM_ENCODER(id,sample_fmt_,name,long_name_); PCM_DECODER(id,sample_fmt_,name,long_name_)
505
506 /* Note: Do not forget to add new entries to the Makefile as well. */
507 PCM_CODEC  (CODEC_ID_PCM_ALAW,  AV_SAMPLE_FMT_S16, pcm_alaw, "PCM A-law");
508 PCM_DECODER(CODEC_ID_PCM_DVD,   AV_SAMPLE_FMT_S32, pcm_dvd, "PCM signed 20|24-bit big-endian");
509 PCM_CODEC  (CODEC_ID_PCM_F32BE, AV_SAMPLE_FMT_FLT, pcm_f32be, "PCM 32-bit floating point big-endian");
510 PCM_CODEC  (CODEC_ID_PCM_F32LE, AV_SAMPLE_FMT_FLT, pcm_f32le, "PCM 32-bit floating point little-endian");
511 PCM_CODEC  (CODEC_ID_PCM_F64BE, AV_SAMPLE_FMT_DBL, pcm_f64be, "PCM 64-bit floating point big-endian");
512 PCM_CODEC  (CODEC_ID_PCM_F64LE, AV_SAMPLE_FMT_DBL, pcm_f64le, "PCM 64-bit floating point little-endian");
513 PCM_DECODER(CODEC_ID_PCM_LXF,   AV_SAMPLE_FMT_S32, pcm_lxf, "PCM signed 20-bit little-endian planar");
514 PCM_CODEC  (CODEC_ID_PCM_MULAW, AV_SAMPLE_FMT_S16, pcm_mulaw, "PCM mu-law");
515 PCM_CODEC  (CODEC_ID_PCM_S8,    AV_SAMPLE_FMT_U8,  pcm_s8, "PCM signed 8-bit");
516 PCM_CODEC  (CODEC_ID_PCM_S16BE, AV_SAMPLE_FMT_S16, pcm_s16be, "PCM signed 16-bit big-endian");
517 PCM_CODEC  (CODEC_ID_PCM_S16LE, AV_SAMPLE_FMT_S16, pcm_s16le, "PCM signed 16-bit little-endian");
518 PCM_DECODER(CODEC_ID_PCM_S16LE_PLANAR, AV_SAMPLE_FMT_S16, pcm_s16le_planar, "PCM 16-bit little-endian planar");
519 PCM_CODEC  (CODEC_ID_PCM_S24BE, AV_SAMPLE_FMT_S32, pcm_s24be, "PCM signed 24-bit big-endian");
520 PCM_CODEC  (CODEC_ID_PCM_S24DAUD, AV_SAMPLE_FMT_S16,  pcm_s24daud, "PCM D-Cinema audio signed 24-bit");
521 PCM_CODEC  (CODEC_ID_PCM_S24LE, AV_SAMPLE_FMT_S32, pcm_s24le, "PCM signed 24-bit little-endian");
522 PCM_CODEC  (CODEC_ID_PCM_S32BE, AV_SAMPLE_FMT_S32, pcm_s32be, "PCM signed 32-bit big-endian");
523 PCM_CODEC  (CODEC_ID_PCM_S32LE, AV_SAMPLE_FMT_S32, pcm_s32le, "PCM signed 32-bit little-endian");
524 PCM_CODEC  (CODEC_ID_PCM_U8,    AV_SAMPLE_FMT_U8,  pcm_u8, "PCM unsigned 8-bit");
525 PCM_CODEC  (CODEC_ID_PCM_U16BE, AV_SAMPLE_FMT_S16, pcm_u16be, "PCM unsigned 16-bit big-endian");
526 PCM_CODEC  (CODEC_ID_PCM_U16LE, AV_SAMPLE_FMT_S16, pcm_u16le, "PCM unsigned 16-bit little-endian");
527 PCM_CODEC  (CODEC_ID_PCM_U24BE, AV_SAMPLE_FMT_S32, pcm_u24be, "PCM unsigned 24-bit big-endian");
528 PCM_CODEC  (CODEC_ID_PCM_U24LE, AV_SAMPLE_FMT_S32, pcm_u24le, "PCM unsigned 24-bit little-endian");
529 PCM_CODEC  (CODEC_ID_PCM_U32BE, AV_SAMPLE_FMT_S32, pcm_u32be, "PCM unsigned 32-bit big-endian");
530 PCM_CODEC  (CODEC_ID_PCM_U32LE, AV_SAMPLE_FMT_S32, pcm_u32le, "PCM unsigned 32-bit little-endian");
531 PCM_DECODER(CODEC_ID_PCM_ZORK,  AV_SAMPLE_FMT_U8,  pcm_zork,  "PCM Zork");