mpegtsenc.c 31.6 KB
Newer Older
1
/*
2
 * MPEG2 transport stream (aka DVB) muxer
3
 * Copyright (c) 2003 Fabrice Bellard
4
 *
5 6 7
 * This file is part of FFmpeg.
 *
 * FFmpeg is free software; you can redistribute it and/or
8 9
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
10
 * version 2.1 of the License, or (at your option) any later version.
11
 *
12
 * FFmpeg is distributed in the hope that it will be useful,
13 14 15 16 17
 * 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
18
 * License along with FFmpeg; if not, write to the Free Software
19
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
20
 */
21

22
#include "libavutil/bswap.h"
23
#include "libavutil/crc.h"
24
#include "libavutil/opt.h"
25
#include "libavcodec/mpegvideo.h"
26
#include "avformat.h"
27
#include "internal.h"
28
#include "mpegts.h"
29
#include "adts.h"
30

31 32
#define PCR_TIME_BASE 27000000

33 34 35 36 37 38 39 40 41 42 43 44
/* write DVB SI sections */

/*********************************************/
/* mpegts section writer */

typedef struct MpegTSSection {
    int pid;
    int cc;
    void (*write_packet)(struct MpegTSSection *s, const uint8_t *packet);
    void *opaque;
} MpegTSSection;

45 46 47 48 49 50 51
typedef struct MpegTSService {
    MpegTSSection pmt; /* MPEG2 pmt table context */
    int sid;           /* service ID */
    char *name;
    char *provider_name;
    int pcr_pid;
    int pcr_packet_count;
52
    int pcr_packet_period;
53 54 55 56 57 58 59
} MpegTSService;

typedef struct MpegTSWrite {
    MpegTSSection pat; /* MPEG2 pat table */
    MpegTSSection sdt; /* MPEG2 sdt table context */
    MpegTSService **services;
    int sdt_packet_count;
60
    int sdt_packet_period;
61
    int pat_packet_count;
62
    int pat_packet_period;
63 64 65
    int nb_services;
    int onid;
    int tsid;
66
    int64_t first_pcr;
67
    int mux_rate; ///< set to 1 when VBR
68 69 70 71 72 73 74

    int transport_stream_id;
    int original_network_id;
    int service_id;

    int pmt_start_pid;
    int start_pid;
75 76
} MpegTSWrite;

77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97
static const AVOption options[] = {
    { "mpegts_transport_stream_id", "Set transport_stream_id field.",
      offsetof(MpegTSWrite, transport_stream_id), FF_OPT_TYPE_INT, 0x0001, 0x0001, 0xffff, AV_OPT_FLAG_ENCODING_PARAM},
    { "mpegts_original_network_id", "Set original_network_id field.",
      offsetof(MpegTSWrite, original_network_id), FF_OPT_TYPE_INT, 0x0001, 0x0001, 0xffff, AV_OPT_FLAG_ENCODING_PARAM},
    { "mpegts_service_id", "Set service_id field.",
      offsetof(MpegTSWrite, service_id), FF_OPT_TYPE_INT, 0x0001, 0x0001, 0xffff, AV_OPT_FLAG_ENCODING_PARAM},
    { "mpegts_pmt_start_pid", "Set the first pid of the PMT.",
      offsetof(MpegTSWrite, pmt_start_pid), FF_OPT_TYPE_INT, 0x1000, 0x1000, 0x1f00, AV_OPT_FLAG_ENCODING_PARAM},
    { "mpegts_start_pid", "Set the first pid.",
      offsetof(MpegTSWrite, start_pid), FF_OPT_TYPE_INT, 0x0100, 0x0100, 0x0f00, AV_OPT_FLAG_ENCODING_PARAM},
    { NULL },
};

static const AVClass mpegts_muxer_class = {
    "MPEGTS muxer",
    av_default_item_name,
    options,
    LIBAVUTIL_VERSION_INT,
};

98
/* NOTE: 4 bytes must be left at the end for the crc32 */
99
static void mpegts_write_section(MpegTSSection *s, uint8_t *buf, int len)
100 101 102 103 104 105 106
{
    unsigned int crc;
    unsigned char packet[TS_PACKET_SIZE];
    const unsigned char *buf_ptr;
    unsigned char *q;
    int first, b, len1, left;

M
Måns Rullgård 已提交
107
    crc = av_bswap32(av_crc(av_crc_get_table(AV_CRC_32_IEEE), -1, buf, len - 4));
108 109 110 111
    buf[len - 4] = (crc >> 24) & 0xff;
    buf[len - 3] = (crc >> 16) & 0xff;
    buf[len - 2] = (crc >> 8) & 0xff;
    buf[len - 1] = (crc) & 0xff;
112

113 114 115 116 117 118 119 120 121 122 123
    /* send each packet */
    buf_ptr = buf;
    while (len > 0) {
        first = (buf == buf_ptr);
        q = packet;
        *q++ = 0x47;
        b = (s->pid >> 8);
        if (first)
            b |= 0x40;
        *q++ = b;
        *q++ = s->pid;
124
        s->cc = (s->cc + 1) & 0xf;
125
        *q++ = 0x10 | s->cc;
126 127 128
        if (first)
            *q++ = 0; /* 0 offset */
        len1 = TS_PACKET_SIZE - (q - packet);
129
        if (len1 > len)
130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153
            len1 = len;
        memcpy(q, buf_ptr, len1);
        q += len1;
        /* add known padding data */
        left = TS_PACKET_SIZE - (q - packet);
        if (left > 0)
            memset(q, 0xff, left);

        s->write_packet(s, packet);

        buf_ptr += len1;
        len -= len1;
    }
}

