Statistics
| Branch: | Revision:

ffmpeg / libavformat / spdifenc.c @ 6cc7f139

History | View | Annotate | Download (19.4 KB)

1 ab1eff9c Bartlomiej Wolowiec
/*
2 d8e481bb Anssi Hannula
 * IEC 61937 muxer
3 ab1eff9c Bartlomiej Wolowiec
 * Copyright (c) 2009 Bartlomiej Wolowiec
4 25a08596 Carl Eugen Hoyos
 * Copyright (c) 2010 Anssi Hannula
5
 * Copyright (c) 2010 Carl Eugen Hoyos
6 ab1eff9c Bartlomiej Wolowiec
 *
7 2912e87a Mans Rullgard
 * This file is part of Libav.
8 ab1eff9c Bartlomiej Wolowiec
 *
9 2912e87a Mans Rullgard
 * Libav is free software; you can redistribute it and/or
10 ab1eff9c Bartlomiej Wolowiec
 * modify it under the terms of the GNU Lesser General Public
11
 * License as published by the Free Software Foundation; either
12
 * version 2.1 of the License, or (at your option) any later version.
13
 *
14 2912e87a Mans Rullgard
 * Libav is distributed in the hope that it will be useful,
15 ab1eff9c Bartlomiej Wolowiec
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
17
 * Lesser General Public License for more details.
18
 *
19
 * You should have received a copy of the GNU Lesser General Public
20 2912e87a Mans Rullgard
 * License along with Libav; if not, write to the Free Software
21 ab1eff9c Bartlomiej Wolowiec
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
22
 */
23
24
/**
25 ba87f080 Diego Biurrun
 * @file
26 ab1eff9c Bartlomiej Wolowiec
 * IEC-61937 encapsulation of various formats, used by S/PDIF
27
 * @author Bartlomiej Wolowiec
28 e5e932e8 Anssi Hannula
 * @author Anssi Hannula
29
 * @author Carl Eugen Hoyos
30 ab1eff9c Bartlomiej Wolowiec
 */
31
32
/*
33
 * Terminology used in specification:
34 d8e481bb Anssi Hannula
 * data-burst - IEC61937 frame, contains header and encapsuled frame
35
 * burst-preambule - IEC61937 frame header, contains 16-bits words named Pa, Pb, Pc and Pd
36 ab1eff9c Bartlomiej Wolowiec
 * burst-payload - encapsuled frame
37
 * Pa, Pb - syncword - 0xF872, 0x4E1F
38
 * Pc - burst-info, contains data-type (bits 0-6), error flag (bit 7), data-type-dependent info (bits 8-12)
39
 *      and bitstream number (bits 13-15)
40
 * data-type - determines type of encapsuled frames
41
 * Pd - length code (number of bits or bytes of encapsuled frame - according to data_type)
42
 *
43 d8e481bb Anssi Hannula
 * IEC 61937 frames at normal usage start every specific count of bytes,
44 ab1eff9c Bartlomiej Wolowiec
 *      dependent from data-type (spaces between packets are filled by zeros)
45
 */
