s302m.c 5.82 KB
Newer Older
1 2 3 4 5
/*
 * SMPTE 302M decoder
 * Copyright (c) 2008 Laurent Aimar <fenrir@videolan.org>
 * Copyright (c) 2009 Baptiste Coudurier <baptiste.coudurier@gmail.com>
 *
6
 * This file is part of FFmpeg.
7
 *
8
 * FFmpeg is free software; you can redistribute it and/or
9 10 11 12
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2.1 of the License, or (at your option) any later version.
 *
13
 * FFmpeg is distributed in the hope that it will be useful,
14 15 16 17 18
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
19
 * License along with FFmpeg; if not, write to the Free Software
20 21 22 23
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
 */

#include "libavutil/intreadwrite.h"
24
#include "libavutil/log.h"
25
#include "avcodec.h"
26
#include "internal.h"
27
#include "mathops.h"
28 29 30

#define AES3_HEADER_LEN 4

31 32 33 34
typedef struct S302MDecodeContext {
    AVFrame frame;
} S302MDecodeContext;

35 36 37 38
static int s302m_parse_frame_header(AVCodecContext *avctx, const uint8_t *buf,
                                    int buf_size)
{
    uint32_t h;
Mans Rullgard's avatar
Mans Rullgard committed
39
    int frame_size, channels, bits;
40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67

    if (buf_size <= AES3_HEADER_LEN) {
        av_log(avctx, AV_LOG_ERROR, "frame is too short\n");
        return AVERROR_INVALIDDATA;
    }

    /*
     * AES3 header :
     * size:            16
     * number channels   2
     * channel_id        8
     * bits per samples  2
     * alignments        4
     */

    h = AV_RB32(buf);
    frame_size =  (h >> 16) & 0xffff;
    channels   = ((h >> 14) & 0x0003) * 2 +  2;
    bits       = ((h >>  4) & 0x0003) * 4 + 16;

    if (AES3_HEADER_LEN + frame_size != buf_size || bits > 24) {
        av_log(avctx, AV_LOG_ERROR, "frame has invalid header\n");
        return AVERROR_INVALIDDATA;
    }

    /* Set output properties */
    avctx->bits_per_coded_sample = bits;
    if (bits > 16)
68
        avctx->sample_fmt = AV_SAMPLE_FMT_S32;
69
    else
70
        avctx->sample_fmt = AV_SAMPLE_FMT_S16;
71 72

    avctx->channels    = channels;
73 74 75 76 77 78 79
    switch(channels) {
        case 2:
            avctx->channel_layout = AV_CH_LAYOUT_STEREO;
            break;
        case 4:
            avctx->channel_layout = AV_CH_LAYOUT_QUAD;
            break;
80 81 82
        case 6:
            avctx->channel_layout = AV_CH_LAYOUT_5POINT1_BACK;
            break;
83 84 85
        case 8:
            avctx->channel_layout = AV_CH_LAYOUT_5POINT1_BACK | AV_CH_LAYOUT_STEREO_DOWNMIX;
    }
86 87 88 89 90 91 92 93 94 95
    avctx->sample_rate = 48000;
    avctx->bit_rate    = 48000 * avctx->channels * (avctx->bits_per_coded_sample + 4) +
                         32 * (48000 / (buf_size * 8 /
                                        (avctx->channels *
                                         (avctx->bits_per_coded_sample + 4))));

    return frame_size;
}

static int s302m_decode_frame(AVCodecContext *avctx, void *data,
96
                              int *got_frame_ptr, AVPacket *avpkt)
97
{
98
    S302MDecodeContext *s = avctx->priv_data;
99 100
    const uint8_t *buf = avpkt->data;
    int buf_size       = avpkt->size;
101
    int block_size, ret;
102 103 104 105 106 107 108 109

    int frame_size = s302m_parse_frame_header(avctx, buf, buf_size);
    if (frame_size < 0)
        return frame_size;

    buf_size -= AES3_HEADER_LEN;
    buf      += AES3_HEADER_LEN;

110 111 112
    /* get output buffer */
    block_size = (avctx->bits_per_coded_sample + 4) / 4;
    s->frame.nb_samples = 2 * (buf_size / block_size) / avctx->channels;
113
    if ((ret = ff_get_buffer(avctx, &s->frame)) < 0) {
114 115 116 117 118
        av_log(avctx, AV_LOG_ERROR, "get_buffer() failed\n");
        return ret;
    }

    buf_size = (s->frame.nb_samples * avctx->channels / 2) * block_size;
119 120

    if (avctx->bits_per_coded_sample == 24) {
121
        uint32_t *o = (uint32_t *)s->frame.data[0];
122
        for (; buf_size > 6; buf_size -= 7) {
123 124 125 126 127 128 129
            *o++ = (ff_reverse[buf[2]]        << 24) |
                   (ff_reverse[buf[1]]        << 16) |
                   (ff_reverse[buf[0]]        <<  8);
            *o++ = (ff_reverse[buf[6] & 0xf0] << 28) |
                   (ff_reverse[buf[5]]        << 20) |
                   (ff_reverse[buf[4]]        << 12) |
                   (ff_reverse[buf[3] & 0x0f] <<  4);
130 131 132
            buf += 7;
        }
    } else if (avctx->bits_per_coded_sample == 20) {
133
        uint32_t *o = (uint32_t *)s->frame.data[0];
134
        for (; buf_size > 5; buf_size -= 6) {
135 136 137 138 139 140
            *o++ = (ff_reverse[buf[2] & 0xf0] << 28) |
                   (ff_reverse[buf[1]]        << 20) |
                   (ff_reverse[buf[0]]        << 12);
            *o++ = (ff_reverse[buf[5] & 0xf0] << 28) |
                   (ff_reverse[buf[4]]        << 20) |
                   (ff_reverse[buf[3]]        << 12);
141 142 143
            buf += 6;
        }
    } else {
144
        uint16_t *o = (uint16_t *)s->frame.data[0];
145
        for (; buf_size > 4; buf_size -= 5) {
146 147 148 149 150
            *o++ = (ff_reverse[buf[1]]        <<  8) |
                    ff_reverse[buf[0]];
            *o++ = (ff_reverse[buf[4] & 0xf0] << 12) |
                   (ff_reverse[buf[3]]        <<  4) |
                   (ff_reverse[buf[2]]        >>  4);
151 152 153 154
            buf += 5;
        }
    }

155 156 157 158 159 160 161 162 163 164 165 166 167 168
    *got_frame_ptr   = 1;
    *(AVFrame *)data = s->frame;

    return avpkt->size;
}

static int s302m_decode_init(AVCodecContext *avctx)
{
    S302MDecodeContext *s = avctx->priv_data;

    avcodec_get_frame_defaults(&s->frame);
    avctx->coded_frame = &s->frame;

    return 0;
169 170 171 172 173 174
}


AVCodec ff_s302m_decoder = {
    .name           = "s302m",
    .type           = AVMEDIA_TYPE_AUDIO,
175
    .id             = AV_CODEC_ID_S302M,
176 177
    .priv_data_size = sizeof(S302MDecodeContext),
    .init           = s302m_decode_init,
178
    .decode         = s302m_decode_frame,
179
    .capabilities   = CODEC_CAP_DR1,
180 181
    .long_name      = NULL_IF_CONFIG_SMALL("SMPTE 302M"),
};