static inline void put16(uint8_t **q_ptr, int val)
{
    uint8_t *q;
    q = *q_ptr;
    *q++ = val >> 8;
    *q++ = val;
    *q_ptr = q;
}

154
static int mpegts_write_section1(MpegTSSection *s, int tid, int id,
155 156 157 158 159
                          int version, int sec_num, int last_sec_num,
                          uint8_t *buf, int len)
{
    uint8_t section[1024], *q;
    unsigned int tot_len;
160 161
    /* reserved_future_use field must be set to 1 for SDT */
    unsigned int flags = tid == SDT_TID ? 0xf000 : 0xb000;
162

163 164 165 166 167 168 169
    tot_len = 3 + 5 + len + 4;
    /* check if not too big */
    if (tot_len > 1024)
        return -1;

    q = section;
    *q++ = tid;
170
    put16(&q, flags | (len + 5 + 4)); /* 5 byte header + 4 byte CRC */
171 172 173 174 175
    put16(&q, id);
    *q++ = 0xc1 | (version << 1); /* current_next_indicator = 1 */
    *q++ = sec_num;
    *q++ = last_sec_num;
    memcpy(q, buf, len);
176

177 178 179 180 181 182 183 184 185 186 187 188
    mpegts_write_section(s, section, tot_len);
    return 0;
}

/*********************************************/
/* mpegts writer */

#define DEFAULT_PROVIDER_NAME   "FFmpeg"
#define DEFAULT_SERVICE_NAME    "Service01"

/* a PES packet header is generated every DEFAULT_PES_HEADER_FREQ packets */
#define DEFAULT_PES_HEADER_FREQ 16
189
#define DEFAULT_PES_PAYLOAD_SIZE ((DEFAULT_PES_HEADER_FREQ - 1) * 184 + 170)
190 191 192 193

/* we retransmit the SI info at this rate */
#define SDT_RETRANS_TIME 500
#define PAT_RETRANS_TIME 100
194
#define PCR_RETRANS_TIME 20
195 196

typedef struct MpegTSWriteStream {
197
    struct MpegTSService *service;
198 199
    int pid; /* stream associated pid */
    int cc;
200
    int payload_index;
201
    int first_pts_check; ///< first pts check needed
202
    int64_t payload_pts;
203
    int64_t payload_dts;
204
    uint8_t payload[DEFAULT_PES_PAYLOAD_SIZE];
205
    ADTSContext *adts;
206 207 208 209 210 211 212 213
} MpegTSWriteStream;

static void mpegts_write_pat(AVFormatContext *s)
{
    MpegTSWrite *ts = s->priv_data;
    MpegTSService *service;
    uint8_t data[1012], *q;
    int i;
214

215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241
    q = data;
    for(i = 0; i < ts->nb_services; i++) {
        service = ts->services[i];
        put16(&q, service->sid);
        put16(&q, 0xe000 | service->pmt.pid);
    }
    mpegts_write_section1(&ts->pat, PAT_TID, ts->tsid, 0, 0, 0,
                          data, q - data);
}