46
47
#include "avformat.h"
48 0f86fcab Ronald S. Bultje
#include "avio_internal.h"
49 8079d2ec Anssi Hannula
#include "spdif.h"
50 ab1eff9c Bartlomiej Wolowiec
#include "libavcodec/ac3.h"
51
#include "libavcodec/dca.h"
52 482d98f6 Anssi Hannula
#include "libavcodec/dcadata.h"
53 3cac899a Alex Converse
#include "libavcodec/aacadtsdec.h"
54 482d98f6 Anssi Hannula
#include "libavutil/opt.h"
55 ab1eff9c Bartlomiej Wolowiec
56 d8e481bb Anssi Hannula
typedef struct IEC61937Context {
57 482d98f6 Anssi Hannula
    const AVClass *av_class;
58 d8e481bb Anssi Hannula
    enum IEC61937DataType data_type;///< burst info - reference to type of payload of the data-burst
59 909865fd Carl Eugen Hoyos
    int length_code;                ///< length code in bits or bytes, depending on data type
60 ab1eff9c Bartlomiej Wolowiec
    int pkt_offset;                 ///< data burst repetition period in bytes
61
    uint8_t *buffer;                ///< allocated buffer, used for swap bytes
62
    int buffer_size;                ///< size of allocated buffer
63
64 909865fd Carl Eugen Hoyos
    uint8_t *out_buf;               ///< pointer to the outgoing data before byte-swapping
65
    int out_bytes;                  ///< amount of outgoing bytes
66
67 cc6c0c7b Anssi Hannula
    int use_preamble;               ///< preamble enabled (disabled for exactly pre-padded DTS)
68 97790352 Anssi Hannula
    int extra_bswap;                ///< extra bswap for payload (for LE DTS => standard BE DTS)
69
70 909865fd Carl Eugen Hoyos
    uint8_t *hd_buf;                ///< allocated buffer to concatenate hd audio frames
71
    int hd_buf_size;                ///< size of the hd audio buffer
72
    int hd_buf_count;               ///< number of frames in the hd audio buffer
73
    int hd_buf_filled;              ///< amount of bytes in the hd audio buffer
74
75 482d98f6 Anssi Hannula
    int dtshd_skip;                 ///< counter used for skipping DTS-HD frames
76
77
    /* AVOptions: */
78
    int dtshd_rate;
79
    int dtshd_fallback;
80 57f2c9ae Anssi Hannula
#define SPDIF_FLAG_BIGENDIAN    0x01
81
    int spdif_flags;
82 482d98f6 Anssi Hannula
83 ab1eff9c Bartlomiej Wolowiec
    /// function, which generates codec dependent header information.
84 909865fd Carl Eugen Hoyos
    /// Sets data_type and pkt_offset, and length_code, out_bytes, out_buf if necessary
85 ab1eff9c Bartlomiej Wolowiec
    int (*header_info) (AVFormatContext *s, AVPacket *pkt);
86 d8e481bb Anssi Hannula
} IEC61937Context;
87 ab1eff9c Bartlomiej Wolowiec
88 482d98f6 Anssi Hannula
static const AVOption options[] = {
89 57f2c9ae Anssi Hannula
{ "spdif_flags", "IEC 61937 encapsulation flags", offsetof(IEC61937Context, spdif_flags), FF_OPT_TYPE_FLAGS, 0, 0, INT_MAX, AV_OPT_FLAG_ENCODING_PARAM, "spdif_flags" },
90
{ "be", "output in big-endian format (for use as s16be)", 0, FF_OPT_TYPE_CONST, SPDIF_FLAG_BIGENDIAN, 0, INT_MAX, AV_OPT_FLAG_ENCODING_PARAM, "spdif_flags" },
91 482d98f6 Anssi Hannula
{ "dtshd_rate", "mux complete DTS frames in HD mode at the specified IEC958 rate (in Hz, default 0=disabled)", offsetof(IEC61937Context, dtshd_rate), FF_OPT_TYPE_INT, 0, 0, 768000, AV_OPT_FLAG_ENCODING_PARAM },
92
{ "dtshd_fallback_time", "min secs to strip HD for after an overflow (-1: till the end, default 60)", offsetof(IEC61937Context, dtshd_fallback), FF_OPT_TYPE_INT, 60, -1, INT_MAX, AV_OPT_FLAG_ENCODING_PARAM },
93
{ NULL },
94
};
95
96
static const AVClass class = { "spdif", av_default_item_name, options, LIBAVUTIL_VERSION_INT };
97 ab1eff9c Bartlomiej Wolowiec
98
static int spdif_header_ac3(AVFormatContext *s, AVPacket *pkt)
99
{
100 d8e481bb Anssi Hannula
    IEC61937Context *ctx = s->priv_data;
101 836132ec Anssi Hannula
    int bitstream_mode = pkt->data[5] & 0x7;
102 ab1eff9c Bartlomiej Wolowiec
103 d8e481bb Anssi Hannula
    ctx->data_type  = IEC61937_AC3 | (bitstream_mode << 8);
104 ab1eff9c Bartlomiej Wolowiec
    ctx->pkt_offset = AC3_FRAME_SIZE << 2;
105
    return 0;
106
}
107
108 909865fd Carl Eugen Hoyos
static int spdif_header_eac3(AVFormatContext *s, AVPacket *pkt)
109
{
110 d8e481bb Anssi Hannula
    IEC61937Context *ctx = s->priv_data;
111 909865fd Carl Eugen Hoyos
    static const uint8_t eac3_repeat[4] = {6, 3, 2, 1};
112
    int repeat = 1;
113
114
    if ((pkt->data[4] & 0xc0) != 0xc0) /* fscod */
115
        repeat = eac3_repeat[(pkt->data[4] & 0x30) >> 4]; /* numblkscod */
116
117
    ctx->hd_buf = av_fast_realloc(ctx->hd_buf, &ctx->hd_buf_size, ctx->hd_buf_filled + pkt->size);
118
    if (!ctx->hd_buf)
119
        return AVERROR(ENOMEM);
120
121
    memcpy(&ctx->hd_buf[ctx->hd_buf_filled], pkt->data, pkt->size);
122
123
    ctx->hd_buf_filled += pkt->size;
124
    if (++ctx->hd_buf_count < repeat){
125
        ctx->pkt_offset = 0;
126
        return 0;
127
    }
128 d8e481bb Anssi Hannula
    ctx->data_type   = IEC61937_EAC3;
129 909865fd Carl Eugen Hoyos
    ctx->pkt_offset  = 24576;
130
    ctx->out_buf     = ctx->hd_buf;
131
    ctx->out_bytes   = ctx->hd_buf_filled;
132
    ctx->length_code = ctx->hd_buf_filled;
133
134
    ctx->hd_buf_count  = 0;
135
    ctx->hd_buf_filled = 0;
136
    return 0;
137
}
138
139 482d98f6 Anssi Hannula
/*
140
 * DTS type IV (DTS-HD) can be transmitted with various frame repetition
141
 * periods; longer repetition periods allow for longer packets and therefore
142
 * higher bitrate. Longer repetition periods mean that the constant bitrate of
143
 * the outputted IEC 61937 stream is higher.
144
 * The repetition period is measured in IEC 60958 frames (4 bytes).
145
 */
