git.sesse.net Git - ffmpeg/blob - libavformat/mpegtsenc.c

   1 /*
   2  * MPEG2 transport stream (aka DVB) muxer
   3  * Copyright (c) 2003 Fabrice Bellard
   4  *
   5  * This file is part of FFmpeg.
   6  *
   7  * FFmpeg is free software; you can redistribute it and/or
   8  * modify it under the terms of the GNU Lesser General Public
   9  * 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  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  15  * Lesser General Public License for more details.
  16  *
  17  * 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/dict.h"
  25 #include "libavutil/intreadwrite.h"
  26 #include "libavutil/mathematics.h"
  27 #include "libavutil/opt.h"
  28 #include "libavutil/avassert.h"
  29 #include "libavcodec/internal.h"
  30 #include "avformat.h"
  31 #include "internal.h"
  32 #include "mpegts.h"
  33
  34 #define PCR_TIME_BASE 27000000
  35
  36 /* write DVB SI sections */
  37
  38 /*********************************************/
  39 /* mpegts section writer */
  40
  41 typedef struct MpegTSSection {
  42     int pid;
  43     int cc;
  44     void (*write_packet)(struct MpegTSSection *s, const uint8_t *packet);
  45     void *opaque;
  46 } MpegTSSection;
  47
  48 typedef struct MpegTSService {
  49     MpegTSSection pmt; /* MPEG2 pmt table context */
  50     int sid;           /* service ID */
  51     char *name;
  52     char *provider_name;
  53     int pcr_pid;
  54     int pcr_packet_count;
  55     int pcr_packet_period;
  56 } MpegTSService;
  57
  58 typedef struct MpegTSWrite {
  59     const AVClass *av_class;
  60     MpegTSSection pat; /* MPEG2 pat table */
  61     MpegTSSection sdt; /* MPEG2 sdt table context */
  62     MpegTSService **services;
  63     int sdt_packet_count;
  64     int sdt_packet_period;
  65     int pat_packet_count;
  66     int pat_packet_period;
  67     int nb_services;
  68     int onid;
  69     int tsid;
  70     int64_t first_pcr;
  71     int mux_rate; ///< set to 1 when VBR
  72     int pes_payload_size;
  73
  74     int transport_stream_id;
  75     int original_network_id;
  76     int service_id;
  77
  78     int pmt_start_pid;
  79     int start_pid;
  80     int m2ts_mode;
  81
  82     int reemit_pat_pmt; // backward compatibility
  83
  84 #define MPEGTS_FLAG_REEMIT_PAT_PMT  0x01
  85 #define MPEGTS_FLAG_AAC_LATM        0x02
  86     int flags;
  87     int copyts;
  88     int tables_version;
  89 } MpegTSWrite;
  90
  91 /* a PES packet header is generated every DEFAULT_PES_HEADER_FREQ packets */
  92 #define DEFAULT_PES_HEADER_FREQ 16
  93 #define DEFAULT_PES_PAYLOAD_SIZE ((DEFAULT_PES_HEADER_FREQ - 1) * 184 + 170)
  94
  95 static const AVOption options[] = {
  96     { "mpegts_transport_stream_id", "Set transport_stream_id field.",
  97       offsetof(MpegTSWrite, transport_stream_id), AV_OPT_TYPE_INT, {.i64 = 0x0001 }, 0x0001, 0xffff, AV_OPT_FLAG_ENCODING_PARAM},
  98     { "mpegts_original_network_id", "Set original_network_id field.",
  99       offsetof(MpegTSWrite, original_network_id), AV_OPT_TYPE_INT, {.i64 = 0x0001 }, 0x0001, 0xffff, AV_OPT_FLAG_ENCODING_PARAM},
 100     { "mpegts_service_id", "Set service_id field.",
 101       offsetof(MpegTSWrite, service_id), AV_OPT_TYPE_INT, {.i64 = 0x0001 }, 0x0001, 0xffff, AV_OPT_FLAG_ENCODING_PARAM},
 102     { "mpegts_pmt_start_pid", "Set the first pid of the PMT.",
 103       offsetof(MpegTSWrite, pmt_start_pid), AV_OPT_TYPE_INT, {.i64 = 0x1000 }, 0x0010, 0x1f00, AV_OPT_FLAG_ENCODING_PARAM},
 104     { "mpegts_start_pid", "Set the first pid.",
 105       offsetof(MpegTSWrite, start_pid), AV_OPT_TYPE_INT, {.i64 = 0x0100 }, 0x0100, 0x0f00, AV_OPT_FLAG_ENCODING_PARAM},
 106     {"mpegts_m2ts_mode", "Enable m2ts mode.",
 107         offsetof(MpegTSWrite, m2ts_mode), AV_OPT_TYPE_INT, {.i64 = -1 },
 108         -1,1, AV_OPT_FLAG_ENCODING_PARAM},
 109     { "muxrate", NULL, offsetof(MpegTSWrite, mux_rate), AV_OPT_TYPE_INT, {.i64 = 1}, 0, INT_MAX, AV_OPT_FLAG_ENCODING_PARAM},
 110     { "pes_payload_size", "Minimum PES packet payload in bytes",
 111       offsetof(MpegTSWrite, pes_payload_size), AV_OPT_TYPE_INT, {.i64 = DEFAULT_PES_PAYLOAD_SIZE}, 0, INT_MAX, AV_OPT_FLAG_ENCODING_PARAM},
 112     { "mpegts_flags", "MPEG-TS muxing flags", offsetof(MpegTSWrite, flags), AV_OPT_TYPE_FLAGS, {.i64 = 0}, 0, INT_MAX,
 113       AV_OPT_FLAG_ENCODING_PARAM, "mpegts_flags" },
 114     { "resend_headers", "Reemit PAT/PMT before writing the next packet",
 115       0, AV_OPT_TYPE_CONST, {.i64 = MPEGTS_FLAG_REEMIT_PAT_PMT}, 0, INT_MAX,
 116       AV_OPT_FLAG_ENCODING_PARAM, "mpegts_flags"},
 117     { "latm", "Use LATM packetization for AAC",
 118       0, AV_OPT_TYPE_CONST, {.i64 = MPEGTS_FLAG_AAC_LATM}, 0, INT_MAX,
 119       AV_OPT_FLAG_ENCODING_PARAM, "mpegts_flags"},
 120     // backward compatibility
 121     { "resend_headers", "Reemit PAT/PMT before writing the next packet",
 122       offsetof(MpegTSWrite, reemit_pat_pmt), AV_OPT_TYPE_INT, {.i64 = 0}, 0, INT_MAX, AV_OPT_FLAG_ENCODING_PARAM},
 123     { "mpegts_copyts", "don't offset dts/pts",
 124       offsetof(MpegTSWrite, copyts), AV_OPT_TYPE_INT, {.i64=-1}, -1, 1, AV_OPT_FLAG_ENCODING_PARAM},
 125     { "tables_version", "set PAT, PMT and SDT version",
 126       offsetof(MpegTSWrite, tables_version), AV_OPT_TYPE_INT, {.i64=0}, 0, 31, AV_OPT_FLAG_ENCODING_PARAM},
 127     { NULL },
 128 };
 129
 130 static const AVClass mpegts_muxer_class = {
 131     .class_name     = "MPEGTS muxer",
 132     .item_name      = av_default_item_name,
 133     .option         = options,
 134     .version        = LIBAVUTIL_VERSION_INT,
 135 };
 136
 137 /* NOTE: 4 bytes must be left at the end for the crc32 */
 138 static void mpegts_write_section(MpegTSSection *s, uint8_t *buf, int len)
 139 {
 140     unsigned int crc;
 141     unsigned char packet[TS_PACKET_SIZE];
 142     const unsigned char *buf_ptr;
 143     unsigned char *q;
 144     int first, b, len1, left;
 145
 146     crc = av_bswap32(av_crc(av_crc_get_table(AV_CRC_32_IEEE), -1, buf, len - 4));
 147     buf[len - 4] = (crc >> 24) & 0xff;
 148     buf[len - 3] = (crc >> 16) & 0xff;
 149     buf[len - 2] = (crc >> 8) & 0xff;
 150     buf[len - 1] = (crc) & 0xff;
 151
 152     /* send each packet */
 153     buf_ptr = buf;
 154     while (len > 0) {
 155         first = (buf == buf_ptr);
 156         q = packet;
 157         *q++ = 0x47;
 158         b = (s->pid >> 8);
 159         if (first)
 160             b |= 0x40;
 161         *q++ = b;
 162         *q++ = s->pid;
 163         s->cc = (s->cc + 1) & 0xf;
 164         *q++ = 0x10 | s->cc;
 165         if (first)
 166             *q++ = 0; /* 0 offset */
 167         len1 = TS_PACKET_SIZE - (q - packet);
 168         if (len1 > len)
 169             len1 = len;
 170         memcpy(q, buf_ptr, len1);
 171         q += len1;
 172         /* add known padding data */
 173         left = TS_PACKET_SIZE - (q - packet);
 174         if (left > 0)
 175             memset(q, 0xff, left);
 176
 177         s->write_packet(s, packet);
 178
 179         buf_ptr += len1;
 180         len -= len1;
 181     }
 182 }
 183
 184 static inline void put16(uint8_t **q_ptr, int val)
 185 {
 186     uint8_t *q;
 187     q = *q_ptr;
 188     *q++ = val >> 8;
 189     *q++ = val;
 190     *q_ptr = q;
 191 }
 192
 193 static int mpegts_write_section1(MpegTSSection *s, int tid, int id,
 194                           int version, int sec_num, int last_sec_num,
 195                           uint8_t *buf, int len)
 196 {
 197     uint8_t section[1024], *q;
 198     unsigned int tot_len;
 199     /* reserved_future_use field must be set to 1 for SDT */
 200     unsigned int flags = tid == SDT_TID ? 0xf000 : 0xb000;
 201
 202     tot_len = 3 + 5 + len + 4;
 203     /* check if not too big */
 204     if (tot_len > 1024)
 205         return AVERROR_INVALIDDATA;
 206
 207     q = section;
 208     *q++ = tid;
 209     put16(&q, flags | (len + 5 + 4)); /* 5 byte header + 4 byte CRC */
 210     put16(&q, id);
 211     *q++ = 0xc1 | (version << 1); /* current_next_indicator = 1 */
 212     *q++ = sec_num;
 213     *q++ = last_sec_num;
 214     memcpy(q, buf, len);
 215
 216     mpegts_write_section(s, section, tot_len);
 217     return 0;
 218 }
 219
 220 /*********************************************/
 221 /* mpegts writer */
 222
 223 #define DEFAULT_PROVIDER_NAME   "FFmpeg"
 224 #define DEFAULT_SERVICE_NAME    "Service01"
 225
 226 /* we retransmit the SI info at this rate */
 227 #define SDT_RETRANS_TIME 500
 228 #define PAT_RETRANS_TIME 100
 229 #define PCR_RETRANS_TIME 20
 230
 231 typedef struct MpegTSWriteStream {
 232     struct MpegTSService *service;
 233     int pid; /* stream associated pid */
 234     int cc;
 235     int payload_size;
 236     int first_pts_check; ///< first pts check needed
 237     int prev_payload_key;
 238     int64_t payload_pts;
 239     int64_t payload_dts;
 240     int payload_flags;
 241     uint8_t *payload;
 242     AVFormatContext *amux;
 243 } MpegTSWriteStream;
 244
 245 static void mpegts_write_pat(AVFormatContext *s)
 246 {
 247     MpegTSWrite *ts = s->priv_data;
 248     MpegTSService *service;
 249     uint8_t data[1012], *q;
 250     int i;
 251
 252     q = data;
 253     for(i = 0; i < ts->nb_services; i++) {
 254         service = ts->services[i];
 255         put16(&q, service->sid);
 256         put16(&q, 0xe000 | service->pmt.pid);
 257     }
 258     mpegts_write_section1(&ts->pat, PAT_TID, ts->tsid, ts->tables_version, 0, 0,
 259                           data, q - data);
 260 }
 261
 262 static int mpegts_write_pmt(AVFormatContext *s, MpegTSService *service)
 263 {
 264     MpegTSWrite *ts = s->priv_data;
 265     uint8_t data[1012], *q, *desc_length_ptr, *program_info_length_ptr;
 266     int val, stream_type, i;
 267
 268     q = data;
 269     put16(&q, 0xe000 | service->pcr_pid);
 270
 271     program_info_length_ptr = q;
 272     q += 2; /* patched after */
 273
 274     /* put program info here */
 275
 276     val = 0xf000 | (q - program_info_length_ptr - 2);
 277     program_info_length_ptr[0] = val >> 8;
 278     program_info_length_ptr[1] = val;
 279
 280     for(i = 0; i < s->nb_streams; i++) {
 281         AVStream *st = s->streams[i];
 282         MpegTSWriteStream *ts_st = st->priv_data;
 283         AVDictionaryEntry *lang = av_dict_get(st->metadata, "language", NULL,0);
 284         switch(st->codec->codec_id) {
 285         case AV_CODEC_ID_MPEG1VIDEO:
 286         case AV_CODEC_ID_MPEG2VIDEO:
 287             stream_type = STREAM_TYPE_VIDEO_MPEG2;
 288             break;
 289         case AV_CODEC_ID_MPEG4:
 290             stream_type = STREAM_TYPE_VIDEO_MPEG4;
 291             break;
 292         case AV_CODEC_ID_H264:
 293             stream_type = STREAM_TYPE_VIDEO_H264;
 294             break;
 295         case AV_CODEC_ID_HEVC:
 296             stream_type = STREAM_TYPE_VIDEO_HEVC;
 297             break;
 298         case AV_CODEC_ID_CAVS:
 299             stream_type = STREAM_TYPE_VIDEO_CAVS;
 300             break;
 301         case AV_CODEC_ID_DIRAC:
 302             stream_type = STREAM_TYPE_VIDEO_DIRAC;
 303             break;
 304         case AV_CODEC_ID_MP2:
 305         case AV_CODEC_ID_MP3:
 306             stream_type = STREAM_TYPE_AUDIO_MPEG1;
 307             break;
 308         case AV_CODEC_ID_AAC:
 309             stream_type = (ts->flags & MPEGTS_FLAG_AAC_LATM) ? STREAM_TYPE_AUDIO_AAC_LATM : STREAM_TYPE_AUDIO_AAC;
 310             break;
 311         case AV_CODEC_ID_AAC_LATM:
 312             stream_type = STREAM_TYPE_AUDIO_AAC_LATM;
 313             break;
 314         case AV_CODEC_ID_AC3:
 315             stream_type = STREAM_TYPE_AUDIO_AC3;
 316             break;
 317         default:
 318             stream_type = STREAM_TYPE_PRIVATE_DATA;
 319             break;
 320         }
 321
 322         if (q - data > sizeof(data) - 32)
 323             return AVERROR(EINVAL);
 324
 325         *q++ = stream_type;
 326         put16(&q, 0xe000 | ts_st->pid);
 327         desc_length_ptr = q;
 328         q += 2; /* patched after */
 329
 330         /* write optional descriptors here */
 331         switch(st->codec->codec_type) {
 332         case AVMEDIA_TYPE_AUDIO:
 333             if(st->codec->codec_id==AV_CODEC_ID_EAC3){
 334                 *q++=0x7a; // EAC3 descriptor see A038 DVB SI
 335                 *q++=1; // 1 byte, all flags sets to 0
 336                 *q++=0; // omit all fields...
 337             }
 338             if(st->codec->codec_id==AV_CODEC_ID_S302M){
 339                 *q++ = 0x05; /* MPEG-2 registration descriptor*/
 340                 *q++ = 4;
 341                 *q++ = 'B';
 342                 *q++ = 'S';
 343                 *q++ = 'S';
 344                 *q++ = 'D';
 345             }
 346
 347             if (lang) {
 348                 char *p;
 349                 char *next = lang->value;
 350                 uint8_t *len_ptr;
 351
 352                 *q++ = 0x0a; /* ISO 639 language descriptor */
 353                 len_ptr = q++;
 354                 *len_ptr = 0;
 355
 356                 for (p = lang->value; next && *len_ptr < 255 / 4 * 4 && q - data < sizeof(data) - 4; p = next + 1) {
 357                     next = strchr(p, ',');
 358                     if (strlen(p) != 3 && (!next || next != p + 3))
 359                         continue; /* not a 3-letter code */
 360
 361                     *q++ = *p++;
 362                     *q++ = *p++;
 363                     *q++ = *p++;
 364
 365                 if (st->disposition & AV_DISPOSITION_CLEAN_EFFECTS)
 366                     *q++ = 0x01;
 367                 else if (st->disposition & AV_DISPOSITION_HEARING_IMPAIRED)
 368                     *q++ = 0x02;
 369                 else if (st->disposition & AV_DISPOSITION_VISUAL_IMPAIRED)
 370                     *q++ = 0x03;
 371                 else
 372                     *q++ = 0; /* undefined type */
 373
 374                     *len_ptr += 4;
 375                 }
 376
 377                 if (*len_ptr == 0)
 378                     q -= 2; /* no language codes were written */
 379             }
 380             break;
 381         case AVMEDIA_TYPE_SUBTITLE:
 382             {
 383                 const char default_language[] = "und";
 384                 const char *language = lang && strlen(lang->value) >= 3 ? lang->value : default_language;
 385
 386                 if (st->codec->codec_id == AV_CODEC_ID_DVB_SUBTITLE) {
 387                     uint8_t *len_ptr;
 388                     int extradata_copied = 0;
 389
 390                     *q++ = 0x59; /* subtitling_descriptor */
 391                     len_ptr = q++;
 392
 393                     while (strlen(language) >= 3 && (sizeof(data) - (q - data)) >= 8) { /* 8 bytes per DVB subtitle substream data */
 394                         *q++ = *language++;
 395                         *q++ = *language++;
 396                         *q++ = *language++;
 397                         /* Skip comma */
 398                         if (*language != '\0')
 399                             language++;
 400
 401                         if (st->codec->extradata_size - extradata_copied >= 5) {
 402                             *q++ = st->codec->extradata[extradata_copied + 4]; /* subtitling_type */
 403                             memcpy(q, st->codec->extradata + extradata_copied, 4); /* composition_page_id and ancillary_page_id */
 404                             extradata_copied += 5;
 405                             q += 4;
 406                         } else {
 407                             /* subtitling_type:
 408                              * 0x10 - normal with no monitor aspect ratio criticality
 409                              * 0x20 - for the hard of hearing with no monitor aspect ratio criticality */
 410                             *q++ = (st->disposition & AV_DISPOSITION_HEARING_IMPAIRED) ? 0x20 : 0x10;
 411                             if ((st->codec->extradata_size == 4) && (extradata_copied == 0)) {
 412                                 /* support of old 4-byte extradata format */
 413                                 memcpy(q, st->codec->extradata, 4); /* composition_page_id and ancillary_page_id */
 414                                 extradata_copied += 4;
 415                                 q += 4;
 416                             } else {
 417                                 put16(&q, 1); /* composition_page_id */
 418                                 put16(&q, 1); /* ancillary_page_id */
 419                             }
 420                         }
 421                     }
 422
 423                     *len_ptr = q - len_ptr - 1;
 424                 } else if (st->codec->codec_id == AV_CODEC_ID_DVB_TELETEXT) {
 425                     uint8_t *len_ptr = NULL;
 426                     int extradata_copied = 0;
 427
 428                     /* The descriptor tag. teletext_descriptor */
 429                     *q++ = 0x56;
 430                     len_ptr = q++;
 431
 432                     while (strlen(language) >= 3 && q - data < sizeof(data) - 6) {
 433                         *q++ = *language++;
 434                         *q++ = *language++;
 435                         *q++ = *language++;
 436                         /* Skip comma */
 437                         if (*language != '\0')
 438                             language++;
 439
 440                         if (st->codec->extradata_size - 1 > extradata_copied) {
 441                             memcpy(q, st->codec->extradata + extradata_copied, 2);
 442                             extradata_copied += 2;
 443                             q += 2;
 444                         } else {
 445                             /* The Teletext descriptor:
 446                              * teletext_type: This 5-bit field indicates the type of Teletext page indicated. (0x01 Initial Teletext page)
 447                              * teletext_magazine_number: This is a 3-bit field which identifies the magazine number.
 448                              * teletext_page_number: This is an 8-bit field giving two 4-bit hex digits identifying the page number. */
 449                             *q++ = 0x08;
 450                             *q++ = 0x00;
 451                         }
 452                     }
 453
 454                     *len_ptr = q - len_ptr - 1;
 455                  }
 456             }
 457             break;
 458         case AVMEDIA_TYPE_VIDEO:
 459             if (stream_type == STREAM_TYPE_VIDEO_DIRAC) {
 460                 *q++ = 0x05; /*MPEG-2 registration descriptor*/
 461                 *q++ = 4;
 462                 *q++ = 'd';
 463                 *q++ = 'r';
 464                 *q++ = 'a';
 465                 *q++ = 'c';
 466             }
 467             break;
 468         case AVMEDIA_TYPE_DATA:
 469             if (st->codec->codec_id == AV_CODEC_ID_SMPTE_KLV) {
 470                 *q++ = 0x05; /* MPEG-2 registration descriptor */
 471                 *q++ = 4;
 472                 *q++ = 'K';
 473                 *q++ = 'L';
 474                 *q++ = 'V';
 475                 *q++ = 'A';
 476             }
 477             break;
 478         }
 479
 480         val = 0xf000 | (q - desc_length_ptr - 2);
 481         desc_length_ptr[0] = val >> 8;
 482         desc_length_ptr[1] = val;
 483     }
 484     mpegts_write_section1(&service->pmt, PMT_TID, service->sid, ts->tables_version, 0, 0,
 485                           data, q - data);
 486     return 0;
 487 }
 488
 489 /* NOTE: str == NULL is accepted for an empty string */
 490 static void putstr8(uint8_t **q_ptr, const char *str)
 491 {
 492     uint8_t *q;
 493     int len;
 494
 495     q = *q_ptr;
 496     if (!str)
 497         len = 0;
 498     else
 499         len = strlen(str);
 500     *q++ = len;
 501     memcpy(q, str, len);
 502     q += len;
 503     *q_ptr = q;
 504 }
 505
 506 static void mpegts_write_sdt(AVFormatContext *s)
 507 {
 508     MpegTSWrite *ts = s->priv_data;
 509     MpegTSService *service;
 510     uint8_t data[1012], *q, *desc_list_len_ptr, *desc_len_ptr;
 511     int i, running_status, free_ca_mode, val;
 512
 513     q = data;
 514     put16(&q, ts->onid);
 515     *q++ = 0xff;
 516     for(i = 0; i < ts->nb_services; i++) {
 517         service = ts->services[i];
 518         put16(&q, service->sid);
 519         *q++ = 0xfc | 0x00; /* currently no EIT info */
 520         desc_list_len_ptr = q;
 521         q += 2;
 522         running_status = 4; /* running */
 523         free_ca_mode = 0;
 524
 525         /* write only one descriptor for the service name and provider */
 526         *q++ = 0x48;
 527         desc_len_ptr = q;
 528         q++;
 529         *q++ = 0x01; /* digital television service */
 530         putstr8(&q, service->provider_name);
 531         putstr8(&q, service->name);
 532         desc_len_ptr[0] = q - desc_len_ptr - 1;
 533
 534         /* fill descriptor length */
 535         val = (running_status << 13) | (free_ca_mode << 12) |
 536             (q - desc_list_len_ptr - 2);
 537         desc_list_len_ptr[0] = val >> 8;
 538         desc_list_len_ptr[1] = val;
 539     }
 540     mpegts_write_section1(&ts->sdt, SDT_TID, ts->tsid, ts->tables_version, 0, 0,
 541                           data, q - data);
 542 }
 543
 544 static MpegTSService *mpegts_add_service(MpegTSWrite *ts,
 545                                          int sid,
 546                                          const char *provider_name,
 547                                          const char *name)
 548 {
 549     MpegTSService *service;
 550
 551     service = av_mallocz(sizeof(MpegTSService));
 552     if (!service)
 553         return NULL;
 554     service->pmt.pid = ts->pmt_start_pid + ts->nb_services;
 555     service->sid = sid;
 556     service->provider_name = av_strdup(provider_name);
 557     service->name = av_strdup(name);
 558     service->pcr_pid = 0x1fff;
 559     dynarray_add(&ts->services, &ts->nb_services, service);
 560     return service;
 561 }
 562
 563 static int64_t get_pcr(const MpegTSWrite *ts, AVIOContext *pb)
 564 {
 565     return av_rescale(avio_tell(pb) + 11, 8 * PCR_TIME_BASE, ts->mux_rate) +
 566            ts->first_pcr;
 567 }
 568
 569 static void mpegts_prefix_m2ts_header(AVFormatContext *s)
 570 {
 571     MpegTSWrite *ts = s->priv_data;
 572     if (ts->m2ts_mode) {
 573         int64_t pcr = get_pcr(s->priv_data, s->pb);
 574         uint32_t tp_extra_header = pcr % 0x3fffffff;
 575         tp_extra_header = AV_RB32(&tp_extra_header);
 576         avio_write(s->pb, (unsigned char *) &tp_extra_header,
 577                 sizeof(tp_extra_header));
 578     }
 579 }
 580
 581 static void section_write_packet(MpegTSSection *s, const uint8_t *packet)
 582 {
 583     AVFormatContext *ctx = s->opaque;
 584     mpegts_prefix_m2ts_header(ctx);
 585     avio_write(ctx->pb, packet, TS_PACKET_SIZE);
 586 }
 587
 588 static int mpegts_write_header(AVFormatContext *s)
 589 {
 590     MpegTSWrite *ts = s->priv_data;
 591     MpegTSWriteStream *ts_st;
 592     MpegTSService *service;
 593     AVStream *st, *pcr_st = NULL;
 594     AVDictionaryEntry *title, *provider;
 595     int i, j;
 596     const char *service_name;
 597     const char *provider_name;
 598     int *pids;
 599     int ret;
 600
 601     if (s->max_delay < 0) /* Not set by the caller */
 602         s->max_delay = 0;
 603
 604     // round up to a whole number of TS packets
 605     ts->pes_payload_size = (ts->pes_payload_size + 14 + 183) / 184 * 184 - 14;
 606
 607     ts->tsid = ts->transport_stream_id;
 608     ts->onid = ts->original_network_id;
 609     /* allocate a single DVB service */
 610     title = av_dict_get(s->metadata, "service_name", NULL, 0);
 611     if (!title)
 612         title = av_dict_get(s->metadata, "title", NULL, 0);
 613     service_name = title ? title->value : DEFAULT_SERVICE_NAME;
 614     provider = av_dict_get(s->metadata, "service_provider", NULL, 0);
 615     provider_name = provider ? provider->value : DEFAULT_PROVIDER_NAME;
 616     service = mpegts_add_service(ts, ts->service_id, provider_name, service_name);
 617     service->pmt.write_packet = section_write_packet;
 618     service->pmt.opaque = s;
 619     service->pmt.cc = 15;
 620
 621     ts->pat.pid = PAT_PID;
 622     ts->pat.cc = 15; // Initialize at 15 so that it wraps and be equal to 0 for the first packet we write
 623     ts->pat.write_packet = section_write_packet;
 624     ts->pat.opaque = s;
 625
 626     ts->sdt.pid = SDT_PID;
 627     ts->sdt.cc = 15;
 628     ts->sdt.write_packet = section_write_packet;
 629     ts->sdt.opaque = s;
 630
 631     pids = av_malloc_array(s->nb_streams, sizeof(*pids));
 632     if (!pids)
 633         return AVERROR(ENOMEM);
 634
 635     /* assign pids to each stream */
 636     for(i = 0;i < s->nb_streams; i++) {
 637         st = s->streams[i];
 638         avpriv_set_pts_info(st, 33, 1, 90000);
 639         ts_st = av_mallocz(sizeof(MpegTSWriteStream));
 640         if (!ts_st) {
 641             ret = AVERROR(ENOMEM);
 642             goto fail;
 643         }
 644         st->priv_data = ts_st;
 645         ts_st->payload = av_mallocz(ts->pes_payload_size);
 646         if (!ts_st->payload) {
 647             ret = AVERROR(ENOMEM);
 648             goto fail;
 649         }
 650         ts_st->service = service;
 651         /* MPEG pid values < 16 are reserved. Applications which set st->id in
 652          * this range are assigned a calculated pid. */
 653         if (st->id < 16) {
 654             ts_st->pid = ts->start_pid + i;
 655         } else if (st->id < 0x1FFF) {
 656             ts_st->pid = st->id;
 657         } else {
 658             av_log(s, AV_LOG_ERROR, "Invalid stream id %d, must be less than 8191\n", st->id);
 659             ret = AVERROR(EINVAL);
 660             goto fail;
 661         }
 662         if (ts_st->pid == service->pmt.pid) {
 663             av_log(s, AV_LOG_ERROR, "Duplicate stream id %d\n", ts_st->pid);
 664             ret = AVERROR(EINVAL);
 665             goto fail;
 666         }
 667         for (j = 0; j < i; j++)
 668             if (pids[j] == ts_st->pid) {
 669                 av_log(s, AV_LOG_ERROR, "Duplicate stream id %d\n", ts_st->pid);
 670                 ret = AVERROR(EINVAL);
 671                 goto fail;
 672             }
 673         pids[i] = ts_st->pid;
 674         ts_st->payload_pts = AV_NOPTS_VALUE;
 675         ts_st->payload_dts = AV_NOPTS_VALUE;
 676         ts_st->first_pts_check = 1;
 677         ts_st->cc = 15;
 678         /* update PCR pid by using the first video stream */
 679         if (st->codec->codec_type == AVMEDIA_TYPE_VIDEO &&
 680             service->pcr_pid == 0x1fff) {
 681             service->pcr_pid = ts_st->pid;
 682             pcr_st = st;
 683         }
 684         if (st->codec->codec_id == AV_CODEC_ID_AAC &&
 685             st->codec->extradata_size > 0)
 686         {
 687             AVStream *ast;
 688             ts_st->amux = avformat_alloc_context();
 689             if (!ts_st->amux) {
 690                 ret = AVERROR(ENOMEM);
 691                 goto fail;
 692             }
 693             ts_st->amux->oformat = av_guess_format((ts->flags & MPEGTS_FLAG_AAC_LATM) ? "latm" : "adts", NULL, NULL);
 694             if (!ts_st->amux->oformat) {
 695                 ret = AVERROR(EINVAL);
 696                 goto fail;
 697             }
 698             ast = avformat_new_stream(ts_st->amux, NULL);
 699             ret = avcodec_copy_context(ast->codec, st->codec);
 700             if (ret != 0)
 701                 goto fail;
 702             ret = avformat_write_header(ts_st->amux, NULL);
 703             if (ret < 0)
 704                 goto fail;
 705         }
 706     }
 707
 708     av_free(pids);
 709
 710     /* if no video stream, use the first stream as PCR */
 711     if (service->pcr_pid == 0x1fff && s->nb_streams > 0) {
 712         pcr_st = s->streams[0];
 713         ts_st = pcr_st->priv_data;
 714         service->pcr_pid = ts_st->pid;
 715     }
 716
 717     if (ts->mux_rate > 1) {
 718         service->pcr_packet_period = (ts->mux_rate * PCR_RETRANS_TIME) /
 719             (TS_PACKET_SIZE * 8 * 1000);
 720         ts->sdt_packet_period      = (ts->mux_rate * SDT_RETRANS_TIME) /
 721             (TS_PACKET_SIZE * 8 * 1000);
 722         ts->pat_packet_period      = (ts->mux_rate * PAT_RETRANS_TIME) /
 723             (TS_PACKET_SIZE * 8 * 1000);
 724
 725         if(ts->copyts < 1)
 726             ts->first_pcr = av_rescale(s->max_delay, PCR_TIME_BASE, AV_TIME_BASE);
 727     } else {
 728         /* Arbitrary values, PAT/PMT will also be written on video key frames */
 729         ts->sdt_packet_period = 200;
 730         ts->pat_packet_period = 40;
 731         if (pcr_st->codec->codec_type == AVMEDIA_TYPE_AUDIO) {
 732             if (!pcr_st->codec->frame_size) {
 733                 av_log(s, AV_LOG_WARNING, "frame size not set\n");
 734                 service->pcr_packet_period =
 735                     pcr_st->codec->sample_rate/(10*512);
 736             } else {
 737                 service->pcr_packet_period =
 738                     pcr_st->codec->sample_rate/(10*pcr_st->codec->frame_size);
 739             }
 740         } else {
 741             // max delta PCR 0.1s
 742             service->pcr_packet_period =
 743                 pcr_st->codec->time_base.den/(10*pcr_st->codec->time_base.num);
 744         }
 745         if(!service->pcr_packet_period)
 746             service->pcr_packet_period = 1;
 747     }
 748
 749     // output a PCR as soon as possible
 750     service->pcr_packet_count = service->pcr_packet_period;
 751     ts->pat_packet_count = ts->pat_packet_period-1;
 752     ts->sdt_packet_count = ts->sdt_packet_period-1;
 753
 754     if (ts->mux_rate == 1)
 755         av_log(s, AV_LOG_VERBOSE, "muxrate VBR, ");
 756     else
 757         av_log(s, AV_LOG_VERBOSE, "muxrate %d, ", ts->mux_rate);
 758     av_log(s, AV_LOG_VERBOSE, "pcr every %d pkts, "
 759            "sdt every %d, pat/pmt every %d pkts\n",
 760            service->pcr_packet_period,
 761            ts->sdt_packet_period, ts->pat_packet_period);
 762
 763     if (ts->m2ts_mode == -1) {
 764         if (av_match_ext(s->filename, "m2ts")) {
 765             ts->m2ts_mode = 1;
 766         } else {
 767             ts->m2ts_mode = 0;
 768         }
 769     }
 770
 771     avio_flush(s->pb);
 772
 773     return 0;
 774
 775  fail:
 776     av_free(pids);
 777     for(i = 0;i < s->nb_streams; i++) {
 778         MpegTSWriteStream *ts_st;
 779         st = s->streams[i];
 780         ts_st = st->priv_data;
 781         if (ts_st) {
 782             av_freep(&ts_st->payload);
 783             if (ts_st->amux) {
 784                 avformat_free_context(ts_st->amux);
 785                 ts_st->amux = NULL;
 786             }
 787         }
 788         av_freep(&st->priv_data);
 789     }
 790     return ret;
 791 }
 792
 793 /* send SDT, PAT and PMT tables regulary */
 794 static void retransmit_si_info(AVFormatContext *s, int force_pat)
 795 {
 796     MpegTSWrite *ts = s->priv_data;
 797     int i;
 798
 799     if (++ts->sdt_packet_count == ts->sdt_packet_period) {
 800         ts->sdt_packet_count = 0;
 801         mpegts_write_sdt(s);
 802     }
 803     if (++ts->pat_packet_count == ts->pat_packet_period || force_pat) {
 804         ts->pat_packet_count = 0;
 805         mpegts_write_pat(s);
 806         for(i = 0; i < ts->nb_services; i++) {
 807             mpegts_write_pmt(s, ts->services[i]);
 808         }
 809     }
 810 }
 811
 812 static int write_pcr_bits(uint8_t *buf, int64_t pcr)
 813 {
 814     int64_t pcr_low = pcr % 300, pcr_high = pcr / 300;
 815
 816     *buf++ = pcr_high >> 25;
 817     *buf++ = pcr_high >> 17;
 818     *buf++ = pcr_high >> 9;
 819     *buf++ = pcr_high >> 1;
 820     *buf++ = pcr_high << 7 | pcr_low >> 8 | 0x7e;
 821     *buf++ = pcr_low;
 822
 823     return 6;
 824 }
 825
 826 /* Write a single null transport stream packet */
 827 static void mpegts_insert_null_packet(AVFormatContext *s)
 828 {
 829     uint8_t *q;
 830     uint8_t buf[TS_PACKET_SIZE];
 831
 832     q = buf;
 833     *q++ = 0x47;
 834     *q++ = 0x00 | 0x1f;
 835     *q++ = 0xff;
 836     *q++ = 0x10;
 837     memset(q, 0x0FF, TS_PACKET_SIZE - (q - buf));
 838     mpegts_prefix_m2ts_header(s);
 839     avio_write(s->pb, buf, TS_PACKET_SIZE);
 840 }
 841
 842 /* Write a single transport stream packet with a PCR and no payload */
 843 static void mpegts_insert_pcr_only(AVFormatContext *s, AVStream *st)
 844 {
 845     MpegTSWrite *ts = s->priv_data;
 846     MpegTSWriteStream *ts_st = st->priv_data;
 847     uint8_t *q;
 848     uint8_t buf[TS_PACKET_SIZE];
 849
 850     q = buf;
 851     *q++ = 0x47;
 852     *q++ = ts_st->pid >> 8;
 853     *q++ = ts_st->pid;
 854     *q++ = 0x20 | ts_st->cc;   /* Adaptation only */
 855     /* Continuity Count field does not increment (see 13818-1 section 2.4.3.3) */
 856     *q++ = TS_PACKET_SIZE - 5; /* Adaptation Field Length */
 857     *q++ = 0x10;               /* Adaptation flags: PCR present */
 858
 859     /* PCR coded into 6 bytes */
 860     q += write_pcr_bits(q, get_pcr(ts, s->pb));
 861
 862     /* stuffing bytes */
 863     memset(q, 0xFF, TS_PACKET_SIZE - (q - buf));
 864     mpegts_prefix_m2ts_header(s);
 865     avio_write(s->pb, buf, TS_PACKET_SIZE);
 866 }
 867
 868 static void write_pts(uint8_t *q, int fourbits, int64_t pts)
 869 {
 870     int val;
 871
 872     val = fourbits << 4 | (((pts >> 30) & 0x07) << 1) | 1;
 873     *q++ = val;
 874     val = (((pts >> 15) & 0x7fff) << 1) | 1;
 875     *q++ = val >> 8;
 876     *q++ = val;
 877     val = (((pts) & 0x7fff) << 1) | 1;
 878     *q++ = val >> 8;
 879     *q++ = val;
 880 }
 881
 882 /* Set an adaptation field flag in an MPEG-TS packet*/
 883 static void set_af_flag(uint8_t *pkt, int flag)
 884 {
 885     // expect at least one flag to set
 886     av_assert0(flag);
 887
 888     if ((pkt[3] & 0x20) == 0) {
 889         // no AF yet, set adaptation field flag
 890         pkt[3] |= 0x20;
 891         // 1 byte length, no flags
 892         pkt[4] = 1;
 893         pkt[5] = 0;
 894     }
 895     pkt[5] |= flag;
 896 }
 897
 898 /* Extend the adaptation field by size bytes */
 899 static void extend_af(uint8_t *pkt, int size)
 900 {
 901     // expect already existing adaptation field
 902     av_assert0(pkt[3] & 0x20);
 903     pkt[4] += size;
 904 }
 905
 906 /* Get a pointer to MPEG-TS payload (right after TS packet header) */
 907 static uint8_t *get_ts_payload_start(uint8_t *pkt)
 908 {
 909     if (pkt[3] & 0x20)
 910         return pkt + 5 + pkt[4];
 911     else
 912         return pkt + 4;
 913 }
 914
 915 /* Add a pes header to the front of payload, and segment into an integer number of
 916  * ts packets. The final ts packet is padded using an over-sized adaptation header
 917  * to exactly fill the last ts packet.
 918  * NOTE: 'payload' contains a complete PES payload.
 919  */
 920 static void mpegts_write_pes(AVFormatContext *s, AVStream *st,
 921                              const uint8_t *payload, int payload_size,
 922                              int64_t pts, int64_t dts, int key)
 923 {
 924     MpegTSWriteStream *ts_st = st->priv_data;
 925     MpegTSWrite *ts = s->priv_data;
 926     uint8_t buf[TS_PACKET_SIZE];
 927     uint8_t *q;
 928     int val, is_start, len, header_len, write_pcr, is_dvb_subtitle, is_dvb_teletext, flags;
 929     int afc_len, stuffing_len;
 930     int64_t pcr = -1; /* avoid warning */
 931     int64_t delay = av_rescale(s->max_delay, 90000, AV_TIME_BASE);
 932     int force_pat = st->codec->codec_type == AVMEDIA_TYPE_VIDEO && key && !ts_st->prev_payload_key;
 933
 934     is_start = 1;
 935     while (payload_size > 0) {
 936         retransmit_si_info(s, force_pat);
 937         force_pat = 0;
 938
 939         write_pcr = 0;
 940         if (ts_st->pid == ts_st->service->pcr_pid) {
 941             if (ts->mux_rate > 1 || is_start) // VBR pcr period is based on frames
 942                 ts_st->service->pcr_packet_count++;
 943             if (ts_st->service->pcr_packet_count >=
 944                 ts_st->service->pcr_packet_period) {
 945                 ts_st->service->pcr_packet_count = 0;
 946                 write_pcr = 1;
 947             }
 948         }
 949
 950         if (ts->mux_rate > 1 && dts != AV_NOPTS_VALUE &&
 951             (dts - get_pcr(ts, s->pb)/300) > delay) {
 952             /* pcr insert gets priority over null packet insert */
 953             if (write_pcr)
 954                 mpegts_insert_pcr_only(s, st);
 955             else
 956                 mpegts_insert_null_packet(s);
 957             continue; /* recalculate write_pcr and possibly retransmit si_info */
 958         }
 959
 960         /* prepare packet header */
 961         q = buf;
 962         *q++ = 0x47;
 963         val = (ts_st->pid >> 8);
 964         if (is_start)
 965             val |= 0x40;
 966         *q++ = val;
 967         *q++ = ts_st->pid;
 968         ts_st->cc = (ts_st->cc + 1) & 0xf;
 969         *q++ = 0x10 | ts_st->cc; // payload indicator + CC
 970         if (key && is_start && pts != AV_NOPTS_VALUE) {
 971             // set Random Access for key frames
 972             if (ts_st->pid == ts_st->service->pcr_pid)
 973                 write_pcr = 1;
 974             set_af_flag(buf, 0x40);
 975             q = get_ts_payload_start(buf);
 976         }
 977         if (write_pcr) {
 978             set_af_flag(buf, 0x10);
 979             q = get_ts_payload_start(buf);
 980             // add 11, pcr references the last byte of program clock reference base
 981             if (ts->mux_rate > 1)
 982                 pcr = get_pcr(ts, s->pb);
 983             else
 984                 pcr = (dts - delay)*300;
 985             if (dts != AV_NOPTS_VALUE && dts < pcr / 300)
 986                 av_log(s, AV_LOG_WARNING, "dts < pcr, TS is invalid\n");
 987             extend_af(buf, write_pcr_bits(q, pcr));
 988             q = get_ts_payload_start(buf);
 989         }
 990         if (is_start) {
 991             int pes_extension = 0;
 992             int pes_header_stuffing_bytes = 0;
 993             /* write PES header */
 994             *q++ = 0x00;
 995             *q++ = 0x00;
 996             *q++ = 0x01;
 997             is_dvb_subtitle = 0;
 998             is_dvb_teletext = 0;
 999             if (st->codec->codec_type == AVMEDIA_TYPE_VIDEO) {
1000                 if (st->codec->codec_id == AV_CODEC_ID_DIRAC) {
1001                     *q++ = 0xfd;
1002                 } else
1003                     *q++ = 0xe0;
1004             } else if (st->codec->codec_type == AVMEDIA_TYPE_AUDIO &&
1005                        (st->codec->codec_id == AV_CODEC_ID_MP2 ||
1006                         st->codec->codec_id == AV_CODEC_ID_MP3 ||
1007                         st->codec->codec_id == AV_CODEC_ID_AAC)) {
1008                 *q++ = 0xc0;
1009             } else if (st->codec->codec_type == AVMEDIA_TYPE_AUDIO &&
1010                         st->codec->codec_id == AV_CODEC_ID_AC3 &&
1011                         ts->m2ts_mode) {
1012                 *q++ = 0xfd;
1013             } else {
1014                 *q++ = 0xbd;
1015                 if(st->codec->codec_type == AVMEDIA_TYPE_SUBTITLE) {
1016                     if (st->codec->codec_id == AV_CODEC_ID_DVB_SUBTITLE) {
1017                         is_dvb_subtitle = 1;
1018                     } else if (st->codec->codec_id == AV_CODEC_ID_DVB_TELETEXT) {
1019                         is_dvb_teletext = 1;
1020                     }
1021                 }
1022             }
1023             header_len = 0;
1024             flags = 0;
1025             if (pts != AV_NOPTS_VALUE) {
1026                 header_len += 5;
1027                 flags |= 0x80;
1028             }
1029             if (dts != AV_NOPTS_VALUE && pts != AV_NOPTS_VALUE && dts != pts) {
1030                 header_len += 5;
1031                 flags |= 0x40;
1032             }
1033             if (st->codec->codec_type == AVMEDIA_TYPE_VIDEO &&
1034                 st->codec->codec_id == AV_CODEC_ID_DIRAC) {
1035                 /* set PES_extension_flag */
1036                 pes_extension = 1;
1037                 flags |= 0x01;
1038
1039                 /*
1040                 * One byte for PES2 extension flag +
1041                 * one byte for extension length +
1042                 * one byte for extension id
1043                 */
1044                 header_len += 3;
1045             }
1046             /* for Blu-ray AC3 Audio the PES Extension flag should be as follow
1047              * otherwise it will not play sound on blu-ray
1048              */
1049             if (ts->m2ts_mode &&
1050                 st->codec->codec_type == AVMEDIA_TYPE_AUDIO &&
1051                 st->codec->codec_id == AV_CODEC_ID_AC3) {
1052                         /* set PES_extension_flag */
1053                         pes_extension = 1;
1054                         flags |= 0x01;
1055                         header_len += 3;
1056             }
1057             if (is_dvb_teletext) {
1058                 pes_header_stuffing_bytes = 0x24 - header_len;
1059                 header_len = 0x24;
1060             }
1061             len = payload_size + header_len + 3;
1062             /* 3 extra bytes should be added to DVB subtitle payload: 0x20 0x00 at the beginning and trailing 0xff */
1063             if (is_dvb_subtitle) {
1064                 len += 3;
1065                 payload_size++;
1066             }
1067             if (len > 0xffff)
1068                 len = 0;
1069             *q++ = len >> 8;
1070             *q++ = len;
1071             val = 0x80;
1072             /* data alignment indicator is required for subtitle and data streams */
1073             if (st->codec->codec_type == AVMEDIA_TYPE_SUBTITLE || st->codec->codec_type == AVMEDIA_TYPE_DATA)
1074                 val |= 0x04;
1075             *q++ = val;
1076             *q++ = flags;
1077             *q++ = header_len;
1078             if (pts != AV_NOPTS_VALUE) {
1079                 write_pts(q, flags >> 6, pts);
1080                 q += 5;
1081             }
1082             if (dts != AV_NOPTS_VALUE && pts != AV_NOPTS_VALUE && dts != pts) {
1083                 write_pts(q, 1, dts);
1084                 q += 5;
1085             }
1086             if (pes_extension && st->codec->codec_id == AV_CODEC_ID_DIRAC) {
1087                 flags = 0x01;  /* set PES_extension_flag_2 */
1088                 *q++ = flags;
1089                 *q++ = 0x80 | 0x01;  /* marker bit + extension length */
1090                 /*
1091                 * Set the stream id extension flag bit to 0 and
1092                 * write the extended stream id
1093                 */
1094                 *q++ = 0x00 | 0x60;
1095             }
1096             /* For Blu-ray AC3 Audio Setting extended flags */
1097           if (ts->m2ts_mode &&
1098               pes_extension &&
1099               st->codec->codec_id == AV_CODEC_ID_AC3) {
1100                       flags = 0x01; /* set PES_extension_flag_2 */
1101                       *q++ = flags;
1102                       *q++ = 0x80 | 0x01; /* marker bit + extension length */
1103                       *q++ = 0x00 | 0x71; /* for AC3 Audio (specifically on blue-rays) */
1104               }
1105
1106
1107             if (is_dvb_subtitle) {
1108                 /* First two fields of DVB subtitles PES data:
1109                  * data_identifier: for DVB subtitle streams shall be coded with the value 0x20
1110                  * subtitle_stream_id: for DVB subtitle stream shall be identified by the value 0x00 */
1111                 *q++ = 0x20;
1112                 *q++ = 0x00;
1113             }
1114             if (is_dvb_teletext) {
1115                 memset(q, 0xff, pes_header_stuffing_bytes);
1116                 q += pes_header_stuffing_bytes;
1117             }
1118             is_start = 0;
1119         }
1120         /* header size */
1121         header_len = q - buf;
1122         /* data len */
1123         len = TS_PACKET_SIZE - header_len;
1124         if (len > payload_size)
1125             len = payload_size;
1126         stuffing_len = TS_PACKET_SIZE - header_len - len;
1127         if (stuffing_len > 0) {
1128             /* add stuffing with AFC */
1129             if (buf[3] & 0x20) {
1130                 /* stuffing already present: increase its size */
1131                 afc_len = buf[4] + 1;
1132                 memmove(buf + 4 + afc_len + stuffing_len,
1133                         buf + 4 + afc_len,
1134                         header_len - (4 + afc_len));
1135                 buf[4] += stuffing_len;
1136                 memset(buf + 4 + afc_len, 0xff, stuffing_len);
1137             } else {
1138                 /* add stuffing */
1139                 memmove(buf + 4 + stuffing_len, buf + 4, header_len - 4);
1140                 buf[3] |= 0x20;
1141                 buf[4] = stuffing_len - 1;
1142                 if (stuffing_len >= 2) {
1143                     buf[5] = 0x00;
1144                     memset(buf + 6, 0xff, stuffing_len - 2);
1145                 }
1146             }
1147         }
1148
1149         if (is_dvb_subtitle && payload_size == len) {
1150             memcpy(buf + TS_PACKET_SIZE - len, payload, len - 1);
1151             buf[TS_PACKET_SIZE - 1] = 0xff; /* end_of_PES_data_field_marker: an 8-bit field with fixed contents 0xff for DVB subtitle */
1152         } else {
1153             memcpy(buf + TS_PACKET_SIZE - len, payload, len);
1154         }
1155
1156         payload += len;
1157         payload_size -= len;
1158         mpegts_prefix_m2ts_header(s);
1159         avio_write(s->pb, buf, TS_PACKET_SIZE);
1160     }
1161     avio_flush(s->pb);
1162     ts_st->prev_payload_key = key;
1163 }
1164
1165 int ff_check_h264_startcode(AVFormatContext *s, const AVStream *st, const AVPacket *pkt)
1166 {
1167     if (pkt->size < 5 || AV_RB32(pkt->data) != 0x0000001) {
1168         if (!st->nb_frames) {
1169             av_log(s, AV_LOG_ERROR, "H.264 bitstream malformed, "
1170                    "no startcode found, use the h264_mp4toannexb bitstream filter (-bsf h264_mp4toannexb)\n");
1171             return AVERROR(EINVAL);
1172         }
1173         av_log(s, AV_LOG_WARNING, "H.264 bitstream error, startcode missing\n");
1174     }
1175     return 0;
1176 }
1177
1178 static int mpegts_write_packet_internal(AVFormatContext *s, AVPacket *pkt)
1179 {
1180     AVStream *st = s->streams[pkt->stream_index];
1181     int size = pkt->size;
1182     uint8_t *buf= pkt->data;
1183     uint8_t *data= NULL;
1184     MpegTSWrite *ts = s->priv_data;
1185     MpegTSWriteStream *ts_st = st->priv_data;
1186     const int64_t delay = av_rescale(s->max_delay, 90000, AV_TIME_BASE)*2;
1187     int64_t dts = pkt->dts, pts = pkt->pts;
1188
1189     if (ts->reemit_pat_pmt) {
1190         av_log(s, AV_LOG_WARNING, "resend_headers option is deprecated, use -mpegts_flags resend_headers\n");
1191         ts->reemit_pat_pmt = 0;
1192         ts->flags |= MPEGTS_FLAG_REEMIT_PAT_PMT;
1193     }
1194
1195     if (ts->flags & MPEGTS_FLAG_REEMIT_PAT_PMT) {
1196         ts->pat_packet_count = ts->pat_packet_period - 1;
1197         ts->sdt_packet_count = ts->sdt_packet_period - 1;
1198         ts->flags &= ~MPEGTS_FLAG_REEMIT_PAT_PMT;
1199     }
1200
1201     if(ts->copyts < 1){
1202         if (pts != AV_NOPTS_VALUE)
1203             pts += delay;
1204         if (dts != AV_NOPTS_VALUE)
1205             dts += delay;
1206     }
1207
1208     if (ts_st->first_pts_check && pts == AV_NOPTS_VALUE) {
1209         av_log(s, AV_LOG_ERROR, "first pts value must be set\n");
1210         return AVERROR_INVALIDDATA;
1211     }
1212     ts_st->first_pts_check = 0;
1213
1214     if (st->codec->codec_id == AV_CODEC_ID_H264) {
1215         const uint8_t *p = buf, *buf_end = p+size;
1216         uint32_t state = -1;
1217         int ret = ff_check_h264_startcode(s, st, pkt);
1218         if (ret < 0)
1219             return ret;
1220
1221         do {
1222             p = avpriv_find_start_code(p, buf_end, &state);
1223             av_dlog(s, "nal %d\n", state & 0x1f);
1224         } while (p < buf_end && (state & 0x1f) != 9 &&
1225                  (state & 0x1f) != 5 && (state & 0x1f) != 1);
1226
1227         if ((state & 0x1f) != 9) { // AUD NAL
1228             data = av_malloc(pkt->size+6);
1229             if (!data)
1230                 return AVERROR(ENOMEM);
1231             memcpy(data+6, pkt->data, pkt->size);
1232             AV_WB32(data, 0x00000001);
1233             data[4] = 0x09;
1234             data[5] = 0xf0; // any slice type (0xe) + rbsp stop one bit
1235             buf  = data;
1236             size = pkt->size+6;
1237         }
1238     } else if (st->codec->codec_id == AV_CODEC_ID_AAC) {
1239         if (pkt->size < 2) {
1240             av_log(s, AV_LOG_ERROR, "AAC packet too short\n");
1241             return AVERROR_INVALIDDATA;
1242         }
1243         if ((AV_RB16(pkt->data) & 0xfff0) != 0xfff0) {
1244             int ret;
1245             AVPacket pkt2;
1246
1247             if (!ts_st->amux) {
1248                 av_log(s, AV_LOG_ERROR, "AAC bitstream not in ADTS format "
1249                        "and extradata missing\n");
1250                 return AVERROR_INVALIDDATA;
1251             }
1252
1253             av_init_packet(&pkt2);
1254             pkt2.data = pkt->data;
1255             pkt2.size = pkt->size;
1256             ret = avio_open_dyn_buf(&ts_st->amux->pb);
1257             if (ret < 0)
1258                 return AVERROR(ENOMEM);
1259
1260             ret = av_write_frame(ts_st->amux, &pkt2);
1261             if (ret < 0) {
1262                 avio_close_dyn_buf(ts_st->amux->pb, &data);
1263                 ts_st->amux->pb = NULL;
1264                 av_free(data);
1265                 return ret;
1266             }
1267             size = avio_close_dyn_buf(ts_st->amux->pb, &data);
1268             ts_st->amux->pb = NULL;
1269             buf = data;
1270         }
1271     }
1272
1273     if (pkt->dts != AV_NOPTS_VALUE) {
1274         int i;
1275         for(i=0; i<s->nb_streams; i++){
1276             AVStream *st2 = s->streams[i];
1277             MpegTSWriteStream *ts_st2 = st2->priv_data;
1278             if(   ts_st2->payload_size
1279                && (ts_st2->payload_dts == AV_NOPTS_VALUE || dts - ts_st2->payload_dts > delay/2)){
1280                 mpegts_write_pes(s, st2, ts_st2->payload, ts_st2->payload_size,
1281                                 ts_st2->payload_pts, ts_st2->payload_dts,
1282                                 ts_st2->payload_flags & AV_PKT_FLAG_KEY);
1283                 ts_st2->payload_size = 0;
1284             }
1285         }
1286     }
1287
1288     if (ts_st->payload_size && ts_st->payload_size + size > ts->pes_payload_size) {
1289         mpegts_write_pes(s, st, ts_st->payload, ts_st->payload_size,
1290                          ts_st->payload_pts, ts_st->payload_dts,
1291                          ts_st->payload_flags & AV_PKT_FLAG_KEY);
1292         ts_st->payload_size = 0;
1293     }
1294
1295     if (st->codec->codec_type != AVMEDIA_TYPE_AUDIO || size > ts->pes_payload_size) {
1296         av_assert0(!ts_st->payload_size);
1297         // for video and subtitle, write a single pes packet
1298         mpegts_write_pes(s, st, buf, size, pts, dts, pkt->flags & AV_PKT_FLAG_KEY);
1299         av_free(data);
1300         return 0;
1301     }
1302
1303     if (!ts_st->payload_size) {
1304         ts_st->payload_pts = pts;
1305         ts_st->payload_dts = dts;
1306         ts_st->payload_flags = pkt->flags;
1307     }
1308
1309     memcpy(ts_st->payload + ts_st->payload_size, buf, size);
1310     ts_st->payload_size += size;
1311
1312     av_free(data);
1313
1314     return 0;
1315 }
1316
1317 static void mpegts_write_flush(AVFormatContext *s)
1318 {
1319     int i;
1320
1321     /* flush current packets */
1322     for(i = 0; i < s->nb_streams; i++) {
1323         AVStream *st = s->streams[i];
1324         MpegTSWriteStream *ts_st = st->priv_data;
1325         if (ts_st->payload_size > 0) {
1326             mpegts_write_pes(s, st, ts_st->payload, ts_st->payload_size,
1327                              ts_st->payload_pts, ts_st->payload_dts,
1328                              ts_st->payload_flags & AV_PKT_FLAG_KEY);
1329             ts_st->payload_size = 0;
1330         }
1331     }
1332     avio_flush(s->pb);
1333 }
1334
1335 static int mpegts_write_packet(AVFormatContext *s, AVPacket *pkt)
1336 {
1337     if (!pkt) {
1338         mpegts_write_flush(s);
1339         return 1;
1340     } else {
1341         return mpegts_write_packet_internal(s, pkt);
1342     }
1343 }
1344
1345 static int mpegts_write_end(AVFormatContext *s)
1346 {
1347     MpegTSWrite *ts = s->priv_data;
1348     MpegTSService *service;
1349     int i;
1350
1351     mpegts_write_flush(s);
1352
1353     for(i = 0; i < s->nb_streams; i++) {
1354         AVStream *st = s->streams[i];
1355         MpegTSWriteStream *ts_st = st->priv_data;
1356         av_freep(&ts_st->payload);
1357         if (ts_st->amux) {
1358             avformat_free_context(ts_st->amux);
1359             ts_st->amux = NULL;
1360         }
1361     }
1362
1363     for(i = 0; i < ts->nb_services; i++) {
1364         service = ts->services[i];
1365         av_freep(&service->provider_name);
1366         av_freep(&service->name);
1367         av_free(service);
1368     }
1369     av_free(ts->services);
1370
1371     return 0;
1372 }
1373
1374 AVOutputFormat ff_mpegts_muxer = {
1375     .name              = "mpegts",
1376     .long_name         = NULL_IF_CONFIG_SMALL("MPEG-TS (MPEG-2 Transport Stream)"),
1377     .mime_type         = "video/x-mpegts",
1378     .extensions        = "ts,m2t,m2ts,mts",
1379     .priv_data_size    = sizeof(MpegTSWrite),
1380     .audio_codec       = AV_CODEC_ID_MP2,
1381     .video_codec       = AV_CODEC_ID_MPEG2VIDEO,
1382     .write_header      = mpegts_write_header,
1383     .write_packet      = mpegts_write_packet,
1384     .write_trailer     = mpegts_write_end,
1385     .flags             = AVFMT_ALLOW_FLUSH,
1386     .priv_class        = &mpegts_muxer_class,
1387 };