static void mpegts_write_pmt(AVFormatContext *s, MpegTSService *service)
{
    //    MpegTSWrite *ts = s->priv_data;
    uint8_t data[1012], *q, *desc_length_ptr, *program_info_length_ptr;
    int val, stream_type, i;

    q = data;
    put16(&q, 0xe000 | service->pcr_pid);

    program_info_length_ptr = q;
    q += 2; /* patched after */

    /* put program info here */

    val = 0xf000 | (q - program_info_length_ptr - 2);
    program_info_length_ptr[0] = val >> 8;
    program_info_length_ptr[1] = val;
242

243 244 245
    for(i = 0; i < s->nb_streams; i++) {
        AVStream *st = s->streams[i];
        MpegTSWriteStream *ts_st = st->priv_data;
246
        AVMetadataTag *lang = av_metadata_get(st->metadata, "language", NULL,0);
247
        switch(st->codec->codec_id) {
248 249 250
        case CODEC_ID_MPEG1VIDEO:
        case CODEC_ID_MPEG2VIDEO:
            stream_type = STREAM_TYPE_VIDEO_MPEG2;
251
            break;
252 253 254 255 256 257
        case CODEC_ID_MPEG4:
            stream_type = STREAM_TYPE_VIDEO_MPEG4;
            break;
        case CODEC_ID_H264:
            stream_type = STREAM_TYPE_VIDEO_H264;
            break;
258 259 260
        case CODEC_ID_DIRAC:
            stream_type = STREAM_TYPE_VIDEO_DIRAC;
            break;
261 262
        case CODEC_ID_MP2:
        case CODEC_ID_MP3:
263
            stream_type = STREAM_TYPE_AUDIO_MPEG1;
264
            break;
265 266 267
        case CODEC_ID_AAC:
            stream_type = STREAM_TYPE_AUDIO_AAC;
            break;
268 269 270
        case CODEC_ID_AAC_LATM:
            stream_type = STREAM_TYPE_AUDIO_AAC_LATM;
            break;
271
        case CODEC_ID_AC3:
272
            stream_type = STREAM_TYPE_AUDIO_AC3;
273
            break;
274 275 276 277 278 279 280 281 282 283
        default:
            stream_type = STREAM_TYPE_PRIVATE_DATA;
            break;
        }
        *q++ = stream_type;
        put16(&q, 0xe000 | ts_st->pid);
        desc_length_ptr = q;
        q += 2; /* patched after */

        /* write optional descriptors here */
284
        switch(st->codec->codec_type) {
285
        case AVMEDIA_TYPE_AUDIO:
286
            if (lang && strlen(lang->value) == 3) {
287 288
                *q++ = 0x0a; /* ISO 639 language descriptor */
                *q++ = 4;
289 290 291
                *q++ = lang->value[0];
                *q++ = lang->value[1];
                *q++ = lang->value[2];
292 293 294 295 296 297 298
                if (st->disposition & AV_DISPOSITION_CLEAN_EFFECTS)
                    *q++ = 0x01;
                else if (st->disposition & AV_DISPOSITION_HEARING_IMPAIRED)
                    *q++ = 0x02;
                else if (st->disposition & AV_DISPOSITION_VISUAL_IMPAIRED)
                    *q++ = 0x03;
                else
299 300 301
                *q++ = 0; /* undefined type */
            }
            break;
302
        case AVMEDIA_TYPE_SUBTITLE:
303 304
            {
                const char *language;
305
                language = lang && strlen(lang->value)==3 ? lang->value : "eng";
306 307 308 309 310 311
                *q++ = 0x59;
                *q++ = 8;
                *q++ = language[0];
                *q++ = language[1];
                *q++ = language[2];
                *q++ = 0x10; /* normal subtitles (0x20 = if hearing pb) */
312 313 314 315
                if(st->codec->extradata_size == 4) {
                    memcpy(q, st->codec->extradata, 4);
                    q += 4;
                } else {
T
Tomas Härdin 已提交
316 317
                    put16(&q, 1); /* page id */
                    put16(&q, 1); /* ancillary page id */
318
                }
319 320
            }
            break;
321
        case AVMEDIA_TYPE_VIDEO:
322 323 324 325 326 327 328 329 330
            if (stream_type == STREAM_TYPE_VIDEO_DIRAC) {
                *q++ = 0x05; /*MPEG-2 registration descriptor*/
                *q++ = 4;
                *q++ = 'd';
                *q++ = 'r';
                *q++ = 'a';
                *q++ = 'c';
            }
            break;
331
        }
332 333 334 335 336 337 338

        val = 0xf000 | (q - desc_length_ptr - 2);
        desc_length_ptr[0] = val >> 8;
        desc_length_ptr[1] = val;
    }
    mpegts_write_section1(&service->pmt, PMT_TID, service->sid, 0, 0, 0,
                          data, q - data);
339
}
340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363

/* NOTE: str == NULL is accepted for an empty string */
static void putstr8(uint8_t **q_ptr, const char *str)
{
    uint8_t *q;
    int len;

    q = *q_ptr;
    if (!str)
        len = 0;
    else
        len = strlen(str);
    *q++ = len;
    memcpy(q, str, len);
    q += len;
    *q_ptr = q;
}

static void mpegts_write_sdt(AVFormatContext *s)
{
    MpegTSWrite *ts = s->priv_data;
    MpegTSService *service;
    uint8_t data[1012], *q, *desc_list_len_ptr, *desc_len_ptr;
    int i, running_status, free_ca_mode, val;
364

365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386
    q = data;
    put16(&q, ts->onid);
    *q++ = 0xff;
    for(i = 0; i < ts->nb_services; i++) {
        service = ts->services[i];
        put16(&q, service->sid);
        *q++ = 0xfc | 0x00; /* currently no EIT info */
        desc_list_len_ptr = q;
        q += 2;
        running_status = 4; /* running */
        free_ca_mode = 0;

        /* write only one descriptor for the service name and provider */
        *q++ = 0x48;
        desc_len_ptr = q;
        q++;
        *q++ = 0x01; /* digital television service */
        putstr8(&q, service->provider_name);
        putstr8(&q, service->name);
        desc_len_ptr[0] = q - desc_len_ptr - 1;

        /* fill descriptor length */
387
        val = (running_status << 13) | (free_ca_mode << 12) |
388 389 390 391 392 393 394 395
            (q - desc_list_len_ptr - 2);
        desc_list_len_ptr[0] = val >> 8;
        desc_list_len_ptr[1] = val;
    }
    mpegts_write_section1(&ts->sdt, SDT_TID, ts->tsid, 0, 0, 0,
                          data, q - data);
}

