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

   1 /*
   2  * MPEG-2 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/avassert.h"
  23 #include "libavutil/bswap.h"
  24 #include "libavutil/crc.h"
  25 #include "libavutil/dict.h"
  26 #include "libavutil/intreadwrite.h"
  27 #include "libavutil/mathematics.h"
  28 #include "libavutil/opt.h"
  29
  30 #include "libavcodec/internal.h"
  31
  32 #include "avformat.h"
  33 #include "avio_internal.h"
  34 #include "internal.h"
  35 #include "mpegts.h"
  36
  37 #define PCR_TIME_BASE 27000000
  38
  39 /* write DVB SI sections */
  40
  41 #define DVB_PRIVATE_NETWORK_START 0xff01
  42
  43 /*********************************************/
  44 /* mpegts section writer */
  45
  46 typedef struct MpegTSSection {
  47     int pid;
  48     int cc;
  49     int discontinuity;
  50     void (*write_packet)(struct MpegTSSection *s, const uint8_t *packet);
  51     void *opaque;
  52 } MpegTSSection;
  53
  54 typedef struct MpegTSService {
  55     MpegTSSection pmt; /* MPEG-2 PMT table context */
  56     int sid;           /* service ID */
  57     uint8_t name[256];
  58     uint8_t provider_name[256];
  59     int pcr_pid;
  60     AVProgram *program;
  61 } MpegTSService;
  62
  63 // service_type values as defined in ETSI 300 468
  64 enum {
  65     MPEGTS_SERVICE_TYPE_DIGITAL_TV                   = 0x01,
  66     MPEGTS_SERVICE_TYPE_DIGITAL_RADIO                = 0x02,
  67     MPEGTS_SERVICE_TYPE_TELETEXT                     = 0x03,
  68     MPEGTS_SERVICE_TYPE_ADVANCED_CODEC_DIGITAL_RADIO = 0x0A,
  69     MPEGTS_SERVICE_TYPE_MPEG2_DIGITAL_HDTV           = 0x11,
  70     MPEGTS_SERVICE_TYPE_ADVANCED_CODEC_DIGITAL_SDTV  = 0x16,
  71     MPEGTS_SERVICE_TYPE_ADVANCED_CODEC_DIGITAL_HDTV  = 0x19,
  72     MPEGTS_SERVICE_TYPE_HEVC_DIGITAL_HDTV            = 0x1F,
  73 };
  74 typedef struct MpegTSWrite {
  75     const AVClass *av_class;
  76     MpegTSSection pat; /* MPEG-2 PAT table */
  77     MpegTSSection sdt; /* MPEG-2 SDT table context */
  78     MpegTSService **services;
  79     int sdt_packet_count;
  80     int sdt_packet_period;
  81     int pat_packet_count;
  82     int pat_packet_period;
  83     int nb_services;
  84     int onid;
  85     int tsid;
  86     int64_t first_pcr;
  87     int64_t next_pcr;
  88     int mux_rate; ///< set to 1 when VBR
  89     int pes_payload_size;
  90
  91     int transport_stream_id;
  92     int original_network_id;
  93     int service_id;
  94     int service_type;
  95
  96     int pmt_start_pid;
  97     int start_pid;
  98     int m2ts_mode;
  99
 100     int pcr_period_ms;
 101 #define MPEGTS_FLAG_REEMIT_PAT_PMT  0x01
 102 #define MPEGTS_FLAG_AAC_LATM        0x02
 103 #define MPEGTS_FLAG_PAT_PMT_AT_FRAMES           0x04
 104 #define MPEGTS_FLAG_SYSTEM_B        0x08
 105 #define MPEGTS_FLAG_DISCONT         0x10
 106     int flags;
 107     int copyts;
 108     int tables_version;
 109     double pat_period;
 110     double sdt_period;
 111     int64_t last_pat_ts;
 112     int64_t last_sdt_ts;
 113
 114     int omit_video_pes_length;
 115 } MpegTSWrite;
 116
 117 /* a PES packet header is generated every DEFAULT_PES_HEADER_FREQ packets */
 118 #define DEFAULT_PES_HEADER_FREQ  16
 119 #define DEFAULT_PES_PAYLOAD_SIZE ((DEFAULT_PES_HEADER_FREQ - 1) * 184 + 170)
 120
 121 /* The section length is 12 bits. The first 2 are set to 0, the remaining
 122  * 10 bits should not exceed 1021. */
 123 #define SECTION_LENGTH 1020
 124
 125 /* NOTE: 4 bytes must be left at the end for the crc32 */
 126 static void mpegts_write_section(MpegTSSection *s, uint8_t *buf, int len)
 127 {
 128     unsigned int crc;
 129     unsigned char packet[TS_PACKET_SIZE];
 130     const unsigned char *buf_ptr;
 131     unsigned char *q;
 132     int first, b, len1, left;
 133
 134     crc = av_bswap32(av_crc(av_crc_get_table(AV_CRC_32_IEEE),
 135                             -1, buf, len - 4));
 136
 137     buf[len - 4] = (crc >> 24) & 0xff;
 138     buf[len - 3] = (crc >> 16) & 0xff;
 139     buf[len - 2] = (crc >>  8) & 0xff;
 140     buf[len - 1] =  crc        & 0xff;
 141
 142     /* send each packet */
 143     buf_ptr = buf;
 144     while (len > 0) {
 145         first = buf == buf_ptr;
 146         q     = packet;
 147         *q++  = 0x47;
 148         b     = s->pid >> 8;
 149         if (first)
 150             b |= 0x40;
 151         *q++  = b;
 152         *q++  = s->pid;
 153         s->cc = s->cc + 1 & 0xf;
 154         *q++  = 0x10 | s->cc;
 155         if (s->discontinuity) {
 156             q[-1] |= 0x20;
 157             *q++ = 1;
 158             *q++ = 0x80;
 159             s->discontinuity = 0;
 160         }
 161         if (first)
 162             *q++ = 0; /* 0 offset */
 163         len1 = TS_PACKET_SIZE - (q - packet);
 164         if (len1 > len)
 165             len1 = len;
 166         memcpy(q, buf_ptr, len1);
 167         q += len1;
 168         /* add known padding data */
 169         left = TS_PACKET_SIZE - (q - packet);
 170         if (left > 0)
 171             memset(q, 0xff, left);
 172
 173         s->write_packet(s, packet);
 174
 175         buf_ptr += len1;
 176         len     -= len1;
 177     }
 178 }
 179
 180 static inline void put16(uint8_t **q_ptr, int val)
 181 {
 182     uint8_t *q;
 183     q      = *q_ptr;
 184     *q++   = val >> 8;
 185     *q++   = val;
 186     *q_ptr = q;
 187 }
 188
 189 static int mpegts_write_section1(MpegTSSection *s, int tid, int id,
 190                                  int version, int sec_num, int last_sec_num,
 191                                  uint8_t *buf, int len)
 192 {
 193     uint8_t section[1024], *q;
 194     unsigned int tot_len;
 195     /* reserved_future_use field must be set to 1 for SDT */
 196     unsigned int flags = tid == SDT_TID ? 0xf000 : 0xb000;
 197
 198     tot_len = 3 + 5 + len + 4;
 199     /* check if not too big */
 200     if (tot_len > 1024)
 201         return AVERROR_INVALIDDATA;
 202
 203     q    = section;
 204     *q++ = tid;
 205     put16(&q, flags | (len + 5 + 4)); /* 5 byte header + 4 byte CRC */
 206     put16(&q, id);
 207     *q++ = 0xc1 | (version << 1); /* current_next_indicator = 1 */
 208     *q++ = sec_num;
 209     *q++ = last_sec_num;
 210     memcpy(q, buf, len);
 211
 212     mpegts_write_section(s, section, tot_len);
 213     return 0;
 214 }
 215
 216 /*********************************************/
 217 /* mpegts writer */
 218
 219 #define DEFAULT_PROVIDER_NAME   "FFmpeg"
 220 #define DEFAULT_SERVICE_NAME    "Service"
 221
 222 /* we retransmit the SI info at this rate */
 223 #define SDT_RETRANS_TIME 500
 224 #define PAT_RETRANS_TIME 100
 225 #define PCR_RETRANS_TIME 20
 226
 227 typedef struct MpegTSWriteStream {
 228     int pid; /* stream associated pid */
 229     int cc;
 230     int discontinuity;
 231     int payload_size;
 232     int first_pts_check; ///< first pts check needed
 233     int prev_payload_key;
 234     int64_t payload_pts;
 235     int64_t payload_dts;
 236     int payload_flags;
 237     uint8_t *payload;
 238     AVFormatContext *amux;
 239
 240     int64_t pcr_period; /* PCR period in PCR time base */
 241     int64_t last_pcr;
 242
 243     /* For Opus */
 244     int opus_queued_samples;
 245     int opus_pending_trim_start;
 246 } MpegTSWriteStream;
 247
 248 static void mpegts_write_pat(AVFormatContext *s)
 249 {
 250     MpegTSWrite *ts = s->priv_data;
 251     MpegTSService *service;
 252     uint8_t data[SECTION_LENGTH], *q;
 253     int i;
 254
 255     q = data;
 256     for (i = 0; i < ts->nb_services; i++) {
 257         service = ts->services[i];
 258         put16(&q, service->sid);
 259         put16(&q, 0xe000 | service->pmt.pid);
 260     }
 261     mpegts_write_section1(&ts->pat, PAT_TID, ts->tsid, ts->tables_version, 0, 0,
 262                           data, q - data);
 263 }
 264
 265 static void putbuf(uint8_t **q_ptr, const uint8_t *buf, size_t len)
 266 {
 267     memcpy(*q_ptr, buf, len);
 268     *q_ptr += len;
 269 }
 270
 271 static void put_registration_descriptor(uint8_t **q_ptr, uint32_t tag)
 272 {
 273     uint8_t *q = *q_ptr;
 274     *q++ = 0x05; /* MPEG-2 registration descriptor*/
 275     *q++ = 4;
 276     *q++ = tag;
 277     *q++ = tag >> 8;
 278     *q++ = tag >> 16;
 279     *q++ = tag >> 24;
 280     *q_ptr = q;
 281 }
 282
 283 static int mpegts_write_pmt(AVFormatContext *s, MpegTSService *service)
 284 {
 285     MpegTSWrite *ts = s->priv_data;
 286     uint8_t data[SECTION_LENGTH], *q, *desc_length_ptr, *program_info_length_ptr;
 287     int val, stream_type, i, err = 0;
 288
 289     q = data;
 290     put16(&q, 0xe000 | service->pcr_pid);
 291
 292     program_info_length_ptr = q;
 293     q += 2; /* patched after */
 294
 295     /* put program info here */
 296
 297     val = 0xf000 | (q - program_info_length_ptr - 2);
 298     program_info_length_ptr[0] = val >> 8;
 299     program_info_length_ptr[1] = val;
 300
 301     for (i = 0; i < s->nb_streams; i++) {
 302         AVStream *st = s->streams[i];
 303         MpegTSWriteStream *ts_st = st->priv_data;
 304         AVDictionaryEntry *lang = av_dict_get(st->metadata, "language", NULL, 0);
 305
 306         if (s->nb_programs) {
 307             int k, found = 0;
 308             AVProgram *program = service->program;
 309
 310             for (k = 0; k < program->nb_stream_indexes; k++)
 311                 if (program->stream_index[k] == i) {
 312                     found = 1;
 313                     break;
 314                 }
 315
 316             if (!found)
 317                 continue;
 318         }
 319
 320         if (q - data > SECTION_LENGTH - 32) {
 321             err = 1;
 322             break;
 323         }
 324         switch (st->codecpar->codec_id) {
 325         case AV_CODEC_ID_MPEG1VIDEO:
 326         case AV_CODEC_ID_MPEG2VIDEO:
 327             stream_type = STREAM_TYPE_VIDEO_MPEG2;
 328             break;
 329         case AV_CODEC_ID_MPEG4:
 330             stream_type = STREAM_TYPE_VIDEO_MPEG4;
 331             break;
 332         case AV_CODEC_ID_H264:
 333             stream_type = STREAM_TYPE_VIDEO_H264;
 334             break;
 335         case AV_CODEC_ID_HEVC:
 336             stream_type = STREAM_TYPE_VIDEO_HEVC;
 337             break;
 338         case AV_CODEC_ID_CAVS:
 339             stream_type = STREAM_TYPE_VIDEO_CAVS;
 340             break;
 341         case AV_CODEC_ID_DIRAC:
 342             stream_type = STREAM_TYPE_VIDEO_DIRAC;
 343             break;
 344         case AV_CODEC_ID_VC1:
 345             stream_type = STREAM_TYPE_VIDEO_VC1;
 346             break;
 347         case AV_CODEC_ID_MP2:
 348         case AV_CODEC_ID_MP3:
 349             if (   st->codecpar->sample_rate > 0
 350                 && st->codecpar->sample_rate < 32000) {
 351                 stream_type = STREAM_TYPE_AUDIO_MPEG2;
 352             } else {
 353                 stream_type = STREAM_TYPE_AUDIO_MPEG1;
 354             }
 355             break;
 356         case AV_CODEC_ID_AAC:
 357             stream_type = (ts->flags & MPEGTS_FLAG_AAC_LATM)
 358                           ? STREAM_TYPE_AUDIO_AAC_LATM
 359                           : STREAM_TYPE_AUDIO_AAC;
 360             break;
 361         case AV_CODEC_ID_AAC_LATM:
 362             stream_type = STREAM_TYPE_AUDIO_AAC_LATM;
 363             break;
 364         case AV_CODEC_ID_AC3:
 365             stream_type = (ts->flags & MPEGTS_FLAG_SYSTEM_B)
 366                           ? STREAM_TYPE_PRIVATE_DATA
 367                           : STREAM_TYPE_AUDIO_AC3;
 368             break;
 369         case AV_CODEC_ID_EAC3:
 370             stream_type = (ts->flags & MPEGTS_FLAG_SYSTEM_B)
 371                           ? STREAM_TYPE_PRIVATE_DATA
 372                           : STREAM_TYPE_AUDIO_EAC3;
 373             break;
 374         case AV_CODEC_ID_DTS:
 375             stream_type = STREAM_TYPE_AUDIO_DTS;
 376             break;
 377         case AV_CODEC_ID_TRUEHD:
 378             stream_type = STREAM_TYPE_AUDIO_TRUEHD;
 379             break;
 380         case AV_CODEC_ID_OPUS:
 381             stream_type = STREAM_TYPE_PRIVATE_DATA;
 382             break;
 383         case AV_CODEC_ID_TIMED_ID3:
 384             stream_type = STREAM_TYPE_METADATA;
 385             break;
 386         default:
 387             stream_type = STREAM_TYPE_PRIVATE_DATA;
 388             break;
 389         }
 390
 391         *q++ = stream_type;
 392         put16(&q, 0xe000 | ts_st->pid);
 393         desc_length_ptr = q;
 394         q += 2; /* patched after */
 395
 396         /* write optional descriptors here */
 397         switch (st->codecpar->codec_type) {
 398         case AVMEDIA_TYPE_AUDIO:
 399             if (st->codecpar->codec_id==AV_CODEC_ID_AC3 && (ts->flags & MPEGTS_FLAG_SYSTEM_B)) {
 400                 *q++=0x6a; // AC3 descriptor see A038 DVB SI
 401                 *q++=1; // 1 byte, all flags sets to 0
 402                 *q++=0; // omit all fields...
 403             }
 404             if (st->codecpar->codec_id==AV_CODEC_ID_EAC3 && (ts->flags & MPEGTS_FLAG_SYSTEM_B)) {
 405                 *q++=0x7a; // EAC3 descriptor see A038 DVB SI
 406                 *q++=1; // 1 byte, all flags sets to 0
 407                 *q++=0; // omit all fields...
 408             }
 409             if (st->codecpar->codec_id==AV_CODEC_ID_S302M)
 410                 put_registration_descriptor(&q, MKTAG('B', 'S', 'S', 'D'));
 411             if (st->codecpar->codec_id==AV_CODEC_ID_OPUS) {
 412                 /* 6 bytes registration descriptor, 4 bytes Opus audio descriptor */
 413                 if (q - data > SECTION_LENGTH - 6 - 4) {
 414                     err = 1;
 415                     break;
 416                 }
 417
 418                 put_registration_descriptor(&q, MKTAG('O', 'p', 'u', 's'));
 419
 420                 *q++ = 0x7f; /* DVB extension descriptor */
 421                 *q++ = 2;
 422                 *q++ = 0x80;
 423
 424                 if (st->codecpar->extradata && st->codecpar->extradata_size >= 19) {
 425                     if (st->codecpar->extradata[18] == 0 && st->codecpar->channels <= 2) {
 426                         /* RTP mapping family */
 427                         *q++ = st->codecpar->channels;
 428                     } else if (st->codecpar->extradata[18] == 1 && st->codecpar->channels <= 8 &&
 429                                st->codecpar->extradata_size >= 21 + st->codecpar->channels) {
 430                         static const uint8_t coupled_stream_counts[9] = {
 431                             1, 0, 1, 1, 2, 2, 2, 3, 3
 432                         };
 433                         static const uint8_t channel_map_a[8][8] = {
 434                             {0},
 435                             {0, 1},
 436                             {0, 2, 1},
 437                             {0, 1, 2, 3},
 438                             {0, 4, 1, 2, 3},
 439                             {0, 4, 1, 2, 3, 5},
 440                             {0, 4, 1, 2, 3, 5, 6},
 441                             {0, 6, 1, 2, 3, 4, 5, 7},
 442                         };
 443                         static const uint8_t channel_map_b[8][8] = {
 444                             {0},
 445                             {0, 1},
 446                             {0, 1, 2},
 447                             {0, 1, 2, 3},
 448                             {0, 1, 2, 3, 4},
 449                             {0, 1, 2, 3, 4, 5},
 450                             {0, 1, 2, 3, 4, 5, 6},
 451                             {0, 1, 2, 3, 4, 5, 6, 7},
 452                         };
 453                         /* Vorbis mapping family */
 454
 455                         if (st->codecpar->extradata[19] == st->codecpar->channels - coupled_stream_counts[st->codecpar->channels] &&
 456                             st->codecpar->extradata[20] == coupled_stream_counts[st->codecpar->channels] &&
 457                             memcmp(&st->codecpar->extradata[21], channel_map_a[st->codecpar->channels-1], st->codecpar->channels) == 0) {
 458                             *q++ = st->codecpar->channels;
 459                         } else if (st->codecpar->channels >= 2 && st->codecpar->extradata[19] == st->codecpar->channels &&
 460                                    st->codecpar->extradata[20] == 0 &&
 461                                    memcmp(&st->codecpar->extradata[21], channel_map_b[st->codecpar->channels-1], st->codecpar->channels) == 0) {
 462                             *q++ = st->codecpar->channels | 0x80;
 463                         } else {
 464                             /* Unsupported, could write an extended descriptor here */
 465                             av_log(s, AV_LOG_ERROR, "Unsupported Opus Vorbis-style channel mapping");
 466                             *q++ = 0xff;
 467                         }
 468                     } else {
 469                         /* Unsupported */
 470                         av_log(s, AV_LOG_ERROR, "Unsupported Opus channel mapping for family %d", st->codecpar->extradata[18]);
 471                         *q++ = 0xff;
 472                     }
 473                 } else if (st->codecpar->channels <= 2) {
 474                     /* Assume RTP mapping family */
 475                     *q++ = st->codecpar->channels;
 476                 } else {
 477                     /* Unsupported */
 478                     av_log(s, AV_LOG_ERROR, "Unsupported Opus channel mapping");
 479                     *q++ = 0xff;
 480                 }
 481             }
 482
 483             if (lang) {
 484                 char *p;
 485                 char *next = lang->value;
 486                 uint8_t *len_ptr;
 487
 488                 *q++     = 0x0a; /* ISO 639 language descriptor */
 489                 len_ptr  = q++;
 490                 *len_ptr = 0;
 491
 492                 for (p = lang->value; next && *len_ptr < 255 / 4 * 4; p = next + 1) {
 493                     if (q - data > SECTION_LENGTH - 4) {
 494                         err = 1;
 495                         break;
 496                     }
 497                     next = strchr(p, ',');
 498                     if (strlen(p) != 3 && (!next || next != p + 3))
 499                         continue; /* not a 3-letter code */
 500
 501                     *q++ = *p++;
 502                     *q++ = *p++;
 503                     *q++ = *p++;
 504
 505                     if (st->disposition & AV_DISPOSITION_CLEAN_EFFECTS)
 506                         *q++ = 0x01;
 507                     else if (st->disposition & AV_DISPOSITION_HEARING_IMPAIRED)
 508                         *q++ = 0x02;
 509                     else if (st->disposition & AV_DISPOSITION_VISUAL_IMPAIRED)
 510                         *q++ = 0x03;
 511                     else
 512                         *q++ = 0; /* undefined type */
 513
 514                     *len_ptr += 4;
 515                 }
 516
 517                 if (*len_ptr == 0)
 518                     q -= 2; /* no language codes were written */
 519             }
 520             break;
 521         case AVMEDIA_TYPE_SUBTITLE:
 522         {
 523            const char default_language[] = "und";
 524            const char *language = lang && strlen(lang->value) >= 3 ? lang->value : default_language;
 525
 526            if (st->codecpar->codec_id == AV_CODEC_ID_DVB_SUBTITLE) {
 527                uint8_t *len_ptr;
 528                int extradata_copied = 0;
 529
 530                *q++ = 0x59; /* subtitling_descriptor */
 531                len_ptr = q++;
 532
 533                while (strlen(language) >= 3) {
 534                    if (sizeof(data) - (q - data) < 8) { /* 8 bytes per DVB subtitle substream data */
 535                        err = 1;
 536                        break;
 537                    }
 538                    *q++ = *language++;
 539                    *q++ = *language++;
 540                    *q++ = *language++;
 541                    /* Skip comma */
 542                    if (*language != '\0')
 543                        language++;
 544
 545                    if (st->codecpar->extradata_size - extradata_copied >= 5) {
 546                        *q++ = st->codecpar->extradata[extradata_copied + 4]; /* subtitling_type */
 547                        memcpy(q, st->codecpar->extradata + extradata_copied, 4); /* composition_page_id and ancillary_page_id */
 548                        extradata_copied += 5;
 549                        q += 4;
 550                    } else {
 551                        /* subtitling_type:
 552                         * 0x10 - normal with no monitor aspect ratio criticality
 553                         * 0x20 - for the hard of hearing with no monitor aspect ratio criticality */
 554                        *q++ = (st->disposition & AV_DISPOSITION_HEARING_IMPAIRED) ? 0x20 : 0x10;
 555                        if ((st->codecpar->extradata_size == 4) && (extradata_copied == 0)) {
 556                            /* support of old 4-byte extradata format */
 557                            memcpy(q, st->codecpar->extradata, 4); /* composition_page_id and ancillary_page_id */
 558                            extradata_copied += 4;
 559                            q += 4;
 560                        } else {
 561                            put16(&q, 1); /* composition_page_id */
 562                            put16(&q, 1); /* ancillary_page_id */
 563                        }
 564                    }
 565                }
 566
 567                *len_ptr = q - len_ptr - 1;
 568            } else if (st->codecpar->codec_id == AV_CODEC_ID_DVB_TELETEXT) {
 569                uint8_t *len_ptr = NULL;
 570                int extradata_copied = 0;
 571
 572                /* The descriptor tag. teletext_descriptor */
 573                *q++ = 0x56;
 574                len_ptr = q++;
 575
 576                while (strlen(language) >= 3 && q - data < sizeof(data) - 6) {
 577                    *q++ = *language++;
 578                    *q++ = *language++;
 579                    *q++ = *language++;
 580                    /* Skip comma */
 581                    if (*language != '\0')
 582                        language++;
 583
 584                    if (st->codecpar->extradata_size - 1 > extradata_copied) {
 585                        memcpy(q, st->codecpar->extradata + extradata_copied, 2);
 586                        extradata_copied += 2;
 587                        q += 2;
 588                    } else {
 589                        /* The Teletext descriptor:
 590                         * teletext_type: This 5-bit field indicates the type of Teletext page indicated. (0x01 Initial Teletext page)
 591                         * teletext_magazine_number: This is a 3-bit field which identifies the magazine number.
 592                         * teletext_page_number: This is an 8-bit field giving two 4-bit hex digits identifying the page number. */
 593                        *q++ = 0x08;
 594                        *q++ = 0x00;
 595                    }
 596                }
 597
 598                *len_ptr = q - len_ptr - 1;
 599             }
 600         }
 601         break;
 602         case AVMEDIA_TYPE_VIDEO:
 603             if (stream_type == STREAM_TYPE_VIDEO_DIRAC) {
 604                 put_registration_descriptor(&q, MKTAG('d', 'r', 'a', 'c'));
 605             } else if (stream_type == STREAM_TYPE_VIDEO_VC1) {
 606                 put_registration_descriptor(&q, MKTAG('V', 'C', '-', '1'));
 607             } else if (stream_type == STREAM_TYPE_VIDEO_HEVC && s->strict_std_compliance <= FF_COMPLIANCE_NORMAL) {
 608                 put_registration_descriptor(&q, MKTAG('H', 'E', 'V', 'C'));
 609             }
 610             break;
 611         case AVMEDIA_TYPE_DATA:
 612             if (st->codecpar->codec_id == AV_CODEC_ID_SMPTE_KLV) {
 613                 put_registration_descriptor(&q, MKTAG('K', 'L', 'V', 'A'));
 614             } else if (st->codecpar->codec_id == AV_CODEC_ID_TIMED_ID3) {
 615                 const char *tag = "ID3 ";
 616                 *q++ = 0x26; /* metadata descriptor */
 617                 *q++ = 13;
 618                 put16(&q, 0xffff);    /* metadata application format */
 619                 putbuf(&q, tag, strlen(tag));
 620                 *q++ = 0xff;        /* metadata format */
 621                 putbuf(&q, tag, strlen(tag));
 622                 *q++ = 0;            /* metadata service ID */
 623                 *q++ = 0xF;          /* metadata_locator_record_flag|MPEG_carriage_flags|reserved */
 624             }
 625             break;
 626         }
 627
 628         val = 0xf000 | (q - desc_length_ptr - 2);
 629         desc_length_ptr[0] = val >> 8;
 630         desc_length_ptr[1] = val;
 631     }
 632
 633     if (err)
 634         av_log(s, AV_LOG_ERROR,
 635                "The PMT section cannot fit stream %d and all following streams.\n"
 636                "Try reducing the number of languages in the audio streams "
 637                "or the total number of streams.\n", i);
 638
 639     mpegts_write_section1(&service->pmt, PMT_TID, service->sid, ts->tables_version, 0, 0,
 640                           data, q - data);
 641     return 0;
 642 }
 643
 644 static void mpegts_write_sdt(AVFormatContext *s)
 645 {
 646     MpegTSWrite *ts = s->priv_data;
 647     MpegTSService *service;
 648     uint8_t data[SECTION_LENGTH], *q, *desc_list_len_ptr, *desc_len_ptr;
 649     int i, running_status, free_ca_mode, val;
 650
 651     q = data;
 652     put16(&q, ts->onid);
 653     *q++ = 0xff;
 654     for (i = 0; i < ts->nb_services; i++) {
 655         service = ts->services[i];
 656         put16(&q, service->sid);
 657         *q++              = 0xfc | 0x00; /* currently no EIT info */
 658         desc_list_len_ptr = q;
 659         q                += 2;
 660         running_status    = 4; /* running */
 661         free_ca_mode      = 0;
 662
 663         /* write only one descriptor for the service name and provider */
 664         *q++         = 0x48;
 665         desc_len_ptr = q;
 666         q++;
 667         *q++         = ts->service_type;
 668         putbuf(&q, service->provider_name, service->provider_name[0] + 1);
 669         putbuf(&q, service->name, service->name[0] + 1);
 670         desc_len_ptr[0] = q - desc_len_ptr - 1;
 671
 672         /* fill descriptor length */
 673         val = (running_status << 13) | (free_ca_mode << 12) |
 674               (q - desc_list_len_ptr - 2);
 675         desc_list_len_ptr[0] = val >> 8;
 676         desc_list_len_ptr[1] = val;
 677     }
 678     mpegts_write_section1(&ts->sdt, SDT_TID, ts->tsid, ts->tables_version, 0, 0,
 679                           data, q - data);
 680 }
 681
 682 /* This stores a string in buf with the correct encoding and also sets the
 683  * first byte as the length. !str is accepted for an empty string.
 684  * If the string is already encoded, invalid UTF-8 or has no multibyte sequence
 685  * then we keep it as is, otherwise we signal UTF-8 encoding. */
 686 static int encode_str8(uint8_t *buf, const char *str)
 687 {
 688     size_t str_len;
 689     if (!str)
 690         str = "";
 691     str_len = strlen(str);
 692     if (str[0] && (unsigned)str[0] >= 0x20) {   /* Make sure the string is not already encoded. */
 693         const uint8_t *q = str;
 694         int has_multibyte = 0;
 695         while (*q) {
 696             uint32_t code;
 697             GET_UTF8(code, *q++, goto invalid;) /* Is it valid UTF-8? */
 698             has_multibyte |= (code > 127);      /* Does it have multibyte UTF-8 chars in it? */
 699         }
 700         if (has_multibyte) {                    /* If we have multibyte chars and valid UTF-8, then encode as such! */
 701             if (str_len > 254)
 702                 return AVERROR(EINVAL);
 703             buf[0] = str_len + 1;
 704             buf[1] = 0x15;
 705             memcpy(&buf[2], str, str_len);
 706             return 0;
 707         }
 708     }
 709 invalid:
 710     /* Otherwise let's just encode the string as is! */
 711     if (str_len > 255)
 712         return AVERROR(EINVAL);
 713     buf[0] = str_len;
 714     memcpy(&buf[1], str, str_len);
 715     return 0;
 716 }
 717
 718 static int64_t get_pcr(const MpegTSWrite *ts, AVIOContext *pb)
 719 {
 720     return av_rescale(avio_tell(pb) + 11, 8 * PCR_TIME_BASE, ts->mux_rate) +
 721            ts->first_pcr;
 722 }
 723
 724 static void mpegts_prefix_m2ts_header(AVFormatContext *s)
 725 {
 726     MpegTSWrite *ts = s->priv_data;
 727     if (ts->m2ts_mode) {
 728         int64_t pcr = get_pcr(s->priv_data, s->pb);
 729         uint32_t tp_extra_header = pcr % 0x3fffffff;
 730         tp_extra_header = AV_RB32(&tp_extra_header);
 731         avio_write(s->pb, (unsigned char *) &tp_extra_header,
 732                    sizeof(tp_extra_header));
 733     }
 734 }
 735
 736 static void section_write_packet(MpegTSSection *s, const uint8_t *packet)
 737 {
 738     AVFormatContext *ctx = s->opaque;
 739     mpegts_prefix_m2ts_header(ctx);
 740     avio_write(ctx->pb, packet, TS_PACKET_SIZE);
 741 }
 742
 743 static MpegTSService *mpegts_add_service(AVFormatContext *s, int sid,
 744                                          const AVDictionary *metadata,
 745                                          AVProgram *program)
 746 {
 747     MpegTSWrite *ts = s->priv_data;
 748     MpegTSService *service;
 749     AVDictionaryEntry *title, *provider;
 750     char default_service_name[32];
 751     const char *service_name;
 752     const char *provider_name;
 753
 754     title = av_dict_get(metadata, "service_name", NULL, 0);
 755     if (!title)
 756         title = av_dict_get(metadata, "title", NULL, 0);
 757     snprintf(default_service_name, sizeof(default_service_name), "%s%02d", DEFAULT_SERVICE_NAME, ts->nb_services + 1);
 758     service_name  = title ? title->value : default_service_name;
 759     provider      = av_dict_get(metadata, "service_provider", NULL, 0);
 760     provider_name = provider ? provider->value : DEFAULT_PROVIDER_NAME;
 761
 762     service = av_mallocz(sizeof(MpegTSService));
 763     if (!service)
 764         return NULL;
 765     service->pmt.pid       = ts->pmt_start_pid + ts->nb_services;
 766     service->sid           = sid;
 767     service->pcr_pid       = 0x1fff;
 768     if (encode_str8(service->provider_name, provider_name) < 0 ||
 769         encode_str8(service->name, service_name) < 0) {
 770         av_log(s, AV_LOG_ERROR, "Too long service or provider name\n");
 771         goto fail;
 772     }
 773     if (av_dynarray_add_nofree(&ts->services, &ts->nb_services, service) < 0)
 774         goto fail;
 775
 776     service->pmt.write_packet = section_write_packet;
 777     service->pmt.opaque       = s;
 778     service->pmt.cc           = 15;
 779     service->pmt.discontinuity= ts->flags & MPEGTS_FLAG_DISCONT;
 780     service->program          = program;
 781
 782     return service;
 783 fail:
 784     av_free(service);
 785     return NULL;
 786 }
 787
 788 static void enable_pcr_generation_for_stream(AVFormatContext *s, AVStream *pcr_st)
 789 {
 790     MpegTSWrite *ts = s->priv_data;
 791     MpegTSWriteStream *ts_st = pcr_st->priv_data;
 792
 793     if (ts->mux_rate > 1 || ts->pcr_period_ms >= 0) {
 794         int pcr_period_ms = ts->pcr_period_ms == -1 ? PCR_RETRANS_TIME : ts->pcr_period_ms;
 795         ts_st->pcr_period = av_rescale(pcr_period_ms, PCR_TIME_BASE, 1000);
 796     } else {
 797         /* By default, for VBR we select the highest multiple of frame duration which is less than 100 ms. */
 798         int64_t frame_period = 0;
 799         if (pcr_st->codecpar->codec_type == AVMEDIA_TYPE_AUDIO) {
 800             int frame_size = av_get_audio_frame_duration2(pcr_st->codecpar, 0);
 801             if (!frame_size) {
 802                av_log(s, AV_LOG_WARNING, "frame size not set\n");
 803                frame_size = 512;
 804             }
 805             frame_period = av_rescale_rnd(frame_size, PCR_TIME_BASE, pcr_st->codecpar->sample_rate, AV_ROUND_UP);
 806         } else if (pcr_st->avg_frame_rate.num) {
 807             frame_period = av_rescale_rnd(pcr_st->avg_frame_rate.den, PCR_TIME_BASE, pcr_st->avg_frame_rate.num, AV_ROUND_UP);
 808         }
 809         if (frame_period > 0 && frame_period <= PCR_TIME_BASE / 10)
 810             ts_st->pcr_period = frame_period * (PCR_TIME_BASE / 10 / frame_period);
 811         else
 812             ts_st->pcr_period = 1;
 813     }
 814
 815     // output a PCR as soon as possible
 816     ts_st->last_pcr   = ts->first_pcr - ts_st->pcr_period;
 817 }
 818
 819 static void select_pcr_streams(AVFormatContext *s)
 820 {
 821     MpegTSWrite *ts = s->priv_data;
 822
 823     for (int i = 0; i < ts->nb_services; i++) {
 824         MpegTSService *service = ts->services[i];
 825         AVStream *pcr_st = NULL;
 826         AVProgram *program = service->program;
 827         int nb_streams = program ? program->nb_stream_indexes : s->nb_streams;
 828
 829         for (int j = 0; j < nb_streams; j++) {
 830             AVStream *st = s->streams[program ? program->stream_index[j] : j];
 831             if (!pcr_st ||
 832                 pcr_st->codecpar->codec_type != AVMEDIA_TYPE_VIDEO && st->codecpar->codec_type == AVMEDIA_TYPE_VIDEO)
 833             {
 834                 pcr_st = st;
 835             }
 836         }
 837
 838         if (pcr_st) {
 839             MpegTSWriteStream *ts_st = pcr_st->priv_data;
 840             service->pcr_pid = ts_st->pid;
 841             enable_pcr_generation_for_stream(s, pcr_st);
 842             av_log(s, AV_LOG_VERBOSE, "service %i using PCR in pid=%i, pcr_period=%"PRId64"ms\n",
 843                 service->sid, service->pcr_pid, av_rescale(ts_st->pcr_period, 1000, PCR_TIME_BASE));
 844         }
 845     }
 846 }
 847
 848 static int mpegts_init(AVFormatContext *s)
 849 {
 850     MpegTSWrite *ts = s->priv_data;
 851     int i, j;
 852     int *pids;
 853     int ret;
 854
 855     if (s->max_delay < 0) /* Not set by the caller */
 856         s->max_delay = 0;
 857
 858     // round up to a whole number of TS packets
 859     ts->pes_payload_size = (ts->pes_payload_size + 14 + 183) / 184 * 184 - 14;
 860
 861     ts->tsid = ts->transport_stream_id;
 862     ts->onid = ts->original_network_id;
 863     if (!s->nb_programs) {
 864         /* allocate a single DVB service */
 865         if (!mpegts_add_service(s, ts->service_id, s->metadata, NULL))
 866             return AVERROR(ENOMEM);
 867     } else {
 868         for (i = 0; i < s->nb_programs; i++) {
 869             AVProgram *program = s->programs[i];
 870             if (!mpegts_add_service(s, program->id, program->metadata, program))
 871                 return AVERROR(ENOMEM);
 872         }
 873     }
 874
 875     ts->pat.pid          = PAT_PID;
 876     /* Initialize at 15 so that it wraps and is equal to 0 for the
 877      * first packet we write. */
 878     ts->pat.cc           = 15;
 879     ts->pat.discontinuity= ts->flags & MPEGTS_FLAG_DISCONT;
 880     ts->pat.write_packet = section_write_packet;
 881     ts->pat.opaque       = s;
 882
 883     ts->sdt.pid          = SDT_PID;
 884     ts->sdt.cc           = 15;
 885     ts->sdt.discontinuity= ts->flags & MPEGTS_FLAG_DISCONT;
 886     ts->sdt.write_packet = section_write_packet;
 887     ts->sdt.opaque       = s;
 888
 889     pids = av_malloc_array(s->nb_streams, sizeof(*pids));
 890     if (!pids) {
 891         ret = AVERROR(ENOMEM);
 892         goto fail;
 893     }
 894
 895     /* assign pids to each stream */
 896     for (i = 0; i < s->nb_streams; i++) {
 897         AVStream *st = s->streams[i];
 898         MpegTSWriteStream *ts_st;
 899
 900         ts_st = av_mallocz(sizeof(MpegTSWriteStream));
 901         if (!ts_st) {
 902             ret = AVERROR(ENOMEM);
 903             goto fail;
 904         }
 905         st->priv_data = ts_st;
 906
 907         avpriv_set_pts_info(st, 33, 1, 90000);
 908
 909         ts_st->payload = av_mallocz(ts->pes_payload_size);
 910         if (!ts_st->payload) {
 911             ret = AVERROR(ENOMEM);
 912             goto fail;
 913         }
 914
 915         /* MPEG pid values < 16 are reserved. Applications which set st->id in
 916          * this range are assigned a calculated pid. */
 917         if (st->id < 16) {
 918             ts_st->pid = ts->start_pid + i;
 919         } else if (st->id < 0x1FFF) {
 920             ts_st->pid = st->id;
 921         } else {
 922             av_log(s, AV_LOG_ERROR,
 923                    "Invalid stream id %d, must be less than 8191\n", st->id);
 924             ret = AVERROR(EINVAL);
 925             goto fail;
 926         }
 927         for (j = 0; j < ts->nb_services; j++) {
 928             if (ts_st->pid == ts->services[j]->pmt.pid) {
 929                 av_log(s, AV_LOG_ERROR, "Duplicate stream id %d\n", ts_st->pid);
 930                 ret = AVERROR(EINVAL);
 931                 goto fail;
 932             }
 933         }
 934         for (j = 0; j < i; j++) {
 935             if (pids[j] == ts_st->pid) {
 936                 av_log(s, AV_LOG_ERROR, "Duplicate stream id %d\n", ts_st->pid);
 937                 ret = AVERROR(EINVAL);
 938                 goto fail;
 939             }
 940         }
 941         pids[i]                = ts_st->pid;
 942         ts_st->payload_pts     = AV_NOPTS_VALUE;
 943         ts_st->payload_dts     = AV_NOPTS_VALUE;
 944         ts_st->first_pts_check = 1;
 945         ts_st->cc              = 15;
 946         ts_st->discontinuity   = ts->flags & MPEGTS_FLAG_DISCONT;
 947         if (st->codecpar->codec_id == AV_CODEC_ID_AAC &&
 948             st->codecpar->extradata_size > 0) {
 949             AVStream *ast;
 950             ts_st->amux = avformat_alloc_context();
 951             if (!ts_st->amux) {
 952                 ret = AVERROR(ENOMEM);
 953                 goto fail;
 954             }
 955             ts_st->amux->oformat =
 956                 av_guess_format((ts->flags & MPEGTS_FLAG_AAC_LATM) ? "latm" : "adts",
 957                                 NULL, NULL);
 958             if (!ts_st->amux->oformat) {
 959                 ret = AVERROR(EINVAL);
 960                 goto fail;
 961             }
 962             if (!(ast = avformat_new_stream(ts_st->amux, NULL))) {
 963                 ret = AVERROR(ENOMEM);
 964                 goto fail;
 965             }
 966             ret = avcodec_parameters_copy(ast->codecpar, st->codecpar);
 967             if (ret != 0)
 968                 goto fail;
 969             ast->time_base = st->time_base;
 970             ret = avformat_write_header(ts_st->amux, NULL);
 971             if (ret < 0)
 972                 goto fail;
 973         }
 974         if (st->codecpar->codec_id == AV_CODEC_ID_OPUS) {
 975             ts_st->opus_pending_trim_start = st->codecpar->initial_padding * 48000 / st->codecpar->sample_rate;
 976         }
 977     }
 978
 979     av_freep(&pids);
 980
 981     if (ts->mux_rate > 1) {
 982         ts->sdt_packet_period      = (int64_t)ts->mux_rate * SDT_RETRANS_TIME /
 983                                      (TS_PACKET_SIZE * 8 * 1000);
 984         ts->pat_packet_period      = (int64_t)ts->mux_rate * PAT_RETRANS_TIME /
 985                                      (TS_PACKET_SIZE * 8 * 1000);
 986     } else {
 987         /* Arbitrary values, PAT/PMT will also be written on video key frames */
 988         ts->sdt_packet_period = 200;
 989         ts->pat_packet_period = 40;
 990     }
 991
 992     if (ts->copyts < 1)
 993         ts->first_pcr = av_rescale(s->max_delay, PCR_TIME_BASE, AV_TIME_BASE);
 994
 995     select_pcr_streams(s);
 996
 997     ts->last_pat_ts = AV_NOPTS_VALUE;
 998     ts->last_sdt_ts = AV_NOPTS_VALUE;
 999     // The user specified a period, use only it
1000     if (ts->pat_period < INT_MAX/2) {
1001         ts->pat_packet_period = INT_MAX;
1002     }
1003     if (ts->sdt_period < INT_MAX/2) {
1004         ts->sdt_packet_period = INT_MAX;
1005     }
1006
1007     ts->pat_packet_count      = ts->pat_packet_period - 1;
1008     ts->sdt_packet_count      = ts->sdt_packet_period - 1;
1009
1010     if (ts->mux_rate == 1)
1011         av_log(s, AV_LOG_VERBOSE, "muxrate VBR, ");
1012     else
1013         av_log(s, AV_LOG_VERBOSE, "muxrate %d, ", ts->mux_rate);
1014     av_log(s, AV_LOG_VERBOSE,
1015            "sdt every %d, pat/pmt every %d pkts\n",
1016            ts->sdt_packet_period, ts->pat_packet_period);
1017
1018     if (ts->m2ts_mode == -1) {
1019         if (av_match_ext(s->url, "m2ts")) {
1020             ts->m2ts_mode = 1;
1021         } else {
1022             ts->m2ts_mode = 0;
1023         }
1024     }
1025
1026     return 0;
1027
1028 fail:
1029     av_freep(&pids);
1030     return ret;
1031 }
1032
1033 /* send SDT, PAT and PMT tables regularly */
1034 static void retransmit_si_info(AVFormatContext *s, int force_pat, int64_t dts)
1035 {
1036     MpegTSWrite *ts = s->priv_data;
1037     int i;
1038
1039     if (++ts->sdt_packet_count == ts->sdt_packet_period ||
1040         (dts != AV_NOPTS_VALUE && ts->last_sdt_ts == AV_NOPTS_VALUE) ||
1041         (dts != AV_NOPTS_VALUE && dts - ts->last_sdt_ts >= ts->sdt_period*90000.0)
1042     ) {
1043         ts->sdt_packet_count = 0;
1044         if (dts != AV_NOPTS_VALUE)
1045             ts->last_sdt_ts = FFMAX(dts, ts->last_sdt_ts);
1046         mpegts_write_sdt(s);
1047     }
1048     if (++ts->pat_packet_count == ts->pat_packet_period ||
1049         (dts != AV_NOPTS_VALUE && ts->last_pat_ts == AV_NOPTS_VALUE) ||
1050         (dts != AV_NOPTS_VALUE && dts - ts->last_pat_ts >= ts->pat_period*90000.0) ||
1051         force_pat) {
1052         ts->pat_packet_count = 0;
1053         if (dts != AV_NOPTS_VALUE)
1054             ts->last_pat_ts = FFMAX(dts, ts->last_pat_ts);
1055         mpegts_write_pat(s);
1056         for (i = 0; i < ts->nb_services; i++)
1057             mpegts_write_pmt(s, ts->services[i]);
1058     }
1059 }
1060
1061 static int write_pcr_bits(uint8_t *buf, int64_t pcr)
1062 {
1063     int64_t pcr_low = pcr % 300, pcr_high = pcr / 300;
1064
1065     *buf++ = pcr_high >> 25;
1066     *buf++ = pcr_high >> 17;
1067     *buf++ = pcr_high >>  9;
1068     *buf++ = pcr_high >>  1;
1069     *buf++ = pcr_high <<  7 | pcr_low >> 8 | 0x7e;
1070     *buf++ = pcr_low;
1071
1072     return 6;
1073 }
1074
1075 /* Write a single null transport stream packet */
1076 static void mpegts_insert_null_packet(AVFormatContext *s)
1077 {
1078     uint8_t *q;
1079     uint8_t buf[TS_PACKET_SIZE];
1080
1081     q    = buf;
1082     *q++ = 0x47;
1083     *q++ = 0x00 | 0x1f;
1084     *q++ = 0xff;
1085     *q++ = 0x10;
1086     memset(q, 0x0FF, TS_PACKET_SIZE - (q - buf));
1087     mpegts_prefix_m2ts_header(s);
1088     avio_write(s->pb, buf, TS_PACKET_SIZE);
1089 }
1090
1091 /* Write a single transport stream packet with a PCR and no payload */
1092 static void mpegts_insert_pcr_only(AVFormatContext *s, AVStream *st)
1093 {
1094     MpegTSWrite *ts = s->priv_data;
1095     MpegTSWriteStream *ts_st = st->priv_data;
1096     uint8_t *q;
1097     uint8_t buf[TS_PACKET_SIZE];
1098
1099     q    = buf;
1100     *q++ = 0x47;
1101     *q++ = ts_st->pid >> 8;
1102     *q++ = ts_st->pid;
1103     *q++ = 0x20 | ts_st->cc;   /* Adaptation only */
1104     /* Continuity Count field does not increment (see 13818-1 section 2.4.3.3) */
1105     *q++ = TS_PACKET_SIZE - 5; /* Adaptation Field Length */
1106     *q++ = 0x10;               /* Adaptation flags: PCR present */
1107     if (ts_st->discontinuity) {
1108         q[-1] |= 0x80;
1109         ts_st->discontinuity = 0;
1110     }
1111
1112     /* PCR coded into 6 bytes */
1113     q += write_pcr_bits(q, get_pcr(ts, s->pb));
1114
1115     /* stuffing bytes */
1116     memset(q, 0xFF, TS_PACKET_SIZE - (q - buf));
1117     mpegts_prefix_m2ts_header(s);
1118     avio_write(s->pb, buf, TS_PACKET_SIZE);
1119 }
1120
1121 static void write_pts(uint8_t *q, int fourbits, int64_t pts)
1122 {
1123     int val;
1124
1125     val  = fourbits << 4 | (((pts >> 30) & 0x07) << 1) | 1;
1126     *q++ = val;
1127     val  = (((pts >> 15) & 0x7fff) << 1) | 1;
1128     *q++ = val >> 8;
1129     *q++ = val;
1130     val  = (((pts) & 0x7fff) << 1) | 1;
1131     *q++ = val >> 8;
1132     *q++ = val;
1133 }
1134
1135 /* Set an adaptation field flag in an MPEG-TS packet*/
1136 static void set_af_flag(uint8_t *pkt, int flag)
1137 {
1138     // expect at least one flag to set
1139     av_assert0(flag);
1140
1141     if ((pkt[3] & 0x20) == 0) {
1142         // no AF yet, set adaptation field flag
1143         pkt[3] |= 0x20;
1144         // 1 byte length, no flags
1145         pkt[4] = 1;
1146         pkt[5] = 0;
1147     }
1148     pkt[5] |= flag;
1149 }
1150
1151 /* Extend the adaptation field by size bytes */
1152 static void extend_af(uint8_t *pkt, int size)
1153 {
1154     // expect already existing adaptation field
1155     av_assert0(pkt[3] & 0x20);
1156     pkt[4] += size;
1157 }
1158
1159 /* Get a pointer to MPEG-TS payload (right after TS packet header) */
1160 static uint8_t *get_ts_payload_start(uint8_t *pkt)
1161 {
1162     if (pkt[3] & 0x20)
1163         return pkt + 5 + pkt[4];
1164     else
1165         return pkt + 4;
1166 }
1167
1168 /* Add a PES header to the front of the payload, and segment into an integer
1169  * number of TS packets. The final TS packet is padded using an oversized
1170  * adaptation header to exactly fill the last TS packet.
1171  * NOTE: 'payload' contains a complete PES payload. */
1172 static void mpegts_write_pes(AVFormatContext *s, AVStream *st,
1173                              const uint8_t *payload, int payload_size,
1174                              int64_t pts, int64_t dts, int key, int stream_id)
1175 {
1176     MpegTSWriteStream *ts_st = st->priv_data;
1177     MpegTSWrite *ts = s->priv_data;
1178     uint8_t buf[TS_PACKET_SIZE];
1179     uint8_t *q;
1180     int val, is_start, len, header_len, write_pcr, is_dvb_subtitle, is_dvb_teletext, flags;
1181     int afc_len, stuffing_len;
1182     int64_t delay = av_rescale(s->max_delay, 90000, AV_TIME_BASE);
1183     int force_pat = st->codecpar->codec_type == AVMEDIA_TYPE_VIDEO && key && !ts_st->prev_payload_key;
1184
1185     av_assert0(ts_st->payload != buf || st->codecpar->codec_type != AVMEDIA_TYPE_VIDEO);
1186     if (ts->flags & MPEGTS_FLAG_PAT_PMT_AT_FRAMES && st->codecpar->codec_type == AVMEDIA_TYPE_VIDEO) {
1187         force_pat = 1;
1188     }
1189
1190     is_start = 1;
1191     while (payload_size > 0) {
1192         int64_t pcr = -1; /* avoid warning */
1193
1194         retransmit_si_info(s, force_pat, dts);
1195         force_pat = 0;
1196
1197         write_pcr = 0;
1198         if (ts->mux_rate > 1) {
1199             /* Send PCR packets for all PCR streams if needed */
1200             pcr = get_pcr(ts, s->pb);
1201             if (pcr >= ts->next_pcr) {
1202                 int64_t next_pcr = INT64_MAX;
1203                 for (int i = 0; i < s->nb_streams; i++) {
1204                     /* Make the current stream the last, because for that we
1205                      * can insert the pcr into the payload later */
1206                     int st2_index = i < st->index ? i : (i + 1 == s->nb_streams ? st->index : i + 1);
1207                     AVStream *st2 = s->streams[st2_index];
1208                     MpegTSWriteStream *ts_st2 = st2->priv_data;
1209                     if (ts_st2->pcr_period) {
1210                         if (pcr - ts_st2->last_pcr >= ts_st2->pcr_period) {
1211                             ts_st2->last_pcr = FFMAX(pcr - ts_st2->pcr_period, ts_st2->last_pcr + ts_st2->pcr_period);
1212                             if (st2 != st) {
1213                                 mpegts_insert_pcr_only(s, st2);
1214                                 pcr = get_pcr(ts, s->pb);
1215                             } else {
1216                                 write_pcr = 1;
1217                             }
1218                         }
1219                         next_pcr = FFMIN(next_pcr, ts_st2->last_pcr + ts_st2->pcr_period);
1220                     }
1221                 }
1222                 ts->next_pcr = next_pcr;
1223             }
1224         } else if (ts_st->pcr_period && dts != AV_NOPTS_VALUE) {
1225             pcr = (dts - delay) * 300;
1226             if (pcr - ts_st->last_pcr >= ts_st->pcr_period && is_start) {
1227                 ts_st->last_pcr = FFMAX(pcr - ts_st->pcr_period, ts_st->last_pcr + ts_st->pcr_period);
1228                 write_pcr = 1;
1229             }
1230         }
1231
1232         if (ts->mux_rate > 1 && dts != AV_NOPTS_VALUE &&
1233             (dts - get_pcr(ts, s->pb) / 300) > delay) {
1234             /* pcr insert gets priority over null packet insert */
1235             if (write_pcr)
1236                 mpegts_insert_pcr_only(s, st);
1237             else
1238                 mpegts_insert_null_packet(s);
1239             /* recalculate write_pcr and possibly retransmit si_info */
1240             continue;
1241         }
1242
1243         /* prepare packet header */
1244         q    = buf;
1245         *q++ = 0x47;
1246         val  = ts_st->pid >> 8;
1247         if (is_start)
1248             val |= 0x40;
1249         *q++      = val;
1250         *q++      = ts_st->pid;
1251         ts_st->cc = ts_st->cc + 1 & 0xf;
1252         *q++      = 0x10 | ts_st->cc; // payload indicator + CC
1253         if (ts_st->discontinuity) {
1254             set_af_flag(buf, 0x80);
1255             q = get_ts_payload_start(buf);
1256             ts_st->discontinuity = 0;
1257         }
1258         if (key && is_start && pts != AV_NOPTS_VALUE) {
1259             // set Random Access for key frames
1260             if (ts_st->pcr_period)
1261                 write_pcr = 1;
1262             set_af_flag(buf, 0x40);
1263             q = get_ts_payload_start(buf);
1264         }
1265         if (write_pcr) {
1266             set_af_flag(buf, 0x10);
1267             q = get_ts_payload_start(buf);
1268             // add 11, pcr references the last byte of program clock reference base
1269             if (dts != AV_NOPTS_VALUE && dts < pcr / 300)
1270                 av_log(s, AV_LOG_WARNING, "dts < pcr, TS is invalid\n");
1271             extend_af(buf, write_pcr_bits(q, pcr));
1272             q = get_ts_payload_start(buf);
1273         }
1274         if (is_start) {
1275             int pes_extension = 0;
1276             int pes_header_stuffing_bytes = 0;
1277             /* write PES header */
1278             *q++ = 0x00;
1279             *q++ = 0x00;
1280             *q++ = 0x01;
1281             is_dvb_subtitle = 0;
1282             is_dvb_teletext = 0;
1283             if (st->codecpar->codec_type == AVMEDIA_TYPE_VIDEO) {
1284                 if (st->codecpar->codec_id == AV_CODEC_ID_DIRAC)
1285                     *q++ = 0xfd;
1286                 else
1287                     *q++ = 0xe0;
1288             } else if (st->codecpar->codec_type == AVMEDIA_TYPE_AUDIO &&
1289                        (st->codecpar->codec_id == AV_CODEC_ID_MP2 ||
1290                         st->codecpar->codec_id == AV_CODEC_ID_MP3 ||
1291                         st->codecpar->codec_id == AV_CODEC_ID_AAC)) {
1292                 *q++ = 0xc0;
1293             } else if (st->codecpar->codec_type == AVMEDIA_TYPE_AUDIO &&
1294                         st->codecpar->codec_id == AV_CODEC_ID_AC3 &&
1295                         ts->m2ts_mode) {
1296                 *q++ = 0xfd;
1297             } else if (st->codecpar->codec_type == AVMEDIA_TYPE_DATA &&
1298                        st->codecpar->codec_id == AV_CODEC_ID_TIMED_ID3) {
1299                 *q++ = 0xbd;
1300             } else if (st->codecpar->codec_type == AVMEDIA_TYPE_DATA) {
1301                 *q++ = stream_id != -1 ? stream_id : 0xfc;
1302
1303                 if (stream_id == 0xbd) /* asynchronous KLV */
1304                     pts = dts = AV_NOPTS_VALUE;
1305             } else {
1306                 *q++ = 0xbd;
1307                 if (st->codecpar->codec_type == AVMEDIA_TYPE_SUBTITLE) {
1308                     if (st->codecpar->codec_id == AV_CODEC_ID_DVB_SUBTITLE) {
1309                         is_dvb_subtitle = 1;
1310                     } else if (st->codecpar->codec_id == AV_CODEC_ID_DVB_TELETEXT) {
1311                         is_dvb_teletext = 1;
1312                     }
1313                 }
1314             }
1315             header_len = 0;
1316             flags      = 0;
1317             if (pts != AV_NOPTS_VALUE) {
1318                 header_len += 5;
1319                 flags      |= 0x80;
1320             }
1321             if (dts != AV_NOPTS_VALUE && pts != AV_NOPTS_VALUE && dts != pts) {
1322                 header_len += 5;
1323                 flags      |= 0x40;
1324             }
1325             if (st->codecpar->codec_type == AVMEDIA_TYPE_VIDEO &&
1326                 st->codecpar->codec_id == AV_CODEC_ID_DIRAC) {
1327                 /* set PES_extension_flag */
1328                 pes_extension = 1;
1329                 flags        |= 0x01;
1330
1331                 /* One byte for PES2 extension flag +
1332                  * one byte for extension length +
1333                  * one byte for extension id */
1334                 header_len += 3;
1335             }
1336             /* for Blu-ray AC3 Audio the PES Extension flag should be as follow
1337              * otherwise it will not play sound on blu-ray
1338              */
1339             if (ts->m2ts_mode &&
1340                 st->codecpar->codec_type == AVMEDIA_TYPE_AUDIO &&
1341                 st->codecpar->codec_id == AV_CODEC_ID_AC3) {
1342                         /* set PES_extension_flag */
1343                         pes_extension = 1;
1344                         flags |= 0x01;
1345                         header_len += 3;
1346             }
1347             if (is_dvb_teletext) {
1348                 pes_header_stuffing_bytes = 0x24 - header_len;
1349                 header_len = 0x24;
1350             }
1351             len = payload_size + header_len + 3;
1352             /* 3 extra bytes should be added to DVB subtitle payload: 0x20 0x00 at the beginning and trailing 0xff */
1353             if (is_dvb_subtitle) {
1354                 len += 3;
1355                 payload_size++;
1356             }
1357             if (len > 0xffff)
1358                 len = 0;
1359             if (ts->omit_video_pes_length && st->codecpar->codec_type == AVMEDIA_TYPE_VIDEO) {
1360                 len = 0;
1361             }
1362             *q++ = len >> 8;
1363             *q++ = len;
1364             val  = 0x80;
1365             /* data alignment indicator is required for subtitle and data streams */
1366             if (st->codecpar->codec_type == AVMEDIA_TYPE_SUBTITLE || st->codecpar->codec_type == AVMEDIA_TYPE_DATA)
1367                 val |= 0x04;
1368             *q++ = val;
1369             *q++ = flags;
1370             *q++ = header_len;
1371             if (pts != AV_NOPTS_VALUE) {
1372                 write_pts(q, flags >> 6, pts);
1373                 q += 5;
1374             }
1375             if (dts != AV_NOPTS_VALUE && pts != AV_NOPTS_VALUE && dts != pts) {
1376                 write_pts(q, 1, dts);
1377                 q += 5;
1378             }
1379             if (pes_extension && st->codecpar->codec_id == AV_CODEC_ID_DIRAC) {
1380                 flags = 0x01;  /* set PES_extension_flag_2 */
1381                 *q++  = flags;
1382                 *q++  = 0x80 | 0x01; /* marker bit + extension length */
1383                 /* Set the stream ID extension flag bit to 0 and
1384                  * write the extended stream ID. */
1385                 *q++ = 0x00 | 0x60;
1386             }
1387             /* For Blu-ray AC3 Audio Setting extended flags */
1388           if (ts->m2ts_mode &&
1389               pes_extension &&
1390               st->codecpar->codec_id == AV_CODEC_ID_AC3) {
1391                       flags = 0x01; /* set PES_extension_flag_2 */
1392                       *q++ = flags;
1393                       *q++ = 0x80 | 0x01; /* marker bit + extension length */
1394                       *q++ = 0x00 | 0x71; /* for AC3 Audio (specifically on blue-rays) */
1395               }
1396
1397
1398             if (is_dvb_subtitle) {
1399                 /* First two fields of DVB subtitles PES data:
1400                  * data_identifier: for DVB subtitle streams shall be coded with the value 0x20
1401                  * subtitle_stream_id: for DVB subtitle stream shall be identified by the value 0x00 */
1402                 *q++ = 0x20;
1403                 *q++ = 0x00;
1404             }
1405             if (is_dvb_teletext) {
1406                 memset(q, 0xff, pes_header_stuffing_bytes);
1407                 q += pes_header_stuffing_bytes;
1408             }
1409             is_start = 0;
1410         }
1411         /* header size */
1412         header_len = q - buf;
1413         /* data len */
1414         len = TS_PACKET_SIZE - header_len;
1415         if (len > payload_size)
1416             len = payload_size;
1417         stuffing_len = TS_PACKET_SIZE - header_len - len;
1418         if (stuffing_len > 0) {
1419             /* add stuffing with AFC */
1420             if (buf[3] & 0x20) {
1421                 /* stuffing already present: increase its size */
1422                 afc_len = buf[4] + 1;
1423                 memmove(buf + 4 + afc_len + stuffing_len,
1424                         buf + 4 + afc_len,
1425                         header_len - (4 + afc_len));
1426                 buf[4] += stuffing_len;
1427                 memset(buf + 4 + afc_len, 0xff, stuffing_len);
1428             } else {
1429                 /* add stuffing */
1430                 memmove(buf + 4 + stuffing_len, buf + 4, header_len - 4);
1431                 buf[3] |= 0x20;
1432                 buf[4]  = stuffing_len - 1;
1433                 if (stuffing_len >= 2) {
1434                     buf[5] = 0x00;
1435                     memset(buf + 6, 0xff, stuffing_len - 2);
1436                 }
1437             }
1438         }
1439
1440         if (is_dvb_subtitle && payload_size == len) {
1441             memcpy(buf + TS_PACKET_SIZE - len, payload, len - 1);
1442             buf[TS_PACKET_SIZE - 1] = 0xff; /* end_of_PES_data_field_marker: an 8-bit field with fixed contents 0xff for DVB subtitle */
1443         } else {
1444             memcpy(buf + TS_PACKET_SIZE - len, payload, len);
1445         }
1446
1447         payload      += len;
1448         payload_size -= len;
1449         mpegts_prefix_m2ts_header(s);
1450         avio_write(s->pb, buf, TS_PACKET_SIZE);
1451     }
1452     ts_st->prev_payload_key = key;
1453 }
1454
1455 int ff_check_h264_startcode(AVFormatContext *s, const AVStream *st, const AVPacket *pkt)
1456 {
1457     if (pkt->size < 5 || AV_RB32(pkt->data) != 0x0000001 && AV_RB24(pkt->data) != 0x000001) {
1458         if (!st->nb_frames) {
1459             av_log(s, AV_LOG_ERROR, "H.264 bitstream malformed, "
1460                    "no startcode found, use the video bitstream filter 'h264_mp4toannexb' to fix it "
1461                    "('-bsf:v h264_mp4toannexb' option with ffmpeg)\n");
1462             return AVERROR_INVALIDDATA;
1463         }
1464         av_log(s, AV_LOG_WARNING, "H.264 bitstream error, startcode missing, size %d", pkt->size);
1465         if (pkt->size)
1466             av_log(s, AV_LOG_WARNING, " data %08"PRIX32, AV_RB32(pkt->data));
1467         av_log(s, AV_LOG_WARNING, "\n");
1468     }
1469     return 0;
1470 }
1471
1472 static int check_hevc_startcode(AVFormatContext *s, const AVStream *st, const AVPacket *pkt)
1473 {
1474     if (pkt->size < 5 || AV_RB32(pkt->data) != 0x0000001 && AV_RB24(pkt->data) != 0x000001) {
1475         if (!st->nb_frames) {
1476             av_log(s, AV_LOG_ERROR, "HEVC bitstream malformed, no startcode found\n");
1477             return AVERROR_PATCHWELCOME;
1478         }
1479         av_log(s, AV_LOG_WARNING, "HEVC bitstream error, startcode missing, size %d", pkt->size);
1480         if (pkt->size)
1481             av_log(s, AV_LOG_WARNING, " data %08"PRIX32, AV_RB32(pkt->data));
1482         av_log(s, AV_LOG_WARNING, "\n");
1483     }
1484     return 0;
1485 }
1486
1487 /* Based on GStreamer's gst-plugins-base/ext/ogg/gstoggstream.c
1488  * Released under the LGPL v2.1+, written by
1489  * Vincent Penquerc'h <vincent.penquerch@collabora.co.uk>
1490  */
1491 static int opus_get_packet_samples(AVFormatContext *s, AVPacket *pkt)
1492 {
1493     static const int durations[32] = {
1494       480, 960, 1920, 2880,       /* Silk NB */
1495       480, 960, 1920, 2880,       /* Silk MB */
1496       480, 960, 1920, 2880,       /* Silk WB */
1497       480, 960,                   /* Hybrid SWB */
1498       480, 960,                   /* Hybrid FB */
1499       120, 240, 480, 960,         /* CELT NB */
1500       120, 240, 480, 960,         /* CELT NB */
1501       120, 240, 480, 960,         /* CELT NB */
1502       120, 240, 480, 960,         /* CELT NB */
1503     };
1504     int toc, frame_duration, nframes, duration;
1505
1506     if (pkt->size < 1)
1507         return 0;
1508
1509     toc = pkt->data[0];
1510
1511     frame_duration = durations[toc >> 3];
1512     switch (toc & 3) {
1513     case 0:
1514         nframes = 1;
1515         break;
1516     case 1:
1517         nframes = 2;
1518         break;
1519     case 2:
1520         nframes = 2;
1521         break;
1522     case 3:
1523         if (pkt->size < 2)
1524             return 0;
1525         nframes = pkt->data[1] & 63;
1526         break;
1527     }
1528
1529     duration = nframes * frame_duration;
1530     if (duration > 5760) {
1531         av_log(s, AV_LOG_WARNING,
1532                "Opus packet duration > 120 ms, invalid");
1533         return 0;
1534     }
1535
1536     return duration;
1537 }
1538
1539 static int mpegts_write_packet_internal(AVFormatContext *s, AVPacket *pkt)
1540 {
1541     AVStream *st = s->streams[pkt->stream_index];
1542     int size = pkt->size;
1543     uint8_t *buf = pkt->data;
1544     uint8_t *data = NULL;
1545     MpegTSWrite *ts = s->priv_data;
1546     MpegTSWriteStream *ts_st = st->priv_data;
1547     const int64_t delay = av_rescale(s->max_delay, 90000, AV_TIME_BASE) * 2;
1548     int64_t dts = pkt->dts, pts = pkt->pts;
1549     int opus_samples = 0;
1550     int side_data_size;
1551     uint8_t *side_data = NULL;
1552     int stream_id = -1;
1553
1554     side_data = av_packet_get_side_data(pkt,
1555                                         AV_PKT_DATA_MPEGTS_STREAM_ID,
1556                                         &side_data_size);
1557     if (side_data)
1558         stream_id = side_data[0];
1559
1560     if (ts->flags & MPEGTS_FLAG_REEMIT_PAT_PMT) {
1561         ts->pat_packet_count = ts->pat_packet_period - 1;
1562         ts->sdt_packet_count = ts->sdt_packet_period - 1;
1563         ts->flags           &= ~MPEGTS_FLAG_REEMIT_PAT_PMT;
1564     }
1565
1566     if (ts->copyts < 1) {
1567         if (pts != AV_NOPTS_VALUE)
1568             pts += delay;
1569         if (dts != AV_NOPTS_VALUE)
1570             dts += delay;
1571     }
1572
1573     if (ts_st->first_pts_check && pts == AV_NOPTS_VALUE) {
1574         av_log(s, AV_LOG_ERROR, "first pts value must be set\n");
1575         return AVERROR_INVALIDDATA;
1576     }
1577     ts_st->first_pts_check = 0;
1578
1579     if (st->codecpar->codec_id == AV_CODEC_ID_H264) {
1580         const uint8_t *p = buf, *buf_end = p + size;
1581         uint32_t state = -1;
1582         int extradd = (pkt->flags & AV_PKT_FLAG_KEY) ? st->codecpar->extradata_size : 0;
1583         int ret = ff_check_h264_startcode(s, st, pkt);
1584         if (ret < 0)
1585             return ret;
1586
1587         if (extradd && AV_RB24(st->codecpar->extradata) > 1)
1588             extradd = 0;
1589
1590         do {
1591             p = avpriv_find_start_code(p, buf_end, &state);
1592             av_log(s, AV_LOG_TRACE, "nal %"PRId32"\n", state & 0x1f);
1593             if ((state & 0x1f) == 7)
1594                 extradd = 0;
1595         } while (p < buf_end && (state & 0x1f) != 9 &&
1596                  (state & 0x1f) != 5 && (state & 0x1f) != 1);
1597
1598         if ((state & 0x1f) != 5)
1599             extradd = 0;
1600         if ((state & 0x1f) != 9) { // AUD NAL
1601             data = av_malloc(pkt->size + 6 + extradd);
1602             if (!data)
1603                 return AVERROR(ENOMEM);
1604             memcpy(data + 6, st->codecpar->extradata, extradd);
1605             memcpy(data + 6 + extradd, pkt->data, pkt->size);
1606             AV_WB32(data, 0x00000001);
1607             data[4] = 0x09;
1608             data[5] = 0xf0; // any slice type (0xe) + rbsp stop one bit
1609             buf     = data;
1610             size    = pkt->size + 6 + extradd;
1611         }
1612     } else if (st->codecpar->codec_id == AV_CODEC_ID_AAC) {
1613         if (pkt->size < 2) {
1614             av_log(s, AV_LOG_ERROR, "AAC packet too short\n");
1615             return AVERROR_INVALIDDATA;
1616         }
1617         if ((AV_RB16(pkt->data) & 0xfff0) != 0xfff0) {
1618             int ret;
1619             AVPacket pkt2;
1620
1621             if (!ts_st->amux) {
1622                 av_log(s, AV_LOG_ERROR, "AAC bitstream not in ADTS format "
1623                                         "and extradata missing\n");
1624             } else {
1625             av_init_packet(&pkt2);
1626             pkt2.data = pkt->data;
1627             pkt2.size = pkt->size;
1628             av_assert0(pkt->dts != AV_NOPTS_VALUE);
1629             pkt2.dts = av_rescale_q(pkt->dts, st->time_base, ts_st->amux->streams[0]->time_base);
1630
1631             ret = avio_open_dyn_buf(&ts_st->amux->pb);
1632             if (ret < 0)
1633                 return AVERROR(ENOMEM);
1634
1635             ret = av_write_frame(ts_st->amux, &pkt2);
1636             if (ret < 0) {
1637                 ffio_free_dyn_buf(&ts_st->amux->pb);
1638                 return ret;
1639             }
1640             size            = avio_close_dyn_buf(ts_st->amux->pb, &data);
1641             ts_st->amux->pb = NULL;
1642             buf             = data;
1643             }
1644         }
1645     } else if (st->codecpar->codec_id == AV_CODEC_ID_HEVC) {
1646         const uint8_t *p = buf, *buf_end = p + size;
1647         uint32_t state = -1;
1648         int extradd = (pkt->flags & AV_PKT_FLAG_KEY) ? st->codecpar->extradata_size : 0;
1649         int ret = check_hevc_startcode(s, st, pkt);
1650         if (ret < 0)
1651             return ret;
1652
1653         if (extradd && AV_RB24(st->codecpar->extradata) > 1)
1654             extradd = 0;
1655
1656         do {
1657             p = avpriv_find_start_code(p, buf_end, &state);
1658             av_log(s, AV_LOG_TRACE, "nal %"PRId32"\n", (state & 0x7e)>>1);
1659             if ((state & 0x7e) == 2*32)
1660                 extradd = 0;
1661         } while (p < buf_end && (state & 0x7e) != 2*35 &&
1662                  (state & 0x7e) >= 2*32);
1663
1664         if ((state & 0x7e) < 2*16 && (state & 0x7e) >= 2*24)
1665             extradd = 0;
1666         if ((state & 0x7e) != 2*35) { // AUD NAL
1667             data = av_malloc(pkt->size + 7 + extradd);
1668             if (!data)
1669                 return AVERROR(ENOMEM);
1670             memcpy(data + 7, st->codecpar->extradata, extradd);
1671             memcpy(data + 7 + extradd, pkt->data, pkt->size);
1672             AV_WB32(data, 0x00000001);
1673             data[4] = 2*35;
1674             data[5] = 1;
1675             data[6] = 0x50; // any slice type (0x4) + rbsp stop one bit
1676             buf     = data;
1677             size    = pkt->size + 7 + extradd;
1678         }
1679     } else if (st->codecpar->codec_id == AV_CODEC_ID_OPUS) {
1680         if (pkt->size < 2) {
1681             av_log(s, AV_LOG_ERROR, "Opus packet too short\n");
1682             return AVERROR_INVALIDDATA;
1683         }
1684
1685         /* Add Opus control header */
1686         if ((AV_RB16(pkt->data) >> 5) != 0x3ff) {
1687             uint8_t *side_data;
1688             int side_data_size;
1689             int i, n;
1690             int ctrl_header_size;
1691             int trim_start = 0, trim_end = 0;
1692
1693             opus_samples = opus_get_packet_samples(s, pkt);
1694
1695             side_data = av_packet_get_side_data(pkt,
1696                                                 AV_PKT_DATA_SKIP_SAMPLES,
1697                                                 &side_data_size);
1698
1699             if (side_data && side_data_size >= 10) {
1700                 trim_end = AV_RL32(side_data + 4) * 48000 / st->codecpar->sample_rate;
1701             }
1702
1703             ctrl_header_size = pkt->size + 2 + pkt->size / 255 + 1;
1704             if (ts_st->opus_pending_trim_start)
1705               ctrl_header_size += 2;
1706             if (trim_end)
1707               ctrl_header_size += 2;
1708
1709             data = av_malloc(ctrl_header_size);
1710             if (!data)
1711                 return AVERROR(ENOMEM);
1712
1713             data[0] = 0x7f;
1714             data[1] = 0xe0;
1715             if (ts_st->opus_pending_trim_start)
1716                 data[1] |= 0x10;
1717             if (trim_end)
1718                 data[1] |= 0x08;
1719
1720             n = pkt->size;
1721             i = 2;
1722             do {
1723                 data[i] = FFMIN(n, 255);
1724                 n -= 255;
1725                 i++;
1726             } while (n >= 0);
1727
1728             av_assert0(2 + pkt->size / 255 + 1 == i);
1729
1730             if (ts_st->opus_pending_trim_start) {
1731                 trim_start = FFMIN(ts_st->opus_pending_trim_start, opus_samples);
1732                 AV_WB16(data + i, trim_start);
1733                 i += 2;
1734                 ts_st->opus_pending_trim_start -= trim_start;
1735             }
1736             if (trim_end) {
1737                 trim_end = FFMIN(trim_end, opus_samples - trim_start);
1738                 AV_WB16(data + i, trim_end);
1739                 i += 2;
1740             }
1741
1742             memcpy(data + i, pkt->data, pkt->size);
1743             buf     = data;
1744             size    = ctrl_header_size;
1745         } else {
1746             /* TODO: Can we get TS formatted data here? If so we will
1747              * need to count the samples of that too! */
1748             av_log(s, AV_LOG_WARNING, "Got MPEG-TS formatted Opus data, unhandled");
1749         }
1750     }
1751
1752     if (pkt->dts != AV_NOPTS_VALUE) {
1753         int i;
1754         for(i=0; i<s->nb_streams; i++) {
1755             AVStream *st2 = s->streams[i];
1756             MpegTSWriteStream *ts_st2 = st2->priv_data;
1757             if (   ts_st2->payload_size
1758                && (ts_st2->payload_dts == AV_NOPTS_VALUE || dts - ts_st2->payload_dts > delay/2)) {
1759                 mpegts_write_pes(s, st2, ts_st2->payload, ts_st2->payload_size,
1760                                  ts_st2->payload_pts, ts_st2->payload_dts,
1761                                  ts_st2->payload_flags & AV_PKT_FLAG_KEY, stream_id);
1762                 ts_st2->payload_size = 0;
1763             }
1764         }
1765     }
1766
1767     if (ts_st->payload_size && (ts_st->payload_size + size > ts->pes_payload_size ||
1768         (dts != AV_NOPTS_VALUE && ts_st->payload_dts != AV_NOPTS_VALUE &&
1769          av_compare_ts(dts - ts_st->payload_dts, st->time_base,
1770                        s->max_delay, AV_TIME_BASE_Q) >= 0) ||
1771         ts_st->opus_queued_samples + opus_samples >= 5760 /* 120ms */)) {
1772         mpegts_write_pes(s, st, ts_st->payload, ts_st->payload_size,
1773                          ts_st->payload_pts, ts_st->payload_dts,
1774                          ts_st->payload_flags & AV_PKT_FLAG_KEY, stream_id);
1775         ts_st->payload_size = 0;
1776         ts_st->opus_queued_samples = 0;
1777     }
1778
1779     if (st->codecpar->codec_type != AVMEDIA_TYPE_AUDIO || size > ts->pes_payload_size) {
1780         av_assert0(!ts_st->payload_size);
1781         // for video and subtitle, write a single pes packet
1782         mpegts_write_pes(s, st, buf, size, pts, dts,
1783                          pkt->flags & AV_PKT_FLAG_KEY, stream_id);
1784         ts_st->opus_queued_samples = 0;
1785         av_free(data);
1786         return 0;
1787     }
1788
1789     if (!ts_st->payload_size) {
1790         ts_st->payload_pts   = pts;
1791         ts_st->payload_dts   = dts;
1792         ts_st->payload_flags = pkt->flags;
1793     }
1794
1795     memcpy(ts_st->payload + ts_st->payload_size, buf, size);
1796     ts_st->payload_size += size;
1797     ts_st->opus_queued_samples += opus_samples;
1798
1799     av_free(data);
1800
1801     return 0;
1802 }
1803
1804 static void mpegts_write_flush(AVFormatContext *s)
1805 {
1806     int i;
1807
1808     /* flush current packets */
1809     for (i = 0; i < s->nb_streams; i++) {
1810         AVStream *st = s->streams[i];
1811         MpegTSWriteStream *ts_st = st->priv_data;
1812         if (ts_st->payload_size > 0) {
1813             mpegts_write_pes(s, st, ts_st->payload, ts_st->payload_size,
1814                              ts_st->payload_pts, ts_st->payload_dts,
1815                              ts_st->payload_flags & AV_PKT_FLAG_KEY, -1);
1816             ts_st->payload_size = 0;
1817             ts_st->opus_queued_samples = 0;
1818         }
1819     }
1820 }
1821
1822 static int mpegts_write_packet(AVFormatContext *s, AVPacket *pkt)
1823 {
1824     if (!pkt) {
1825         mpegts_write_flush(s);
1826         return 1;
1827     } else {
1828         return mpegts_write_packet_internal(s, pkt);
1829     }
1830 }
1831
1832 static int mpegts_write_end(AVFormatContext *s)
1833 {
1834     if (s->pb)
1835         mpegts_write_flush(s);
1836
1837     return 0;
1838 }
1839
1840 static void mpegts_deinit(AVFormatContext *s)
1841 {
1842     MpegTSWrite *ts = s->priv_data;
1843     MpegTSService *service;
1844     int i;
1845
1846     for (i = 0; i < s->nb_streams; i++) {
1847         AVStream *st = s->streams[i];
1848         MpegTSWriteStream *ts_st = st->priv_data;
1849         if (ts_st) {
1850             av_freep(&ts_st->payload);
1851             if (ts_st->amux) {
1852                 avformat_free_context(ts_st->amux);
1853                 ts_st->amux = NULL;
1854             }
1855         }
1856     }
1857
1858     for (i = 0; i < ts->nb_services; i++) {
1859         service = ts->services[i];
1860         av_freep(&service);
1861     }
1862     av_freep(&ts->services);
1863 }
1864
1865 static int mpegts_check_bitstream(struct AVFormatContext *s, const AVPacket *pkt)
1866 {
1867     int ret = 1;
1868     AVStream *st = s->streams[pkt->stream_index];
1869
1870     if (st->codecpar->codec_id == AV_CODEC_ID_H264) {
1871         if (pkt->size >= 5 && AV_RB32(pkt->data) != 0x0000001 &&
1872                              (AV_RB24(pkt->data) != 0x000001 ||
1873                               (st->codecpar->extradata_size > 0 &&
1874                                st->codecpar->extradata[0] == 1)))
1875             ret = ff_stream_add_bitstream_filter(st, "h264_mp4toannexb", NULL);
1876     } else if (st->codecpar->codec_id == AV_CODEC_ID_HEVC) {
1877         if (pkt->size >= 5 && AV_RB32(pkt->data) != 0x0000001 &&
1878                              (AV_RB24(pkt->data) != 0x000001 ||
1879                               (st->codecpar->extradata_size > 0 &&
1880                                st->codecpar->extradata[0] == 1)))
1881             ret = ff_stream_add_bitstream_filter(st, "hevc_mp4toannexb", NULL);
1882     }
1883
1884     return ret;
1885 }
1886
1887 static const AVOption options[] = {
1888     { "mpegts_transport_stream_id", "Set transport_stream_id field.",
1889       offsetof(MpegTSWrite, transport_stream_id), AV_OPT_TYPE_INT,
1890       { .i64 = 0x0001 }, 0x0001, 0xffff, AV_OPT_FLAG_ENCODING_PARAM },
1891     { "mpegts_original_network_id", "Set original_network_id field.",
1892       offsetof(MpegTSWrite, original_network_id), AV_OPT_TYPE_INT,
1893       { .i64 = DVB_PRIVATE_NETWORK_START }, 0x0001, 0xffff, AV_OPT_FLAG_ENCODING_PARAM },
1894     { "mpegts_service_id", "Set service_id field.",
1895       offsetof(MpegTSWrite, service_id), AV_OPT_TYPE_INT,
1896       { .i64 = 0x0001 }, 0x0001, 0xffff, AV_OPT_FLAG_ENCODING_PARAM },
1897     { "mpegts_service_type", "Set service_type field.",
1898       offsetof(MpegTSWrite, service_type), AV_OPT_TYPE_INT,
1899       { .i64 = 0x01 }, 0x01, 0xff, AV_OPT_FLAG_ENCODING_PARAM, "mpegts_service_type" },
1900     { "digital_tv", "Digital Television.",
1901       0, AV_OPT_TYPE_CONST, { .i64 = MPEGTS_SERVICE_TYPE_DIGITAL_TV }, 0x01, 0xff,
1902       AV_OPT_FLAG_ENCODING_PARAM, "mpegts_service_type" },
1903     { "digital_radio", "Digital Radio.",
1904       0, AV_OPT_TYPE_CONST, { .i64 = MPEGTS_SERVICE_TYPE_DIGITAL_RADIO }, 0x01, 0xff,
1905       AV_OPT_FLAG_ENCODING_PARAM, "mpegts_service_type" },
1906     { "teletext", "Teletext.",
1907       0, AV_OPT_TYPE_CONST, { .i64 = MPEGTS_SERVICE_TYPE_TELETEXT }, 0x01, 0xff,
1908       AV_OPT_FLAG_ENCODING_PARAM, "mpegts_service_type" },
1909     { "advanced_codec_digital_radio", "Advanced Codec Digital Radio.",
1910       0, AV_OPT_TYPE_CONST, { .i64 = MPEGTS_SERVICE_TYPE_ADVANCED_CODEC_DIGITAL_RADIO }, 0x01, 0xff,
1911       AV_OPT_FLAG_ENCODING_PARAM, "mpegts_service_type" },
1912     { "mpeg2_digital_hdtv", "MPEG2 Digital HDTV.",
1913       0, AV_OPT_TYPE_CONST, { .i64 = MPEGTS_SERVICE_TYPE_MPEG2_DIGITAL_HDTV }, 0x01, 0xff,
1914       AV_OPT_FLAG_ENCODING_PARAM, "mpegts_service_type" },
1915     { "advanced_codec_digital_sdtv", "Advanced Codec Digital SDTV.",
1916       0, AV_OPT_TYPE_CONST, { .i64 = MPEGTS_SERVICE_TYPE_ADVANCED_CODEC_DIGITAL_SDTV }, 0x01, 0xff,
1917       AV_OPT_FLAG_ENCODING_PARAM, "mpegts_service_type" },
1918     { "advanced_codec_digital_hdtv", "Advanced Codec Digital HDTV.",
1919       0, AV_OPT_TYPE_CONST, { .i64 = MPEGTS_SERVICE_TYPE_ADVANCED_CODEC_DIGITAL_HDTV }, 0x01, 0xff,
1920       AV_OPT_FLAG_ENCODING_PARAM, "mpegts_service_type" },
1921     { "hevc_digital_hdtv", "HEVC Digital Television Service.",
1922       0, AV_OPT_TYPE_CONST, { .i64 = MPEGTS_SERVICE_TYPE_HEVC_DIGITAL_HDTV }, 0x01, 0xff,
1923       AV_OPT_FLAG_ENCODING_PARAM, "mpegts_service_type" },
1924     { "mpegts_pmt_start_pid", "Set the first pid of the PMT.",
1925       offsetof(MpegTSWrite, pmt_start_pid), AV_OPT_TYPE_INT,
1926       { .i64 = 0x1000 }, 0x0010, 0x1f00, AV_OPT_FLAG_ENCODING_PARAM },
1927     { "mpegts_start_pid", "Set the first pid.",
1928       offsetof(MpegTSWrite, start_pid), AV_OPT_TYPE_INT,
1929       { .i64 = 0x0100 }, 0x0010, 0x0f00, AV_OPT_FLAG_ENCODING_PARAM },
1930     { "mpegts_m2ts_mode", "Enable m2ts mode.",
1931       offsetof(MpegTSWrite, m2ts_mode), AV_OPT_TYPE_BOOL,
1932       { .i64 = -1 }, -1, 1, AV_OPT_FLAG_ENCODING_PARAM },
1933     { "muxrate", NULL,
1934       offsetof(MpegTSWrite, mux_rate), AV_OPT_TYPE_INT,
1935       { .i64 = 1 }, 0, INT_MAX, AV_OPT_FLAG_ENCODING_PARAM },
1936     { "pes_payload_size", "Minimum PES packet payload in bytes",
1937       offsetof(MpegTSWrite, pes_payload_size), AV_OPT_TYPE_INT,
1938       { .i64 = DEFAULT_PES_PAYLOAD_SIZE }, 0, INT_MAX, AV_OPT_FLAG_ENCODING_PARAM },
1939     { "mpegts_flags", "MPEG-TS muxing flags",
1940       offsetof(MpegTSWrite, flags), AV_OPT_TYPE_FLAGS, { .i64 = 0 }, 0, INT_MAX,
1941       AV_OPT_FLAG_ENCODING_PARAM, "mpegts_flags" },
1942     { "resend_headers", "Reemit PAT/PMT before writing the next packet",
1943       0, AV_OPT_TYPE_CONST, { .i64 = MPEGTS_FLAG_REEMIT_PAT_PMT }, 0, INT_MAX,
1944       AV_OPT_FLAG_ENCODING_PARAM, "mpegts_flags" },
1945     { "latm", "Use LATM packetization for AAC",
1946       0, AV_OPT_TYPE_CONST, { .i64 = MPEGTS_FLAG_AAC_LATM }, 0, INT_MAX,
1947       AV_OPT_FLAG_ENCODING_PARAM, "mpegts_flags" },
1948     { "pat_pmt_at_frames", "Reemit PAT and PMT at each video frame",
1949       0, AV_OPT_TYPE_CONST, { .i64 = MPEGTS_FLAG_PAT_PMT_AT_FRAMES}, 0, INT_MAX,
1950       AV_OPT_FLAG_ENCODING_PARAM, "mpegts_flags" },
1951     { "system_b", "Conform to System B (DVB) instead of System A (ATSC)",
1952       0, AV_OPT_TYPE_CONST, { .i64 = MPEGTS_FLAG_SYSTEM_B }, 0, INT_MAX,
1953       AV_OPT_FLAG_ENCODING_PARAM, "mpegts_flags" },
1954     { "initial_discontinuity", "Mark initial packets as discontinuous",
1955       0, AV_OPT_TYPE_CONST, { .i64 = MPEGTS_FLAG_DISCONT }, 0, INT_MAX,
1956       AV_OPT_FLAG_ENCODING_PARAM, "mpegts_flags" },
1957     { "mpegts_copyts", "don't offset dts/pts",
1958       offsetof(MpegTSWrite, copyts), AV_OPT_TYPE_BOOL,
1959       { .i64 = -1 }, -1, 1, AV_OPT_FLAG_ENCODING_PARAM },
1960     { "tables_version", "set PAT, PMT and SDT version",
1961       offsetof(MpegTSWrite, tables_version), AV_OPT_TYPE_INT,
1962       { .i64 = 0 }, 0, 31, AV_OPT_FLAG_ENCODING_PARAM },
1963     { "omit_video_pes_length", "Omit the PES packet length for video packets",
1964       offsetof(MpegTSWrite, omit_video_pes_length), AV_OPT_TYPE_BOOL,
1965       { .i64 = 1 }, 0, 1, AV_OPT_FLAG_ENCODING_PARAM },
1966     { "pcr_period", "PCR retransmission time in milliseconds",
1967       offsetof(MpegTSWrite, pcr_period_ms), AV_OPT_TYPE_INT,
1968       { .i64 = -1 }, -1, INT_MAX, AV_OPT_FLAG_ENCODING_PARAM },
1969     { "pat_period", "PAT/PMT retransmission time limit in seconds",
1970       offsetof(MpegTSWrite, pat_period), AV_OPT_TYPE_DOUBLE,
1971       { .dbl = INT_MAX }, 0, INT_MAX, AV_OPT_FLAG_ENCODING_PARAM },
1972     { "sdt_period", "SDT retransmission time limit in seconds",
1973       offsetof(MpegTSWrite, sdt_period), AV_OPT_TYPE_DOUBLE,
1974       { .dbl = INT_MAX }, 0, INT_MAX, AV_OPT_FLAG_ENCODING_PARAM },
1975     { NULL },
1976 };
1977
1978 static const AVClass mpegts_muxer_class = {
1979     .class_name = "MPEGTS muxer",
1980     .item_name  = av_default_item_name,
1981     .option     = options,
1982     .version    = LIBAVUTIL_VERSION_INT,
1983 };
1984
1985 AVOutputFormat ff_mpegts_muxer = {
1986     .name           = "mpegts",
1987     .long_name      = NULL_IF_CONFIG_SMALL("MPEG-TS (MPEG-2 Transport Stream)"),
1988     .mime_type      = "video/MP2T",
1989     .extensions     = "ts,m2t,m2ts,mts",
1990     .priv_data_size = sizeof(MpegTSWrite),
1991     .audio_codec    = AV_CODEC_ID_MP2,
1992     .video_codec    = AV_CODEC_ID_MPEG2VIDEO,
1993     .init           = mpegts_init,
1994     .write_packet   = mpegts_write_packet,
1995     .write_trailer  = mpegts_write_end,
1996     .deinit         = mpegts_deinit,
1997     .check_bitstream = mpegts_check_bitstream,
1998     .flags          = AVFMT_ALLOW_FLUSH | AVFMT_VARIABLE_FPS | AVFMT_NODIMENSIONS,
1999     .priv_class     = &mpegts_muxer_class,
2000 };