146
static int spdif_dts4_subtype(int period)
147
{
148
    switch (period) {
149 ec25f83b Janne Grunau
    case 512:   return 0x0;
150
    case 1024:  return 0x1;
151
    case 2048:  return 0x2;
152
    case 4096:  return 0x3;
153
    case 8192:  return 0x4;
154
    case 16384: return 0x5;
155 482d98f6 Anssi Hannula
    }
156
    return -1;
157
}
158
159
static int spdif_header_dts4(AVFormatContext *s, AVPacket *pkt, int core_size,
160
                             int sample_rate, int blocks)
161
{
162
    IEC61937Context *ctx = s->priv_data;
163
    static const char dtshd_start_code[10] = { 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0xfe };
164
    int pkt_size = pkt->size;
165
    int period;
166
    int subtype;
167
168
    if (!core_size) {
169
        av_log(s, AV_LOG_ERROR, "HD mode not supported for this format\n");
170
        return AVERROR(EINVAL);
171
    }
172
173
    if (!sample_rate) {
174
        av_log(s, AV_LOG_ERROR, "Unknown DTS sample rate for HD\n");
175
        return AVERROR_INVALIDDATA;
176
    }
177
178
    period = ctx->dtshd_rate * (blocks << 5) / sample_rate;
179
    subtype = spdif_dts4_subtype(period);
180
181
    if (subtype < 0) {
182
        av_log(s, AV_LOG_ERROR, "Specified HD rate of %d Hz would require an "
183
               "impossible repetition period of %d for the current DTS stream"
184
               " (blocks = %d, sample rate = %d)\n", ctx->dtshd_rate, period,
185
               blocks << 5, sample_rate);
186
        return AVERROR(EINVAL);
187
    }
188
189
    /* set pkt_offset and DTS IV subtype according to the requested output
190
     * rate */
191
    ctx->pkt_offset = period * 4;
192
    ctx->data_type = IEC61937_DTSHD | subtype << 8;
193
194
    /* If the bitrate is too high for transmitting at the selected
195
     * repetition period setting, strip DTS-HD until a good amount
196
     * of consecutive non-overflowing HD frames have been observed.
197
     * This generally only happens if the caller is cramming a Master
198
     * Audio stream into 192kHz IEC 60958 (which may or may not fit). */
199
    if (sizeof(dtshd_start_code) + 2 + pkt_size
200
            > ctx->pkt_offset - BURST_HEADER_SIZE && core_size) {
201
        if (!ctx->dtshd_skip)
202
            av_log(s, AV_LOG_WARNING, "DTS-HD bitrate too high, "
203
                                      "temporarily sending core only\n");
204
        if (ctx->dtshd_fallback > 0)
205
            ctx->dtshd_skip = sample_rate * ctx->dtshd_fallback / (blocks << 5);
206
        else
207 ec25f83b Janne Grunau
            /* skip permanently (dtshd_fallback == -1) or just once
208
             * (dtshd_fallback == 0) */
209 482d98f6 Anssi Hannula
            ctx->dtshd_skip = 1;
210
    }
211
    if (ctx->dtshd_skip && core_size) {
212
        pkt_size = core_size;
213
        if (ctx->dtshd_fallback >= 0)
214
            --ctx->dtshd_skip;
215
    }
216
217
    ctx->out_bytes   = sizeof(dtshd_start_code) + 2 + pkt_size;
218
    ctx->length_code = ctx->out_bytes;
219
220 ec25f83b Janne Grunau
    av_fast_malloc(&ctx->hd_buf, &ctx->hd_buf_size, ctx->out_bytes);
221 482d98f6 Anssi Hannula
    if (!ctx->hd_buf)
222
        return AVERROR(ENOMEM);
223
224
    ctx->out_buf = ctx->hd_buf;
225
226
    memcpy(ctx->hd_buf, dtshd_start_code, sizeof(dtshd_start_code));
227
    AV_WB16(ctx->hd_buf + sizeof(dtshd_start_code), pkt_size);
228
    memcpy(ctx->hd_buf + sizeof(dtshd_start_code) + 2, pkt->data, pkt_size);
229
230
    return 0;
231
}
232
233 ab1eff9c Bartlomiej Wolowiec
static int spdif_header_dts(AVFormatContext *s, AVPacket *pkt)
234
{
235 d8e481bb Anssi Hannula
    IEC61937Context *ctx = s->priv_data;
236 ab1eff9c Bartlomiej Wolowiec
    uint32_t syncword_dts = AV_RB32(pkt->data);
237
    int blocks;
238 482d98f6 Anssi Hannula
    int sample_rate = 0;
239
    int core_size = 0;
240
241
    if (pkt->size < 9)
242
        return AVERROR_INVALIDDATA;
243 ab1eff9c Bartlomiej Wolowiec
244
    switch (syncword_dts) {
245
    case DCA_MARKER_RAW_BE:
246
        blocks = (AV_RB16(pkt->data + 4) >> 2) & 0x7f;
247 482d98f6 Anssi Hannula
        core_size = ((AV_RB24(pkt->data + 5) >> 4) & 0x3fff) + 1;
248
        sample_rate = dca_sample_rates[(pkt->data[8] >> 2) & 0x0f];
249 ab1eff9c Bartlomiej Wolowiec
        break;
250
    case DCA_MARKER_RAW_LE:
251
        blocks = (AV_RL16(pkt->data + 4) >> 2) & 0x7f;
252 97790352 Anssi Hannula
        ctx->extra_bswap = 1;
253 ab1eff9c Bartlomiej Wolowiec
        break;
254
    case DCA_MARKER_14B_BE:
255
        blocks =
256
            (((pkt->data[5] & 0x07) << 4) | ((pkt->data[6] & 0x3f) >> 2));
257
        break;
258
    case DCA_MARKER_14B_LE:
259
        blocks =
260
            (((pkt->data[4] & 0x07) << 4) | ((pkt->data[7] & 0x3f) >> 2));
261 97790352 Anssi Hannula
        ctx->extra_bswap = 1;
262 ab1eff9c Bartlomiej Wolowiec
        break;
263 482d98f6 Anssi Hannula
    case DCA_HD_MARKER:
264
        /* We only handle HD frames that are paired with core. However,
265
           sometimes DTS-HD streams with core have a stray HD frame without
266
           core in the beginning of the stream. */
267
        av_log(s, AV_LOG_ERROR, "stray DTS-HD frame\n");
268
        return AVERROR_INVALIDDATA;
269 ab1eff9c Bartlomiej Wolowiec
    default:
270
        av_log(s, AV_LOG_ERROR, "bad DTS syncword 0x%x\n", syncword_dts);
271 a4c8e0a8 Anssi Hannula
        return AVERROR_INVALIDDATA;
272 ab1eff9c Bartlomiej Wolowiec
    }
273
    blocks++;
274 482d98f6 Anssi Hannula
275
    if (ctx->dtshd_rate)
276
        /* DTS type IV output requested */
277
        return spdif_header_dts4(s, pkt, core_size, sample_rate, blocks);
278
279 ab1eff9c Bartlomiej Wolowiec
    switch (blocks) {
280 d8e481bb Anssi Hannula
    case  512 >> 5: ctx->data_type = IEC61937_DTS1; break;
281
    case 1024 >> 5: ctx->data_type = IEC61937_DTS2; break;
282
    case 2048 >> 5: ctx->data_type = IEC61937_DTS3; break;
283 ab1eff9c Bartlomiej Wolowiec
    default:
284
        av_log(s, AV_LOG_ERROR, "%i samples in DTS frame not supported\n",
285
               blocks << 5);
286 a4c8e0a8 Anssi Hannula
        return AVERROR(ENOSYS);
287 ab1eff9c Bartlomiej Wolowiec
    }
288 482d98f6 Anssi Hannula
289
    /* discard extraneous data by default */
290
    if (core_size && core_size < pkt->size) {
291
        ctx->out_bytes = core_size;
292
        ctx->length_code = core_size << 3;
293
    }
294
295 ab1eff9c Bartlomiej Wolowiec
    ctx->pkt_offset = blocks << 7;
296
297 cc6c0c7b Anssi Hannula
    if (ctx->out_bytes == ctx->pkt_offset) {
298
        /* The DTS stream fits exactly into the output stream, so skip the
299
         * preamble as it would not fit in there. This is the case for dts
300
         * discs and dts-in-wav. */
301
        ctx->use_preamble = 0;
302 482d98f6 Anssi Hannula
    } else if (ctx->out_bytes > ctx->pkt_offset - BURST_HEADER_SIZE) {
303
        av_log_ask_for_sample(s, "Unrecognized large DTS frame.");
304
        /* This will fail with a "bitrate too high" in the caller */
305 cc6c0c7b Anssi Hannula
    }
306
307 ab1eff9c Bartlomiej Wolowiec
    return 0;
308
}
309
310 d8e481bb Anssi Hannula
static const enum IEC61937DataType mpeg_data_type[2][3] = {
311 ab1eff9c Bartlomiej Wolowiec
    //     LAYER1                      LAYER2                  LAYER3
312 d8e481bb Anssi Hannula
    { IEC61937_MPEG2_LAYER1_LSF, IEC61937_MPEG2_LAYER2_LSF, IEC61937_MPEG2_LAYER3_LSF },//MPEG2 LSF
313
    { IEC61937_MPEG1_LAYER1,     IEC61937_MPEG1_LAYER23,    IEC61937_MPEG1_LAYER23 },   //MPEG1
314 ab1eff9c Bartlomiej Wolowiec
};
315
316
static int spdif_header_mpeg(AVFormatContext *s, AVPacket *pkt)
317
{
318 d8e481bb Anssi Hannula
    IEC61937Context *ctx = s->priv_data;
319 ab1eff9c Bartlomiej Wolowiec
    int version =      (pkt->data[1] >> 3) & 3;
320
    int layer   = 3 - ((pkt->data[1] >> 1) & 3);
321
    int extension = pkt->data[2] & 1;
322
323
    if (layer == 3 || version == 1) {
324
        av_log(s, AV_LOG_ERROR, "Wrong MPEG file format\n");
325 a4c8e0a8 Anssi Hannula
        return AVERROR_INVALIDDATA;
326 ab1eff9c Bartlomiej Wolowiec
    }
327
    av_log(s, AV_LOG_DEBUG, "version: %i layer: %i extension: %i\n", version, layer, extension);
328
    if (version == 2 && extension) {
329 d8e481bb Anssi Hannula
        ctx->data_type  = IEC61937_MPEG2_EXT;
330 ab1eff9c Bartlomiej Wolowiec
        ctx->pkt_offset = 4608;
331
    } else {
332
        ctx->data_type  = mpeg_data_type [version & 1][layer];
333 8079d2ec Anssi Hannula
        ctx->pkt_offset = spdif_mpeg_pkt_offset[version & 1][layer];
334 ab1eff9c Bartlomiej Wolowiec
    }
335
    // TODO Data type dependant info (normal/karaoke, dynamic range control)
336
    return 0;
337
}
338
339
static int spdif_header_aac(AVFormatContext *s, AVPacket *pkt)
340
{
341 d8e481bb Anssi Hannula
    IEC61937Context *ctx = s->priv_data;
342 ab1eff9c Bartlomiej Wolowiec
    AACADTSHeaderInfo hdr;
343
    GetBitContext gbc;
344
    int ret;
345
346
    init_get_bits(&gbc, pkt->data, AAC_ADTS_HEADER_SIZE * 8);
347
    ret = ff_aac_parse_header(&gbc, &hdr);
348
    if (ret < 0) {
349
        av_log(s, AV_LOG_ERROR, "Wrong AAC file format\n");
350 a4c8e0a8 Anssi Hannula
        return AVERROR_INVALIDDATA;
351 ab1eff9c Bartlomiej Wolowiec
    }
352
353
    ctx->pkt_offset = hdr.samples << 2;
354
    switch (hdr.num_aac_frames) {
355
    case 1:
356 d8e481bb Anssi Hannula
        ctx->data_type = IEC61937_MPEG2_AAC;
357 ab1eff9c Bartlomiej Wolowiec
        break;
358
    case 2:
359 d8e481bb Anssi Hannula
        ctx->data_type = IEC61937_MPEG2_AAC_LSF_2048;
360 ab1eff9c Bartlomiej Wolowiec
        break;
361
    case 4:
362 d8e481bb Anssi Hannula
        ctx->data_type = IEC61937_MPEG2_AAC_LSF_4096;
363 ab1eff9c Bartlomiej Wolowiec
        break;
364
    default:
365
        av_log(s, AV_LOG_ERROR, "%i samples in AAC frame not supported\n",
366
               hdr.samples);
367 a4c8e0a8 Anssi Hannula
        return AVERROR(EINVAL);
368 ab1eff9c Bartlomiej Wolowiec
    }
369
    //TODO Data type dependent info (LC profile/SBR)
370
    return 0;
371
}
372
373 323e3f8b Anssi Hannula
374
/*
375
 * It seems Dolby TrueHD frames have to be encapsulated in MAT frames before
376
 * they can be encapsulated in IEC 61937.
377
 * Here we encapsulate 24 TrueHD frames in a single MAT frame, padding them
378
 * to achieve constant rate.
379
 * The actual format of a MAT frame is unknown, but the below seems to work.
380
 * However, it seems it is not actually necessary for the 24 TrueHD frames to
381
 * be in an exact alignment with the MAT frame.
382
 */