396 397 398
static MpegTSService *mpegts_add_service(MpegTSWrite *ts,
                                         int sid,
                                         const char *provider_name,
399 400 401 402 403 404 405
                                         const char *name)
{
    MpegTSService *service;

    service = av_mallocz(sizeof(MpegTSService));
    if (!service)
        return NULL;
406
    service->pmt.pid = ts->pmt_start_pid + ts->nb_services - 1;
407 408 409 410 411 412 413 414 415 416 417
    service->sid = sid;
    service->provider_name = av_strdup(provider_name);
    service->name = av_strdup(name);
    service->pcr_pid = 0x1fff;
    dynarray_add(&ts->services, &ts->nb_services, service);
    return service;
}

static void section_write_packet(MpegTSSection *s, const uint8_t *packet)
{
    AVFormatContext *ctx = s->opaque;
418
    put_buffer(ctx->pb, packet, TS_PACKET_SIZE);
419 420 421 422 423 424 425
}

static int mpegts_write_header(AVFormatContext *s)
{
    MpegTSWrite *ts = s->priv_data;
    MpegTSWriteStream *ts_st;
    MpegTSService *service;
426
    AVStream *st, *pcr_st = NULL;
427
    AVMetadataTag *title, *provider;
428
    int i, j;
429
    const char *service_name;
430
    const char *provider_name;
431
    int *pids;
432

433 434
    ts->tsid = ts->transport_stream_id;
    ts->onid = ts->original_network_id;
435
    /* allocate a single DVB service */
436
    title = av_metadata_get(s->metadata, "service_name", NULL, 0);
437
    if (!title)
438
        title = av_metadata_get(s->metadata, "title", NULL, 0);
439
    service_name = title ? title->value : DEFAULT_SERVICE_NAME;
440 441
    provider = av_metadata_get(s->metadata, "service_provider", NULL, 0);
    provider_name = provider ? provider->value : DEFAULT_PROVIDER_NAME;
442
    service = mpegts_add_service(ts, ts->service_id, provider_name, service_name);
443 444
    service->pmt.write_packet = section_write_packet;
    service->pmt.opaque = s;
445
    service->pmt.cc = 15;
446 447

    ts->pat.pid = PAT_PID;
448
    ts->pat.cc = 15; // Initialize at 15 so that it wraps and be equal to 0 for the first packet we write
449 450 451 452
    ts->pat.write_packet = section_write_packet;
    ts->pat.opaque = s;

    ts->sdt.pid = SDT_PID;
453
    ts->sdt.cc = 15;
454 455 456
    ts->sdt.write_packet = section_write_packet;
    ts->sdt.opaque = s;

457
    pids = av_malloc(s->nb_streams * sizeof(*pids));
458 459 460
    if (!pids)
        return AVERROR(ENOMEM);

461 462 463 464 465 466 467
    /* assign pids to each stream */
    for(i = 0;i < s->nb_streams; i++) {
        st = s->streams[i];
        ts_st = av_mallocz(sizeof(MpegTSWriteStream));
        if (!ts_st)
            goto fail;
        st->priv_data = ts_st;
468
        ts_st->service = service;
469 470 471
        /* MPEG pid values < 16 are reserved. Applications which set st->id in
         * this range are assigned a calculated pid. */
        if (st->id < 16) {
472
            ts_st->pid = ts->start_pid + i;
473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488
        } else if (st->id < 0x1FFF) {
            ts_st->pid = st->id;
        } else {
            av_log(s, AV_LOG_ERROR, "Invalid stream id %d, must be less than 8191\n", st->id);
            goto fail;
        }
        if (ts_st->pid == service->pmt.pid) {
            av_log(s, AV_LOG_ERROR, "Duplicate stream id %d\n", ts_st->pid);
            goto fail;
        }
        for (j = 0; j < i; j++)
            if (pids[j] == ts_st->pid) {
                av_log(s, AV_LOG_ERROR, "Duplicate stream id %d\n", ts_st->pid);
                goto fail;
            }
        pids[i] = ts_st->pid;
489
        ts_st->payload_pts = AV_NOPTS_VALUE;
490
        ts_st->payload_dts = AV_NOPTS_VALUE;
491
        ts_st->first_pts_check = 1;
492
        ts_st->cc = 15;
493
        /* update PCR pid by using the first video stream */
494
        if (st->codec->codec_type == AVMEDIA_TYPE_VIDEO &&
495
            service->pcr_pid == 0x1fff) {
496
            service->pcr_pid = ts_st->pid;
497
            pcr_st = st;
498
        }
499 500 501 502
        if (st->codec->codec_id == CODEC_ID_AAC &&
            st->codec->extradata_size > 0) {
            ts_st->adts = av_mallocz(sizeof(*ts_st->adts));
            if (!ts_st->adts)
503
                return AVERROR(ENOMEM);
504 505 506 507
            if (ff_adts_decode_extradata(s, ts_st->adts, st->codec->extradata,
                                         st->codec->extradata_size) < 0)
                return -1;
        }
508
    }
509

510 511
    av_free(pids);

512 513
    /* if no video stream, use the first stream as PCR */
    if (service->pcr_pid == 0x1fff && s->nb_streams > 0) {
514 515
        pcr_st = s->streams[0];
        ts_st = pcr_st->priv_data;
516 517 518
        service->pcr_pid = ts_st->pid;
    }

519
    ts->mux_rate = s->mux_rate ? s->mux_rate : 1;
520

521
    if (ts->mux_rate > 1) {
B
Baptiste Coudurier 已提交
522 523 524 525 526 527 528
        service->pcr_packet_period = (ts->mux_rate * PCR_RETRANS_TIME) /
            (TS_PACKET_SIZE * 8 * 1000);
        ts->sdt_packet_period      = (ts->mux_rate * SDT_RETRANS_TIME) /
            (TS_PACKET_SIZE * 8 * 1000);
        ts->pat_packet_period      = (ts->mux_rate * PAT_RETRANS_TIME) /
            (TS_PACKET_SIZE * 8 * 1000);

529
        ts->first_pcr = av_rescale(s->max_delay, PCR_TIME_BASE, AV_TIME_BASE);
530 531 532 533
    } else {
        /* Arbitrary values, PAT/PMT could be written on key frames */
        ts->sdt_packet_period = 200;
        ts->pat_packet_period = 40;
534
        if (pcr_st->codec->codec_type == AVMEDIA_TYPE_AUDIO) {
535 536 537 538 539 540 541 542 543 544 545 546 547 548 549
            if (!pcr_st->codec->frame_size) {
                av_log(s, AV_LOG_WARNING, "frame size not set\n");
                service->pcr_packet_period =
                    pcr_st->codec->sample_rate/(10*512);
            } else {
                service->pcr_packet_period =
                    pcr_st->codec->sample_rate/(10*pcr_st->codec->frame_size);
            }
        } else {
            // max delta PCR 0.1s
            service->pcr_packet_period =
                pcr_st->codec->time_base.den/(10*pcr_st->codec->time_base.num);
        }
    }

550 551
    // output a PCR as soon as possible
    service->pcr_packet_count = service->pcr_packet_period;
552 553
    ts->pat_packet_count = ts->pat_packet_period-1;
    ts->sdt_packet_count = ts->sdt_packet_period-1;
554

555 556 557 558 559
    if (ts->mux_rate == 1)
        av_log(s, AV_LOG_INFO, "muxrate VBR, ");
    else
        av_log(s, AV_LOG_INFO, "muxrate %d, ", ts->mux_rate);
    av_log(s, AV_LOG_INFO, "pcr every %d pkts, "
560
           "sdt every %d, pat/pmt every %d pkts\n",
561
           service->pcr_packet_period,
562
           ts->sdt_packet_period, ts->pat_packet_period);
563

564
    put_flush_packet(s->pb);
565 566 567 568

    return 0;

 fail:
569
    av_free(pids);
570 571 572 573 574 575 576 577 578 579 580 581 582
    for(i = 0;i < s->nb_streams; i++) {
        st = s->streams[i];
        av_free(st->priv_data);
    }
    return -1;
}

