Port SMPTE S302M audio decoder from FFmbc 0.3.
[ffmpeg.git] / libavcodec / s302m.c
1 /*
2  * SMPTE 302M decoder
3  * Copyright (c) 2008 Laurent Aimar <fenrir@videolan.org>
4  * Copyright (c) 2009 Baptiste Coudurier <baptiste.coudurier@gmail.com>
5  *
6  * This file is part of Libav.
7  *
8  * Libav is free software; you can redistribute it and/or
9  * modify it under the terms of the GNU Lesser General Public
10  * License as published by the Free Software Foundation; either
11  * version 2.1 of the License, or (at your option) any later version.
12  *
13  * Libav is distributed in the hope that it will be useful,
14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
16  * Lesser General Public License for more details.
17  *
18  * You should have received a copy of the GNU Lesser General Public
19  * License along with Libav; if not, write to the Free Software
20  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
21  */
22
23 #include "libavutil/intreadwrite.h"
24 #include "avcodec.h"
25
26 #define AES3_HEADER_LEN 4
27
28 static int s302m_parse_frame_header(AVCodecContext *avctx, const uint8_t *buf,
29                                     int buf_size)
30 {
31     uint32_t h;
32     int frame_size, channels, id, bits;
33
34     if (buf_size <= AES3_HEADER_LEN) {
35         av_log(avctx, AV_LOG_ERROR, "frame is too short\n");
36         return AVERROR_INVALIDDATA;
37     }
38
39     /*
40      * AES3 header :
41      * size:            16
42      * number channels   2
43      * channel_id        8
44      * bits per samples  2
45      * alignments        4
46      */
47
48     h = AV_RB32(buf);
49     frame_size =  (h >> 16) & 0xffff;
50     channels   = ((h >> 14) & 0x0003) * 2 +  2;
51     id         =  (h >>  6) & 0x00ff;
52     bits       = ((h >>  4) & 0x0003) * 4 + 16;
53
54     if (AES3_HEADER_LEN + frame_size != buf_size || bits > 24) {
55         av_log(avctx, AV_LOG_ERROR, "frame has invalid header\n");
56         return AVERROR_INVALIDDATA;
57     }
58
59     /* Set output properties */
60     avctx->bits_per_coded_sample = bits;
61     if (bits > 16)
62         avctx->sample_fmt = SAMPLE_FMT_S32;
63     else
64         avctx->sample_fmt = SAMPLE_FMT_S16;
65
66     avctx->channels    = channels;
67     avctx->sample_rate = 48000;
68     avctx->bit_rate    = 48000 * avctx->channels * (avctx->bits_per_coded_sample + 4) +
69                          32 * (48000 / (buf_size * 8 /
70                                         (avctx->channels *
71                                          (avctx->bits_per_coded_sample + 4))));
72
73     return frame_size;
74 }
75
76 static int s302m_decode_frame(AVCodecContext *avctx, void *data,
77                               int *data_size, AVPacket *avpkt)
78 {
79     const uint8_t *buf = avpkt->data;
80     int buf_size       = avpkt->size;
81
82     int frame_size = s302m_parse_frame_header(avctx, buf, buf_size);
83     if (frame_size < 0)
84         return frame_size;
85
86     buf_size -= AES3_HEADER_LEN;
87     buf      += AES3_HEADER_LEN;
88
89     if (*data_size < 4 * buf_size * 8 / (avctx->bits_per_coded_sample + 4))
90         return -1;
91
92     if (avctx->bits_per_coded_sample == 24) {
93         uint32_t *o = data;
94         for (; buf_size > 6; buf_size -= 7) {
95             *o++ = (av_reverse[buf[2]]        << 24) |
96                    (av_reverse[buf[1]]        << 16) |
97                    (av_reverse[buf[0]]        <<  8);
98             *o++ = (av_reverse[buf[6] & 0xf0] << 28) |
99                    (av_reverse[buf[5]]        << 20) |
100                    (av_reverse[buf[4]]        << 12) |
101                    (av_reverse[buf[3] & 0x0f] <<  8);
102             buf += 7;
103         }
104         *data_size = (uint8_t*) o - (uint8_t*) data;
105     } else if (avctx->bits_per_coded_sample == 20) {
106         uint32_t *o = data;
107         for (; buf_size > 5; buf_size -= 6) {
108             *o++ = (av_reverse[buf[2] & 0xf0] << 28) |
109                    (av_reverse[buf[1]]        << 20) |
110                    (av_reverse[buf[0]]        << 12);
111             *o++ = (av_reverse[buf[5] & 0xf0] << 28) |
112                    (av_reverse[buf[4]]        << 20) |
113                    (av_reverse[buf[3]]        << 12);
114             buf += 6;
115         }
116         *data_size = (uint8_t*) o - (uint8_t*) data;
117     } else {
118         uint16_t *o = data;
119         for (; buf_size > 4; buf_size -= 5) {
120             *o++ = (av_reverse[buf[1]]        <<  8) |
121                     av_reverse[buf[0]];
122             *o++ = (av_reverse[buf[4] & 0xf0] << 12) |
123                    (av_reverse[buf[3]]        <<  4) |
124                     av_reverse[buf[2] & 0x0f];
125             buf += 5;
126         }
127         *data_size = (uint8_t*) o - (uint8_t*) data;
128     }
129
130     return buf - avpkt->data;
131 }
132
133
134 AVCodec ff_s302m_decoder = {
135     .name           = "s302m",
136     .type           = AVMEDIA_TYPE_AUDIO,
137     .id             = CODEC_ID_S302M,
138     .priv_data_size = 0,
139     .decode         = s302m_decode_frame,
140     .long_name      = NULL_IF_CONFIG_SMALL("SMPTE 302M"),
141 };