383
#define MAT_FRAME_SIZE          61424
384
#define TRUEHD_FRAME_OFFSET     2560
385
#define MAT_MIDDLE_CODE_OFFSET  -4
386
387
static int spdif_header_truehd(AVFormatContext *s, AVPacket *pkt)
388
{
389 d8e481bb Anssi Hannula
    IEC61937Context *ctx = s->priv_data;
390 323e3f8b Anssi Hannula
    int mat_code_length = 0;
391
    const char mat_end_code[16] = { 0xC3, 0xC2, 0xC0, 0xC4, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x97, 0x11 };
392
393
    if (!ctx->hd_buf_count) {
394
        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 };
395
        mat_code_length = sizeof(mat_start_code) + BURST_HEADER_SIZE;
396
        memcpy(ctx->hd_buf, mat_start_code, sizeof(mat_start_code));
397
398
    } else if (ctx->hd_buf_count == 12) {
399
        const char mat_middle_code[12] = { 0xC3, 0xC1, 0x42, 0x49, 0x3B, 0xFA, 0x82, 0x83, 0x49, 0x80, 0x77, 0xE0 };
400
        mat_code_length = sizeof(mat_middle_code) + MAT_MIDDLE_CODE_OFFSET;
401
        memcpy(&ctx->hd_buf[12 * TRUEHD_FRAME_OFFSET - BURST_HEADER_SIZE + MAT_MIDDLE_CODE_OFFSET],
402
               mat_middle_code, sizeof(mat_middle_code));
403
    }