/* send SDT, PAT and PMT tables regulary */
static void retransmit_si_info(AVFormatContext *s)
{
    MpegTSWrite *ts = s->priv_data;
    int i;

583
    if (++ts->sdt_packet_count == ts->sdt_packet_period) {
584 585 586
        ts->sdt_packet_count = 0;
        mpegts_write_sdt(s);
    }
587
    if (++ts->pat_packet_count == ts->pat_packet_period) {
588 589 590 591 592 593 594 595
        ts->pat_packet_count = 0;
        mpegts_write_pat(s);
        for(i = 0; i < ts->nb_services; i++) {
            mpegts_write_pmt(s, ts->services[i]);
        }
    }
}

596 597 598 599 600 601 602 603 604 605 606 607 608 609
static int64_t get_pcr(const MpegTSWrite *ts, ByteIOContext *pb)
{
    return av_rescale(url_ftell(pb) + 11, 8 * PCR_TIME_BASE, ts->mux_rate) +
           ts->first_pcr;
}

static uint8_t* write_pcr_bits(uint8_t *buf, int64_t pcr)
{
    int64_t pcr_low = pcr % 300, pcr_high = pcr / 300;

    *buf++ = pcr_high >> 25;
    *buf++ = pcr_high >> 17;
    *buf++ = pcr_high >> 9;
    *buf++ = pcr_high >> 1;
610
    *buf++ = pcr_high << 7 | pcr_low >> 8 | 0x7e;
611 612 613 614 615
    *buf++ = pcr_low;

    return buf;
}

616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648
/* Write a single null transport stream packet */
static void mpegts_insert_null_packet(AVFormatContext *s)
{
    uint8_t *q;
    uint8_t buf[TS_PACKET_SIZE];

    q = buf;
    *q++ = 0x47;
    *q++ = 0x00 | 0x1f;
    *q++ = 0xff;
    *q++ = 0x10;
    memset(q, 0x0FF, TS_PACKET_SIZE - (q - buf));
    put_buffer(s->pb, buf, TS_PACKET_SIZE);
}

