380 lines
12 KiB
C
380 lines
12 KiB
C
/*
|
|
* IEC958 muxer
|
|
* Copyright (c) 2009 Bartlomiej Wolowiec
|
|
* Copyright (c) 2010 Anssi Hannula
|
|
* Copyright (c) 2010 Carl Eugen Hoyos
|
|
*
|
|
* This file is part of FFmpeg.
|
|
*
|
|
* FFmpeg is free software; you can redistribute it and/or
|
|
* 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.
|
|
*
|
|
* FFmpeg is distributed in the hope that it will be useful,
|
|
* 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
|
|
* License along with FFmpeg; if not, write to the Free Software
|
|
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
|
|
*/
|
|
|
|
/**
|
|
* @file
|
|
* IEC-61937 encapsulation of various formats, used by S/PDIF
|
|
* @author Bartlomiej Wolowiec
|
|
*/
|
|
|
|
/*
|
|
* Terminology used in specification:
|
|
* data-burst - IEC958 frame, contains header and encapsuled frame
|
|
* burst-preambule - IEC958 frame header, contains 16-bits words named Pa, Pb, Pc and Pd
|
|
* burst-payload - encapsuled frame
|
|
* Pa, Pb - syncword - 0xF872, 0x4E1F
|
|
* Pc - burst-info, contains data-type (bits 0-6), error flag (bit 7), data-type-dependent info (bits 8-12)
|
|
* and bitstream number (bits 13-15)
|
|
* data-type - determines type of encapsuled frames
|
|
* Pd - length code (number of bits or bytes of encapsuled frame - according to data_type)
|
|
*
|
|
* IEC958 frames at normal usage start every specific count of bytes,
|
|
* dependent from data-type (spaces between packets are filled by zeros)
|
|
*/
|
|
|
|
#include "avformat.h"
|
|
#include "spdif.h"
|
|
#include "libavcodec/ac3.h"
|
|
#include "libavcodec/dca.h"
|
|
#include "libavcodec/aacadtsdec.h"
|
|
|
|
typedef struct IEC958Context {
|
|
enum IEC958DataType data_type; ///< burst info - reference to type of payload of the data-burst
|
|
int length_code; ///< length code in bits or bytes, depending on data type
|
|
int pkt_offset; ///< data burst repetition period in bytes
|
|
uint8_t *buffer; ///< allocated buffer, used for swap bytes
|
|
int buffer_size; ///< size of allocated buffer
|
|
|
|
uint8_t *out_buf; ///< pointer to the outgoing data before byte-swapping
|
|
int out_bytes; ///< amount of outgoing bytes
|
|
|
|
uint8_t *hd_buf; ///< allocated buffer to concatenate hd audio frames
|
|
int hd_buf_size; ///< size of the hd audio buffer
|
|
int hd_buf_count; ///< number of frames in the hd audio buffer
|
|
int hd_buf_filled; ///< amount of bytes in the hd audio buffer
|
|
|
|
/// function, which generates codec dependent header information.
|
|
/// Sets data_type and pkt_offset, and length_code, out_bytes, out_buf if necessary
|
|
int (*header_info) (AVFormatContext *s, AVPacket *pkt);
|
|
} IEC958Context;
|
|
|
|
|
|
static int spdif_header_ac3(AVFormatContext *s, AVPacket *pkt)
|
|
{
|
|
IEC958Context *ctx = s->priv_data;
|
|
int bitstream_mode = pkt->data[6] & 0x7;
|
|
|
|
ctx->data_type = IEC958_AC3 | (bitstream_mode << 8);
|
|
ctx->pkt_offset = AC3_FRAME_SIZE << 2;
|
|
return 0;
|
|
}
|
|
|
|
static int spdif_header_eac3(AVFormatContext *s, AVPacket *pkt)
|
|
{
|
|
IEC958Context *ctx = s->priv_data;
|
|
static const uint8_t eac3_repeat[4] = {6, 3, 2, 1};
|
|
int repeat = 1;
|
|
|
|
if ((pkt->data[4] & 0xc0) != 0xc0) /* fscod */
|
|
repeat = eac3_repeat[(pkt->data[4] & 0x30) >> 4]; /* numblkscod */
|
|
|
|
ctx->hd_buf = av_fast_realloc(ctx->hd_buf, &ctx->hd_buf_size, ctx->hd_buf_filled + pkt->size);
|
|
if (!ctx->hd_buf)
|
|
return AVERROR(ENOMEM);
|
|
|
|
memcpy(&ctx->hd_buf[ctx->hd_buf_filled], pkt->data, pkt->size);
|
|
|
|
ctx->hd_buf_filled += pkt->size;
|
|
if (++ctx->hd_buf_count < repeat){
|
|
ctx->pkt_offset = 0;
|
|
return 0;
|
|
}
|
|
ctx->data_type = IEC958_EAC3;
|
|
ctx->pkt_offset = 24576;
|
|
ctx->out_buf = ctx->hd_buf;
|
|
ctx->out_bytes = ctx->hd_buf_filled;
|
|
ctx->length_code = ctx->hd_buf_filled;
|
|
|
|
ctx->hd_buf_count = 0;
|
|
ctx->hd_buf_filled = 0;
|
|
return 0;
|
|
}
|
|
|
|
static int spdif_header_dts(AVFormatContext *s, AVPacket *pkt)
|
|
{
|
|
IEC958Context *ctx = s->priv_data;
|
|
uint32_t syncword_dts = AV_RB32(pkt->data);
|
|
int blocks;
|
|
|
|
switch (syncword_dts) {
|
|
case DCA_MARKER_RAW_BE:
|
|
blocks = (AV_RB16(pkt->data + 4) >> 2) & 0x7f;
|
|
break;
|
|
case DCA_MARKER_RAW_LE:
|
|
blocks = (AV_RL16(pkt->data + 4) >> 2) & 0x7f;
|
|
break;
|
|
case DCA_MARKER_14B_BE:
|
|
blocks =
|
|
(((pkt->data[5] & 0x07) << 4) | ((pkt->data[6] & 0x3f) >> 2));
|
|
break;
|
|
case DCA_MARKER_14B_LE:
|
|
blocks =
|
|
(((pkt->data[4] & 0x07) << 4) | ((pkt->data[7] & 0x3f) >> 2));
|
|
break;
|
|
default:
|
|
av_log(s, AV_LOG_ERROR, "bad DTS syncword 0x%x\n", syncword_dts);
|
|
return -1;
|
|
}
|
|
blocks++;
|
|
switch (blocks) {
|
|
case 512 >> 5: ctx->data_type = IEC958_DTS1; break;
|
|
case 1024 >> 5: ctx->data_type = IEC958_DTS2; break;
|
|
case 2048 >> 5: ctx->data_type = IEC958_DTS3; break;
|
|
default:
|
|
av_log(s, AV_LOG_ERROR, "%i samples in DTS frame not supported\n",
|
|
blocks << 5);
|
|
return -1;
|
|
}
|
|
ctx->pkt_offset = blocks << 7;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const enum IEC958DataType mpeg_data_type[2][3] = {
|
|
// LAYER1 LAYER2 LAYER3
|
|
{ IEC958_MPEG2_LAYER1_LSF, IEC958_MPEG2_LAYER2_LSF, IEC958_MPEG2_LAYER3_LSF }, //MPEG2 LSF
|
|
{ IEC958_MPEG1_LAYER1, IEC958_MPEG1_LAYER23, IEC958_MPEG1_LAYER23 }, //MPEG1
|
|
};
|
|
|
|
static int spdif_header_mpeg(AVFormatContext *s, AVPacket *pkt)
|
|
{
|
|
IEC958Context *ctx = s->priv_data;
|
|
int version = (pkt->data[1] >> 3) & 3;
|
|
int layer = 3 - ((pkt->data[1] >> 1) & 3);
|
|
int extension = pkt->data[2] & 1;
|
|
|
|
if (layer == 3 || version == 1) {
|
|
av_log(s, AV_LOG_ERROR, "Wrong MPEG file format\n");
|
|
return -1;
|
|
}
|
|
av_log(s, AV_LOG_DEBUG, "version: %i layer: %i extension: %i\n", version, layer, extension);
|
|
if (version == 2 && extension) {
|
|
ctx->data_type = IEC958_MPEG2_EXT;
|
|
ctx->pkt_offset = 4608;
|
|
} else {
|
|
ctx->data_type = mpeg_data_type [version & 1][layer];
|
|
ctx->pkt_offset = spdif_mpeg_pkt_offset[version & 1][layer];
|
|
}
|
|
// TODO Data type dependant info (normal/karaoke, dynamic range control)
|
|
return 0;
|
|
}
|
|
|
|
static int spdif_header_aac(AVFormatContext *s, AVPacket *pkt)
|
|
{
|
|
IEC958Context *ctx = s->priv_data;
|
|
AACADTSHeaderInfo hdr;
|
|
GetBitContext gbc;
|
|
int ret;
|
|
|
|
init_get_bits(&gbc, pkt->data, AAC_ADTS_HEADER_SIZE * 8);
|
|
ret = ff_aac_parse_header(&gbc, &hdr);
|
|
if (ret < 0) {
|
|
av_log(s, AV_LOG_ERROR, "Wrong AAC file format\n");
|
|
return -1;
|
|
}
|
|
|
|
ctx->pkt_offset = hdr.samples << 2;
|
|
switch (hdr.num_aac_frames) {
|
|
case 1:
|
|
ctx->data_type = IEC958_MPEG2_AAC;
|
|
break;
|
|
case 2:
|
|
ctx->data_type = IEC958_MPEG2_AAC_LSF_2048;
|
|
break;
|
|
case 4:
|
|
ctx->data_type = IEC958_MPEG2_AAC_LSF_4096;
|
|
break;
|
|
default:
|
|
av_log(s, AV_LOG_ERROR, "%i samples in AAC frame not supported\n",
|
|
hdr.samples);
|
|
return -1;
|
|
}
|
|
//TODO Data type dependent info (LC profile/SBR)
|
|
return 0;
|
|
}
|
|
|
|
|
|
/*
|
|
* It seems Dolby TrueHD frames have to be encapsulated in MAT frames before
|
|
* they can be encapsulated in IEC 61937.
|
|
* Here we encapsulate 24 TrueHD frames in a single MAT frame, padding them
|
|
* to achieve constant rate.
|
|
* The actual format of a MAT frame is unknown, but the below seems to work.
|
|
* However, it seems it is not actually necessary for the 24 TrueHD frames to
|
|
* be in an exact alignment with the MAT frame.
|
|
*/
|
|
#define MAT_FRAME_SIZE 61424
|
|
#define TRUEHD_FRAME_OFFSET 2560
|
|
#define MAT_MIDDLE_CODE_OFFSET -4
|
|
|
|
static int spdif_header_truehd(AVFormatContext *s, AVPacket *pkt)
|
|
{
|
|
IEC958Context *ctx = s->priv_data;
|
|
int mat_code_length = 0;
|
|
const char mat_end_code[16] = { 0xC3, 0xC2, 0xC0, 0xC4, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x97, 0x11 };
|
|
|
|
if (!ctx->hd_buf_count) {
|
|
const char mat_start_code[20] = { 0x07, 0x9E, 0x00, 0x03, 0x84, 0x01, 0x01, 0x01, 0x80, 0x00, 0x56, 0xA5, 0x3B, 0xF4, 0x81, 0x83, 0x49, 0x80, 0x77, 0xE0 };
|
|
mat_code_length = sizeof(mat_start_code) + BURST_HEADER_SIZE;
|
|
memcpy(ctx->hd_buf, mat_start_code, sizeof(mat_start_code));
|
|
|
|
} else if (ctx->hd_buf_count == 12) {
|
|
const char mat_middle_code[12] = { 0xC3, 0xC1, 0x42, 0x49, 0x3B, 0xFA, 0x82, 0x83, 0x49, 0x80, 0x77, 0xE0 };
|
|
mat_code_length = sizeof(mat_middle_code) + MAT_MIDDLE_CODE_OFFSET;
|
|
memcpy(&ctx->hd_buf[12 * TRUEHD_FRAME_OFFSET - BURST_HEADER_SIZE + MAT_MIDDLE_CODE_OFFSET],
|
|
mat_middle_code, sizeof(mat_middle_code));
|
|
}
|
|
|
|
if (pkt->size > TRUEHD_FRAME_OFFSET - mat_code_length) {
|
|
/* if such frames exist, we'd need some more complex logic to
|
|
* distribute the TrueHD frames in the MAT frame */
|
|
av_log(s, AV_LOG_ERROR, "TrueHD frame too big, %d bytes\n", pkt->size);
|
|
av_log_ask_for_sample(s, NULL);
|
|
return -1;
|
|
}
|
|
|
|
memcpy(&ctx->hd_buf[ctx->hd_buf_count * TRUEHD_FRAME_OFFSET - BURST_HEADER_SIZE + mat_code_length],
|
|
pkt->data, pkt->size);
|
|
memset(&ctx->hd_buf[ctx->hd_buf_count * TRUEHD_FRAME_OFFSET - BURST_HEADER_SIZE + mat_code_length + pkt->size],
|
|
0, TRUEHD_FRAME_OFFSET - pkt->size - mat_code_length);
|
|
|
|
if (++ctx->hd_buf_count < 24){
|
|
ctx->pkt_offset = 0;
|
|
return 0;
|
|
}
|
|
memcpy(&ctx->hd_buf[MAT_FRAME_SIZE - sizeof(mat_end_code)], mat_end_code, sizeof(mat_end_code));
|
|
ctx->hd_buf_count = 0;
|
|
|
|
ctx->data_type = IEC958_TRUEHD;
|
|
ctx->pkt_offset = 61440;
|
|
ctx->out_buf = ctx->hd_buf;
|
|
ctx->out_bytes = MAT_FRAME_SIZE;
|
|
ctx->length_code = MAT_FRAME_SIZE;
|
|
return 0;
|
|
}
|
|
|
|
static int spdif_write_header(AVFormatContext *s)
|
|
{
|
|
IEC958Context *ctx = s->priv_data;
|
|
|
|
switch (s->streams[0]->codec->codec_id) {
|
|
case CODEC_ID_AC3:
|
|
ctx->header_info = spdif_header_ac3;
|
|
break;
|
|
case CODEC_ID_EAC3:
|
|
ctx->header_info = spdif_header_eac3;
|
|
break;
|
|
case CODEC_ID_MP1:
|
|
case CODEC_ID_MP2:
|
|
case CODEC_ID_MP3:
|
|
ctx->header_info = spdif_header_mpeg;
|
|
break;
|
|
case CODEC_ID_DTS:
|
|
ctx->header_info = spdif_header_dts;
|
|
break;
|
|
case CODEC_ID_AAC:
|
|
ctx->header_info = spdif_header_aac;
|
|
break;
|
|
case CODEC_ID_TRUEHD:
|
|
ctx->header_info = spdif_header_truehd;
|
|
ctx->hd_buf = av_malloc(MAT_FRAME_SIZE);
|
|
if (!ctx->hd_buf)
|
|
return AVERROR(ENOMEM);
|
|
break;
|
|
default:
|
|
av_log(s, AV_LOG_ERROR, "codec not supported\n");
|
|
return -1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int spdif_write_trailer(AVFormatContext *s)
|
|
{
|
|
IEC958Context *ctx = s->priv_data;
|
|
av_freep(&ctx->buffer);
|
|
av_freep(&ctx->hd_buf);
|
|
return 0;
|
|
}
|
|
|
|
static int spdif_write_packet(struct AVFormatContext *s, AVPacket *pkt)
|
|
{
|
|
IEC958Context *ctx = s->priv_data;
|
|
int ret, padding;
|
|
|
|
ctx->out_buf = pkt->data;
|
|
ctx->out_bytes = pkt->size;
|
|
ctx->length_code = FFALIGN(pkt->size, 2) << 3;
|
|
|
|
ret = ctx->header_info(s, pkt);
|
|
if (ret < 0)
|
|
return -1;
|
|
if (!ctx->pkt_offset)
|
|
return 0;
|
|
|
|
padding = (ctx->pkt_offset - BURST_HEADER_SIZE - ctx->out_bytes) >> 1;
|
|
if (padding < 0) {
|
|
av_log(s, AV_LOG_ERROR, "bitrate is too high\n");
|
|
return -1;
|
|
}
|
|
|
|
put_le16(s->pb, SYNCWORD1); //Pa
|
|
put_le16(s->pb, SYNCWORD2); //Pb
|
|
put_le16(s->pb, ctx->data_type); //Pc
|
|
put_le16(s->pb, ctx->length_code);//Pd
|
|
|
|
#if HAVE_BIGENDIAN
|
|
put_buffer(s->pb, ctx->out_buf, ctx->out_bytes & ~1);
|
|
#else
|
|
av_fast_malloc(&ctx->buffer, &ctx->buffer_size, ctx->out_bytes + FF_INPUT_BUFFER_PADDING_SIZE);
|
|
if (!ctx->buffer)
|
|
return AVERROR(ENOMEM);
|
|
ff_spdif_bswap_buf16((uint16_t *)ctx->buffer, (uint16_t *)ctx->out_buf, ctx->out_bytes >> 1);
|
|
put_buffer(s->pb, ctx->buffer, ctx->out_bytes & ~1);
|
|
#endif
|
|
|
|
if (ctx->out_bytes & 1)
|
|
put_be16(s->pb, ctx->out_buf[ctx->out_bytes - 1]);
|
|
|
|
for (; padding > 0; padding--)
|
|
put_be16(s->pb, 0);
|
|
|
|
av_log(s, AV_LOG_DEBUG, "type=%x len=%i pkt_offset=%i\n",
|
|
ctx->data_type, ctx->out_bytes, ctx->pkt_offset);
|
|
|
|
put_flush_packet(s->pb);
|
|
return 0;
|
|
}
|
|
|
|
AVOutputFormat spdif_muxer = {
|
|
"spdif",
|
|
NULL_IF_CONFIG_SMALL("IEC958 - S/PDIF (IEC-61937)"),
|
|
NULL,
|
|
"spdif",
|
|
sizeof(IEC958Context),
|
|
CODEC_ID_AC3,
|
|
CODEC_ID_NONE,
|
|
spdif_write_header,
|
|
spdif_write_packet,
|
|
spdif_write_trailer,
|
|
};
|