404
405
    if (pkt->size > TRUEHD_FRAME_OFFSET - mat_code_length) {
406
        /* if such frames exist, we'd need some more complex logic to
407
         * distribute the TrueHD frames in the MAT frame */
408
        av_log(s, AV_LOG_ERROR, "TrueHD frame too big, %d bytes\n", pkt->size);
409
        av_log_ask_for_sample(s, NULL);
410 a4c8e0a8 Anssi Hannula
        return AVERROR_INVALIDDATA;
411 323e3f8b Anssi Hannula
    }
412
413
    memcpy(&ctx->hd_buf[ctx->hd_buf_count * TRUEHD_FRAME_OFFSET - BURST_HEADER_SIZE + mat_code_length],
414
           pkt->data, pkt->size);
415
    memset(&ctx->hd_buf[ctx->hd_buf_count * TRUEHD_FRAME_OFFSET - BURST_HEADER_SIZE + mat_code_length + pkt->size],
416
           0, TRUEHD_FRAME_OFFSET - pkt->size - mat_code_length);
417
418
    if (++ctx->hd_buf_count < 24){
419
        ctx->pkt_offset = 0;
420
        return 0;
421
    }
422
    memcpy(&ctx->hd_buf[MAT_FRAME_SIZE - sizeof(mat_end_code)], mat_end_code, sizeof(mat_end_code));