/* Write a single transport stream packet with a PCR and no payload */
static void mpegts_insert_pcr_only(AVFormatContext *s, AVStream *st)
{
    MpegTSWrite *ts = s->priv_data;
    MpegTSWriteStream *ts_st = st->priv_data;
    uint8_t *q;
    uint8_t buf[TS_PACKET_SIZE];

    q = buf;
    *q++ = 0x47;
    *q++ = ts_st->pid >> 8;
    *q++ = ts_st->pid;
    *q++ = 0x20 | ts_st->cc;   /* Adaptation only */
    /* Continuity Count field does not increment (see 13818-1 section 2.4.3.3) */
    *q++ = TS_PACKET_SIZE - 5; /* Adaptation Field Length */
    *q++ = 0x10;               /* Adaptation flags: PCR present */

    /* PCR coded into 6 bytes */
649
    q = write_pcr_bits(q, get_pcr(ts, s->pb));
650 651 652 653 654 655

    /* stuffing bytes */
    memset(q, 0xFF, TS_PACKET_SIZE - (q - buf));
    put_buffer(s->pb, buf, TS_PACKET_SIZE);
}

656 657 658 659 660 661 662 663 664 665 666 667 668 669
static void write_pts(uint8_t *q, int fourbits, int64_t pts)
{
    int val;

    val = fourbits << 4 | (((pts >> 30) & 0x07) << 1) | 1;
    *q++ = val;
    val = (((pts >> 15) & 0x7fff) << 1) | 1;
    *q++ = val >> 8;
    *q++ = val;
    val = (((pts) & 0x7fff) << 1) | 1;
    *q++ = val >> 8;
    *q++ = val;
}

670 671 672 673 674
/* Add a pes header to the front of payload, and segment into an integer number of
 * ts packets. The final ts packet is padded using an over-sized adaptation header
 * to exactly fill the last ts packet.
 * NOTE: 'payload' contains a complete PES payload.
 */
675 676
static void mpegts_write_pes(AVFormatContext *s, AVStream *st,
                             const uint8_t *payload, int payload_size,
677
                             int64_t pts, int64_t dts)
