00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023 #include "libavutil/intreadwrite.h"
00024 #include "avcodec.h"
00025
00026 #define AES3_HEADER_LEN 4
00027
00028 typedef struct S302MDecodeContext {
00029 AVFrame frame;
00030 } S302MDecodeContext;
00031
00032 static int s302m_parse_frame_header(AVCodecContext *avctx, const uint8_t *buf,
00033 int buf_size)
00034 {
00035 uint32_t h;
00036 int frame_size, channels, bits;
00037
00038 if (buf_size <= AES3_HEADER_LEN) {
00039 av_log(avctx, AV_LOG_ERROR, "frame is too short\n");
00040 return AVERROR_INVALIDDATA;
00041 }
00042
00043
00044
00045
00046
00047
00048
00049
00050
00051
00052 h = AV_RB32(buf);
00053 frame_size = (h >> 16) & 0xffff;
00054 channels = ((h >> 14) & 0x0003) * 2 + 2;
00055 bits = ((h >> 4) & 0x0003) * 4 + 16;
00056
00057 if (AES3_HEADER_LEN + frame_size != buf_size || bits > 24) {
00058 av_log(avctx, AV_LOG_ERROR, "frame has invalid header\n");
00059 return AVERROR_INVALIDDATA;
00060 }
00061
00062
00063 avctx->bits_per_coded_sample = bits;
00064 if (bits > 16)
00065 avctx->sample_fmt = AV_SAMPLE_FMT_S32;
00066 else
00067 avctx->sample_fmt = AV_SAMPLE_FMT_S16;
00068
00069 avctx->channels = channels;
00070 switch(channels) {
00071 case 2:
00072 avctx->channel_layout = AV_CH_LAYOUT_STEREO;
00073 break;
00074 case 4:
00075 avctx->channel_layout = AV_CH_LAYOUT_QUAD;
00076 break;
00077 case 6:
00078 avctx->channel_layout = AV_CH_LAYOUT_5POINT1_BACK;
00079 break;
00080 case 8:
00081 avctx->channel_layout = AV_CH_LAYOUT_5POINT1_BACK | AV_CH_LAYOUT_STEREO_DOWNMIX;
00082 }
00083 avctx->sample_rate = 48000;
00084 avctx->bit_rate = 48000 * avctx->channels * (avctx->bits_per_coded_sample + 4) +
00085 32 * (48000 / (buf_size * 8 /
00086 (avctx->channels *
00087 (avctx->bits_per_coded_sample + 4))));
00088
00089 return frame_size;
00090 }
00091
00092 static int s302m_decode_frame(AVCodecContext *avctx, void *data,
00093 int *got_frame_ptr, AVPacket *avpkt)
00094 {
00095 S302MDecodeContext *s = avctx->priv_data;
00096 const uint8_t *buf = avpkt->data;
00097 int buf_size = avpkt->size;
00098 int block_size, ret;
00099
00100 int frame_size = s302m_parse_frame_header(avctx, buf, buf_size);
00101 if (frame_size < 0)
00102 return frame_size;
00103
00104 buf_size -= AES3_HEADER_LEN;
00105 buf += AES3_HEADER_LEN;
00106
00107
00108 block_size = (avctx->bits_per_coded_sample + 4) / 4;
00109 s->frame.nb_samples = 2 * (buf_size / block_size) / avctx->channels;
00110 if ((ret = avctx->get_buffer(avctx, &s->frame)) < 0) {
00111 av_log(avctx, AV_LOG_ERROR, "get_buffer() failed\n");
00112 return ret;
00113 }
00114
00115 buf_size = (s->frame.nb_samples * avctx->channels / 2) * block_size;
00116
00117 if (avctx->bits_per_coded_sample == 24) {
00118 uint32_t *o = (uint32_t *)s->frame.data[0];
00119 for (; buf_size > 6; buf_size -= 7) {
00120 *o++ = (av_reverse[buf[2]] << 24) |
00121 (av_reverse[buf[1]] << 16) |
00122 (av_reverse[buf[0]] << 8);
00123 *o++ = (av_reverse[buf[6] & 0xf0] << 28) |
00124 (av_reverse[buf[5]] << 20) |
00125 (av_reverse[buf[4]] << 12) |
00126 (av_reverse[buf[3] & 0x0f] << 4);
00127 buf += 7;
00128 }
00129 } else if (avctx->bits_per_coded_sample == 20) {
00130 uint32_t *o = (uint32_t *)s->frame.data[0];
00131 for (; buf_size > 5; buf_size -= 6) {
00132 *o++ = (av_reverse[buf[2] & 0xf0] << 28) |
00133 (av_reverse[buf[1]] << 20) |
00134 (av_reverse[buf[0]] << 12);
00135 *o++ = (av_reverse[buf[5] & 0xf0] << 28) |
00136 (av_reverse[buf[4]] << 20) |
00137 (av_reverse[buf[3]] << 12);
00138 buf += 6;
00139 }
00140 } else {
00141 uint16_t *o = (uint16_t *)s->frame.data[0];
00142 for (; buf_size > 4; buf_size -= 5) {
00143 *o++ = (av_reverse[buf[1]] << 8) |
00144 av_reverse[buf[0]];
00145 *o++ = (av_reverse[buf[4] & 0xf0] << 12) |
00146 (av_reverse[buf[3]] << 4) |
00147 (av_reverse[buf[2]] >> 4);
00148 buf += 5;
00149 }
00150 }
00151
00152 *got_frame_ptr = 1;
00153 *(AVFrame *)data = s->frame;
00154
00155 return avpkt->size;
00156 }
00157
00158 static int s302m_decode_init(AVCodecContext *avctx)
00159 {
00160 S302MDecodeContext *s = avctx->priv_data;
00161
00162 avcodec_get_frame_defaults(&s->frame);
00163 avctx->coded_frame = &s->frame;
00164
00165 return 0;
00166 }
00167
00168
00169 AVCodec ff_s302m_decoder = {
00170 .name = "s302m",
00171 .type = AVMEDIA_TYPE_AUDIO,
00172 .id = CODEC_ID_S302M,
00173 .priv_data_size = sizeof(S302MDecodeContext),
00174 .init = s302m_decode_init,
00175 .decode = s302m_decode_frame,
00176 .capabilities = CODEC_CAP_DR1,
00177 .long_name = NULL_IF_CONFIG_SMALL("SMPTE 302M"),
00178 };