423
    ctx->hd_buf_count = 0;
424
425 d8e481bb Anssi Hannula
    ctx->data_type   = IEC61937_TRUEHD;
426 323e3f8b Anssi Hannula
    ctx->pkt_offset  = 61440;
427
    ctx->out_buf     = ctx->hd_buf;
428
    ctx->out_bytes   = MAT_FRAME_SIZE;
429
    ctx->length_code = MAT_FRAME_SIZE;
430
    return 0;
431
}
432
433 ab1eff9c Bartlomiej Wolowiec
static int spdif_write_header(AVFormatContext *s)
434
{
435 d8e481bb Anssi Hannula
    IEC61937Context *ctx = s->priv_data;
436 ab1eff9c Bartlomiej Wolowiec
437
    switch (s->streams[0]->codec->codec_id) {
438
    case CODEC_ID_AC3:
439
        ctx->header_info = spdif_header_ac3;
440
        break;
441 909865fd Carl Eugen Hoyos
    case CODEC_ID_EAC3:
442
        ctx->header_info = spdif_header_eac3;
443
        break;
444 ab1eff9c Bartlomiej Wolowiec
    case CODEC_ID_MP1:
445
    case CODEC_ID_MP2:
446
    case CODEC_ID_MP3:
447
        ctx->header_info = spdif_header_mpeg;
448
        break;
449
    case CODEC_ID_DTS:
450
        ctx->header_info = spdif_header_dts;
451
        break;
452
    case CODEC_ID_AAC:
453
        ctx->header_info = spdif_header_aac;
454
        break;
455 323e3f8b Anssi Hannula
    case CODEC_ID_TRUEHD:
456
        ctx->header_info = spdif_header_truehd;
457
        ctx->hd_buf = av_malloc(MAT_FRAME_SIZE);
458
        if (!ctx->hd_buf)
459
            return AVERROR(ENOMEM);
460
        break;
461 ab1eff9c Bartlomiej Wolowiec
    default:
462
        av_log(s, AV_LOG_ERROR, "codec not supported\n");
463 a4c8e0a8 Anssi Hannula
        return AVERROR_PATCHWELCOME;
464 ab1eff9c Bartlomiej Wolowiec
    }
465
    return 0;
466
}
467
468
static int spdif_write_trailer(AVFormatContext *s)
469
{
470 d8e481bb Anssi Hannula
    IEC61937Context *ctx = s->priv_data;
471 ab1eff9c Bartlomiej Wolowiec
    av_freep(&ctx->buffer);
472 909865fd Carl Eugen Hoyos
    av_freep(&ctx->hd_buf);
473 ab1eff9c Bartlomiej Wolowiec
    return 0;
474
}
475
476 57f2c9ae Anssi Hannula
static av_always_inline void spdif_put_16(IEC61937Context *ctx,
477 ae628ec1 Anton Khirnov
                                          AVIOContext *pb, unsigned int val)