678 679
{
    MpegTSWriteStream *ts_st = st->priv_data;
680
    MpegTSWrite *ts = s->priv_data;
681
    uint8_t buf[TS_PACKET_SIZE];
682
    uint8_t *q;
683
    int val, is_start, len, header_len, write_pcr, private_code, flags;
684 685
    int afc_len, stuffing_len;
    int64_t pcr = -1; /* avoid warning */
686
    int64_t delay = av_rescale(s->max_delay, 90000, AV_TIME_BASE);
687

688 689 690
    is_start = 1;
    while (payload_size > 0) {
        retransmit_si_info(s);
691

692 693
        write_pcr = 0;
        if (ts_st->pid == ts_st->service->pcr_pid) {
694 695
            if (ts->mux_rate > 1 || is_start) // VBR pcr period is based on frames
                ts_st->service->pcr_packet_count++;
696
            if (ts_st->service->pcr_packet_count >=
697
                ts_st->service->pcr_packet_period) {
698 699 700 701 702
                ts_st->service->pcr_packet_count = 0;
                write_pcr = 1;
            }
        }

703
        if (ts->mux_rate > 1 && dts != AV_NOPTS_VALUE &&
704
            (dts - get_pcr(ts, s->pb)/300) > delay) {
705 706 707 708 709 710 711 712
            /* pcr insert gets priority over null packet insert */
            if (write_pcr)
                mpegts_insert_pcr_only(s, st);
            else
                mpegts_insert_null_packet(s);
            continue; /* recalculate write_pcr and possibly retransmit si_info */
        }

713 714 715 716 717 718 719 720 721
        /* prepare packet header */
        q = buf;
        *q++ = 0x47;
        val = (ts_st->pid >> 8);
        if (is_start)
            val |= 0x40;
        *q++ = val;
        *q++ = ts_st->pid;
        ts_st->cc = (ts_st->cc + 1) & 0xf;
722
        *q++ = 0x10 | ts_st->cc | (write_pcr ? 0x20 : 0);
723
        if (write_pcr) {
724
            // add 11, pcr references the last byte of program clock reference base
725
            if (ts->mux_rate > 1)
726
                pcr = get_pcr(ts, s->pb);
727
            else
728 729
                pcr = (dts - delay)*300;
            if (dts != AV_NOPTS_VALUE && dts < pcr / 300)
730
                av_log(s, AV_LOG_WARNING, "dts < pcr, TS is invalid\n");
731 732
            *q++ = 7; /* AFC length */
            *q++ = 0x10; /* flags: PCR present */
733
            q = write_pcr_bits(q, pcr);
734
        }
735
        if (is_start) {
736
            int pes_extension = 0;
737 738 739 740
            /* write PES header */
            *q++ = 0x00;
            *q++ = 0x00;
            *q++ = 0x01;
741
            private_code = 0;
742
            if (st->codec->codec_type == AVMEDIA_TYPE_VIDEO) {
743 744 745 746
                if (st->codec->codec_id == CODEC_ID_DIRAC) {
                    *q++ = 0xfd;
                } else
                    *q++ = 0xe0;
747
            } else if (st->codec->codec_type == AVMEDIA_TYPE_AUDIO &&
748 749
                       (st->codec->codec_id == CODEC_ID_MP2 ||
                        st->codec->codec_id == CODEC_ID_MP3)) {
750
                *q++ = 0xc0;
751 752
            } else {
                *q++ = 0xbd;
753
                if (st->codec->codec_type == AVMEDIA_TYPE_SUBTITLE) {
754 755 756
                    private_code = 0x20;
                }
            }
757 758 759 760 761 762
            header_len = 0;
            flags = 0;
            if (pts != AV_NOPTS_VALUE) {
                header_len += 5;
                flags |= 0x80;
            }
763
            if (dts != AV_NOPTS_VALUE && pts != AV_NOPTS_VALUE && dts != pts) {
764 765 766
                header_len += 5;
                flags |= 0x40;
            }
767
            if (st->codec->codec_type == AVMEDIA_TYPE_VIDEO &&
768 769 770 771 772 773 774 775 776 777 778 779
                st->codec->codec_id == CODEC_ID_DIRAC) {
                /* set PES_extension_flag */
                pes_extension = 1;
                flags |= 0x01;

                /*
                * One byte for PES2 extension flag +
                * one byte for extension length +
                * one byte for extension id
                */
                header_len += 3;
            }
780
            len = payload_size + header_len + 3;
781
            if (private_code != 0)
782
                len++;
783 784
            if (len > 0xffff)
                len = 0;
785 786
            *q++ = len >> 8;
            *q++ = len;
787 788
            val = 0x80;
            /* data alignment indicator is required for subtitle data */
789
            if (st->codec->codec_type == AVMEDIA_TYPE_SUBTITLE)
790 791
                val |= 0x04;
            *q++ = val;
792 793
            *q++ = flags;
            *q++ = header_len;
794
            if (pts != AV_NOPTS_VALUE) {
795 796 797
                write_pts(q, flags >> 6, pts);
                q += 5;
            }
798
            if (dts != AV_NOPTS_VALUE && pts != AV_NOPTS_VALUE && dts != pts) {
799 800
                write_pts(q, 1, dts);
                q += 5;
801
            }
802 803 804 805 806 807 808 809 810 811
            if (pes_extension && st->codec->codec_id == CODEC_ID_DIRAC) {
                flags = 0x01;  /* set PES_extension_flag_2 */
                *q++ = flags;
                *q++ = 0x80 | 0x01;  /* marker bit + extension length */
                /*
                * Set the stream id extension flag bit to 0 and
                * write the extended stream id
                */
                *q++ = 0x00 | 0x60;
            }
812 813
            if (private_code != 0)
                *q++ = private_code;
814
            is_start = 0;
815
        }
816 817 818 819
        /* header size */
        header_len = q - buf;
        /* data len */
        len = TS_PACKET_SIZE - header_len;
820 821
        if (len > payload_size)
            len = payload_size;
822 823 824 825 826 827 828
        stuffing_len = TS_PACKET_SIZE - header_len - len;
        if (stuffing_len > 0) {
            /* add stuffing with AFC */
            if (buf[3] & 0x20) {
                /* stuffing already present: increase its size */
                afc_len = buf[4] + 1;
                memmove(buf + 4 + afc_len + stuffing_len,
829
                        buf + 4 + afc_len,
830 831 832 833 834 835 836 837 838 839 840 841 842 843 844
                        header_len - (4 + afc_len));
                buf[4] += stuffing_len;
                memset(buf + 4 + afc_len, 0xff, stuffing_len);
            } else {
                /* add stuffing */
                memmove(buf + 4 + stuffing_len, buf + 4, header_len - 4);
                buf[3] |= 0x20;
                buf[4] = stuffing_len - 1;
                if (stuffing_len >= 2) {
                    buf[5] = 0x00;
                    memset(buf + 6, 0xff, stuffing_len - 2);
                }
            }
        }
        memcpy(buf + TS_PACKET_SIZE - len, payload, len);
845 846
        payload += len;
        payload_size -= len;
847
        put_buffer(s->pb, buf, TS_PACKET_SIZE);
848
    }
849
    put_flush_packet(s->pb);
850 851
}

852
static int mpegts_write_packet(AVFormatContext *s, AVPacket *pkt)
853
{
854
    AVStream *st = s->streams[pkt->stream_index];
855
    int size = pkt->size;
856
    uint8_t *buf= pkt->data;
857
    uint8_t *data= NULL;
858
    MpegTSWriteStream *ts_st = st->priv_data;
859
    const uint64_t delay = av_rescale(s->max_delay, 90000, AV_TIME_BASE)*2;
860 861 862 863 864 865
    int64_t dts = AV_NOPTS_VALUE, pts = AV_NOPTS_VALUE;

    if (pkt->pts != AV_NOPTS_VALUE)
        pts = pkt->pts + delay;
    if (pkt->dts != AV_NOPTS_VALUE)
        dts = pkt->dts + delay;
866

867 868 869 870 871 872
    if (ts_st->first_pts_check && pts == AV_NOPTS_VALUE) {
        av_log(s, AV_LOG_ERROR, "first pts value must set\n");
        return -1;
    }
    ts_st->first_pts_check = 0;

873
    if (st->codec->codec_id == CODEC_ID_H264) {
874 875 876
        const uint8_t *p = buf, *buf_end = p+size;
        uint32_t state = -1;

877
        if (pkt->size < 5 || AV_RB32(pkt->data) != 0x0000001) {
878 879
            av_log(s, AV_LOG_ERROR, "h264 bitstream malformated, "
                   "no startcode found, use -vbsf h264_mp4toannexb\n");
880 881
            return -1;
        }
882 883 884 885 886 887 888 889

        do {
            p = ff_find_start_code(p, buf_end, &state);
            //av_log(s, AV_LOG_INFO, "nal %d\n", state & 0x1f);
        } while (p < buf_end && (state & 0x1f) != 9 &&
                 (state & 0x1f) != 5 && (state & 0x1f) != 1);

        if ((state & 0x1f) != 9) { // AUD NAL
890 891 892 893 894 895
            data = av_malloc(pkt->size+6);
            if (!data)
                return -1;
            memcpy(data+6, pkt->data, pkt->size);
            AV_WB32(data, 0x00000001);
            data[4] = 0x09;
896
            data[5] = 0xf0; // any slice type (0xe) + rbsp stop one bit
897 898 899
            buf  = data;
            size = pkt->size+6;
        }
900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915
    } else if (st->codec->codec_id == CODEC_ID_AAC) {
        if (pkt->size < 2)
            return -1;
        if ((AV_RB16(pkt->data) & 0xfff0) != 0xfff0) {
            ADTSContext *adts = ts_st->adts;
            int new_size;
            if (!adts) {
                av_log(s, AV_LOG_ERROR, "aac bitstream not in adts format "
                       "and extradata missing\n");
                return -1;
            }
            new_size = ADTS_HEADER_SIZE+adts->pce_size+pkt->size;
            if ((unsigned)new_size >= INT_MAX)
                return -1;
            data = av_malloc(new_size);
            if (!data)
916
                return AVERROR(ENOMEM);
917 918 919 920 921 922 923 924 925
            ff_adts_write_frame_header(adts, data, pkt->size, adts->pce_size);
            if (adts->pce_size) {
                memcpy(data+ADTS_HEADER_SIZE, adts->pce_data, adts->pce_size);
                adts->pce_size = 0;
            }
            memcpy(data+ADTS_HEADER_SIZE+adts->pce_size, pkt->data, pkt->size);
            buf = data;
            size = new_size;
        }
926 927
    }

928
    if (st->codec->codec_type != AVMEDIA_TYPE_AUDIO) {
929 930
        // for video and subtitle, write a single pes packet
        mpegts_write_pes(s, st, buf, size, pts, dts);
931
        av_free(data);
932 933 934
        return 0;
    }

935 936 937 938
    if (ts_st->payload_index + size > DEFAULT_PES_PAYLOAD_SIZE) {
        mpegts_write_pes(s, st, ts_st->payload, ts_st->payload_index,
                         ts_st->payload_pts, ts_st->payload_dts);
        ts_st->payload_index = 0;
939 940
    }

941 942 943
    if (!ts_st->payload_index) {
        ts_st->payload_pts = pts;
        ts_st->payload_dts = dts;
944
    }
945

946 947 948
    memcpy(ts_st->payload + ts_st->payload_index, buf, size);
    ts_st->payload_index += size;

949 950
    av_free(data);

951 952 953 954 955 956 957 958 959 960 961 962 963 964 965
    return 0;
}

static int mpegts_write_end(AVFormatContext *s)
{
    MpegTSWrite *ts = s->priv_data;
    MpegTSWriteStream *ts_st;
    MpegTSService *service;
    AVStream *st;
    int i;

    /* flush current packets */
    for(i = 0; i < s->nb_streams; i++) {
        st = s->streams[i];
        ts_st = st->priv_data;
966 967
        if (ts_st->payload_index > 0) {
            mpegts_write_pes(s, st, ts_st->payload, ts_st->payload_index,
968
                             ts_st->payload_pts, ts_st->payload_dts);
969
        }
970
        av_freep(&ts_st->adts);
971
    }
972
    put_flush_packet(s->pb);
973

974 975 976 977 978 979 980 981 982 983 984
    for(i = 0; i < ts->nb_services; i++) {
        service = ts->services[i];
        av_freep(&service->provider_name);
        av_freep(&service->name);
        av_free(service);
    }
    av_free(ts->services);

    return 0;
}

985
AVOutputFormat ff_mpegts_muxer = {
986
    "mpegts",
987
    NULL_IF_CONFIG_SMALL("MPEG-2 transport stream format"),
988
    "video/x-mpegts",
989
    "ts,m2t",
990 991
    sizeof(MpegTSWrite),
    CODEC_ID_MP2,
992
    CODEC_ID_MPEG2VIDEO,
993 994 995
    mpegts_write_header,
    mpegts_write_packet,
    mpegts_write_end,
996
    .priv_class = &mpegts_muxer_class,
997
};