478 57f2c9ae Anssi Hannula
{
479
    if (ctx->spdif_flags & SPDIF_FLAG_BIGENDIAN)
480 77eb5504 Anton Khirnov
        avio_wb16(pb, val);
481 57f2c9ae Anssi Hannula
    else
482 77eb5504 Anton Khirnov
        avio_wl16(pb, val);
483 57f2c9ae Anssi Hannula
}
484
485 ab1eff9c Bartlomiej Wolowiec
static int spdif_write_packet(struct AVFormatContext *s, AVPacket *pkt)
486
{
487 d8e481bb Anssi Hannula
    IEC61937Context *ctx = s->priv_data;
488 ab1eff9c Bartlomiej Wolowiec
    int ret, padding;
489
490 4b6bfbe2 Carl Eugen Hoyos
    ctx->out_buf = pkt->data;
491 909865fd Carl Eugen Hoyos
    ctx->out_bytes = pkt->size;
492
    ctx->length_code = FFALIGN(pkt->size, 2) << 3;
493 cc6c0c7b Anssi Hannula
    ctx->use_preamble = 1;
494 97790352 Anssi Hannula
    ctx->extra_bswap = 0;
495 909865fd Carl Eugen Hoyos
496 ab1eff9c Bartlomiej Wolowiec
    ret = ctx->header_info(s, pkt);
497
    if (ret < 0)
498 a4c8e0a8 Anssi Hannula
        return ret;
499 909865fd Carl Eugen Hoyos
    if (!ctx->pkt_offset)
500
        return 0;
501 ab1eff9c Bartlomiej Wolowiec
502 febd72be Anssi Hannula
    padding = (ctx->pkt_offset - ctx->use_preamble * BURST_HEADER_SIZE - ctx->out_bytes) & ~1;
503 ab1eff9c Bartlomiej Wolowiec
    if (padding < 0) {
504
        av_log(s, AV_LOG_ERROR, "bitrate is too high\n");
505 a4c8e0a8 Anssi Hannula
        return AVERROR(EINVAL);
506 ab1eff9c Bartlomiej Wolowiec
    }
507
508 cc6c0c7b Anssi Hannula
    if (ctx->use_preamble) {
509 57f2c9ae Anssi Hannula
        spdif_put_16(ctx, s->pb, SYNCWORD1);       //Pa
510
        spdif_put_16(ctx, s->pb, SYNCWORD2);       //Pb
511
        spdif_put_16(ctx, s->pb, ctx->data_type);  //Pc
512
        spdif_put_16(ctx, s->pb, ctx->length_code);//Pd
513 cc6c0c7b Anssi Hannula
    }
514 ab1eff9c Bartlomiej Wolowiec
515 57f2c9ae Anssi Hannula
    if (ctx->extra_bswap ^ (ctx->spdif_flags & SPDIF_FLAG_BIGENDIAN)) {
516 77eb5504 Anton Khirnov
    avio_write(s->pb, ctx->out_buf, ctx->out_bytes & ~1);
517 97790352 Anssi Hannula
    } else {
518 909865fd Carl Eugen Hoyos
    av_fast_malloc(&ctx->buffer, &ctx->buffer_size, ctx->out_bytes + FF_INPUT_BUFFER_PADDING_SIZE);
519 ab1eff9c Bartlomiej Wolowiec
    if (!ctx->buffer)
520
        return AVERROR(ENOMEM);
521 909865fd Carl Eugen Hoyos
    ff_spdif_bswap_buf16((uint16_t *)ctx->buffer, (uint16_t *)ctx->out_buf, ctx->out_bytes >> 1);
522 77eb5504 Anton Khirnov
    avio_write(s->pb, ctx->buffer, ctx->out_bytes & ~1);
523 97790352 Anssi Hannula
    }
524 ab1eff9c Bartlomiej Wolowiec
525 57f2c9ae Anssi Hannula
    /* a final lone byte has to be MSB aligned */
526 909865fd Carl Eugen Hoyos
    if (ctx->out_bytes & 1)
527 57f2c9ae Anssi Hannula
        spdif_put_16(ctx, s->pb, ctx->out_buf[ctx->out_bytes - 1] << 8);
528 ab1eff9c Bartlomiej Wolowiec
529 0ac8e2bf Anton Khirnov
    ffio_fill(s->pb, 0, padding);
530 ab1eff9c Bartlomiej Wolowiec
531
    av_log(s, AV_LOG_DEBUG, "type=%x len=%i pkt_offset=%i\n",
532 909865fd Carl Eugen Hoyos
           ctx->data_type, ctx->out_bytes, ctx->pkt_offset);
533 ab1eff9c Bartlomiej Wolowiec
534 b7f2fdde Anton Khirnov
    avio_flush(s->pb);
535 ab1eff9c Bartlomiej Wolowiec
    return 0;
536
}
537
538 c6610a21 Diego Elio Pettenò
AVOutputFormat ff_spdif_muxer = {
539 ab1eff9c Bartlomiej Wolowiec
    "spdif",
540 d8e481bb Anssi Hannula
    NULL_IF_CONFIG_SMALL("IEC 61937 (used on S/PDIF - IEC958)"),
541 ab1eff9c Bartlomiej Wolowiec
    NULL,
542
    "spdif",
543 d8e481bb Anssi Hannula
    sizeof(IEC61937Context),
544 ab1eff9c Bartlomiej Wolowiec
    CODEC_ID_AC3,
545
    CODEC_ID_NONE,
546
    spdif_write_header,
547
    spdif_write_packet,
548
    spdif_write_trailer,
549 6c60fcf8 Anssi Hannula
    .flags = AVFMT_NOTIMESTAMPS,
550 482d98f6 Anssi Hannula
    .priv_class = &class,
551 ab1eff9c Bartlomiej Wolowiec
};