Fix Ticket37
[ffmpeg.git] / libavformat / mpegts.c
1 /*
2  * MPEG2 transport stream (aka DVB) demuxer
3  * Copyright (c) 2002-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 //#define DEBUG
23 //#define DEBUG_SEEK
24 //#define USE_SYNCPOINT_SEARCH
25
26 #include "libavutil/crc.h"
27 #include "libavutil/intreadwrite.h"
28 #include "libavcodec/bytestream.h"
29 #include "avformat.h"
30 #include "mpegts.h"
31 #include "internal.h"
32 #include "avio_internal.h"
33 #include "seek.h"
34 #include "mpeg.h"
35 #include "isom.h"
36
37 /* maximum size in which we look for synchronisation if
38    synchronisation is lost */
39 #define MAX_RESYNC_SIZE 65536
40
41 #define MAX_PES_PAYLOAD 200*1024
42
43 enum MpegTSFilterType {
44     MPEGTS_PES,
45     MPEGTS_SECTION,
46 };
47
48 typedef struct MpegTSFilter MpegTSFilter;
49
50 typedef int PESCallback(MpegTSFilter *f, const uint8_t *buf, int len, int is_start, int64_t pos);
51
52 typedef struct MpegTSPESFilter {
53     PESCallback *pes_cb;
54     void *opaque;
55 } MpegTSPESFilter;
56
57 typedef void SectionCallback(MpegTSFilter *f, const uint8_t *buf, int len);
58
59 typedef void SetServiceCallback(void *opaque, int ret);
60
61 typedef struct MpegTSSectionFilter {
62     int section_index;
63     int section_h_size;
64     uint8_t *section_buf;
65     unsigned int check_crc:1;
66     unsigned int end_of_section_reached:1;
67     SectionCallback *section_cb;
68     void *opaque;
69 } MpegTSSectionFilter;
70
71 struct MpegTSFilter {
72     int pid;
73     int last_cc; /* last cc code (-1 if first packet) */
74     enum MpegTSFilterType type;
75     union {
76         MpegTSPESFilter pes_filter;
77         MpegTSSectionFilter section_filter;
78     } u;
79 };
80
81 #define MAX_PIDS_PER_PROGRAM 64
82 struct Program {
83     unsigned int id; //program id/service id
84     unsigned int nb_pids;
85     unsigned int pids[MAX_PIDS_PER_PROGRAM];
86 };
87
88 struct MpegTSContext {
89     /* user data */
90     AVFormatContext *stream;
91     /** raw packet size, including FEC if present            */
92     int raw_packet_size;
93
94     int pos47;
95
96     /** if true, all pids are analyzed to find streams       */
97     int auto_guess;
98
99     /** compute exact PCR for each transport stream packet   */
100     int mpeg2ts_compute_pcr;
101
102     int64_t cur_pcr;    /**< used to estimate the exact PCR  */
103     int pcr_incr;       /**< used to estimate the exact PCR  */
104
105     /* data needed to handle file based ts */
106     /** stop parsing loop                                    */
107     int stop_parse;
108     /** packet containing Audio/Video data                   */
109     AVPacket *pkt;
110     /** to detect seek                                       */
111     int64_t last_pos;
112
113     /******************************************/
114     /* private mpegts data */
115     /* scan context */
116     /** structure to keep track of Program->pids mapping     */
117     unsigned int nb_prg;
118     struct Program *prg;
119
120
121     /** filters for various streams specified by PMT + for the PAT and PMT */
122     MpegTSFilter *pids[NB_PID_MAX];
123 };
124
125 /* TS stream handling */
126
127 enum MpegTSState {
128     MPEGTS_HEADER = 0,
129     MPEGTS_PESHEADER,
130     MPEGTS_PESHEADER_FILL,
131     MPEGTS_PAYLOAD,
132     MPEGTS_SKIP,
133 };
134
135 /* enough for PES header + length */
136 #define PES_START_SIZE  6
137 #define PES_HEADER_SIZE 9
138 #define MAX_PES_HEADER_SIZE (9 + 255)
139
140 typedef struct PESContext {
141     int pid;
142     int pcr_pid; /**< if -1 then all packets containing PCR are considered */
143     int stream_type;
144     MpegTSContext *ts;
145     AVFormatContext *stream;
146     AVStream *st;
147     AVStream *sub_st; /**< stream for the embedded AC3 stream in HDMV TrueHD */
148     enum MpegTSState state;
149     /* used to get the format */
150     int data_index;
151     int total_size;
152     int pes_header_size;
153     int extended_stream_id;
154     int64_t pts, dts;
155     int64_t ts_packet_pos; /**< position of first TS packet of this PES packet */
156     uint8_t header[MAX_PES_HEADER_SIZE];
157     uint8_t *buffer;
158 } PESContext;
159
160 extern AVInputFormat ff_mpegts_demuxer;
161
162 static void clear_program(MpegTSContext *ts, unsigned int programid)
163 {
164     int i;
165
166     for(i=0; i<ts->nb_prg; i++)
167         if(ts->prg[i].id == programid)
168             ts->prg[i].nb_pids = 0;
169 }
170
171 static void clear_programs(MpegTSContext *ts)
172 {
173     av_freep(&ts->prg);
174     ts->nb_prg=0;
175 }
176
177 static void add_pat_entry(MpegTSContext *ts, unsigned int programid)
178 {
179     struct Program *p;
180     void *tmp = av_realloc(ts->prg, (ts->nb_prg+1)*sizeof(struct Program));
181     if(!tmp)
182         return;
183     ts->prg = tmp;
184     p = &ts->prg[ts->nb_prg];
185     p->id = programid;
186     p->nb_pids = 0;
187     ts->nb_prg++;
188 }
189
190 static void add_pid_to_pmt(MpegTSContext *ts, unsigned int programid, unsigned int pid)
191 {
192     int i;
193     struct Program *p = NULL;
194     for(i=0; i<ts->nb_prg; i++) {
195         if(ts->prg[i].id == programid) {
196             p = &ts->prg[i];
197             break;
198         }
199     }
200     if(!p)
201         return;
202
203     if(p->nb_pids >= MAX_PIDS_PER_PROGRAM)
204         return;
205     p->pids[p->nb_pids++] = pid;
206 }
207
208 /**
209  * \brief discard_pid() decides if the pid is to be discarded according
210  *                      to caller's programs selection
211  * \param ts    : - TS context
212  * \param pid   : - pid
213  * \return 1 if the pid is only comprised in programs that have .discard=AVDISCARD_ALL
214  *         0 otherwise
215  */
216 static int discard_pid(MpegTSContext *ts, unsigned int pid)
217 {
218     int i, j, k;
219     int used = 0, discarded = 0;
220     struct Program *p;
221     for(i=0; i<ts->nb_prg; i++) {
222         p = &ts->prg[i];
223         for(j=0; j<p->nb_pids; j++) {
224             if(p->pids[j] != pid)
225                 continue;
226             //is program with id p->id set to be discarded?
227             for(k=0; k<ts->stream->nb_programs; k++) {
228                 if(ts->stream->programs[k]->id == p->id) {
229                     if(ts->stream->programs[k]->discard == AVDISCARD_ALL)
230                         discarded++;
231                     else
232                         used++;
233                 }
234             }
235         }
236     }
237
238     return !used && discarded;
239 }
240
241 /**
242  *  Assemble PES packets out of TS packets, and then call the "section_cb"
243  *  function when they are complete.
244  */
245 static void write_section_data(AVFormatContext *s, MpegTSFilter *tss1,
246                                const uint8_t *buf, int buf_size, int is_start)
247 {
248     MpegTSSectionFilter *tss = &tss1->u.section_filter;
249     int len;
250
251     if (is_start) {
252         memcpy(tss->section_buf, buf, buf_size);
253         tss->section_index = buf_size;
254         tss->section_h_size = -1;
255         tss->end_of_section_reached = 0;
256     } else {
257         if (tss->end_of_section_reached)
258             return;
259         len = 4096 - tss->section_index;
260         if (buf_size < len)
261             len = buf_size;
262         memcpy(tss->section_buf + tss->section_index, buf, len);
263         tss->section_index += len;
264     }
265
266     /* compute section length if possible */
267     if (tss->section_h_size == -1 && tss->section_index >= 3) {
268         len = (AV_RB16(tss->section_buf + 1) & 0xfff) + 3;
269         if (len > 4096)
270             return;
271         tss->section_h_size = len;
272     }
273
274     if (tss->section_h_size != -1 && tss->section_index >= tss->section_h_size) {
275         tss->end_of_section_reached = 1;
276         if (!tss->check_crc ||
277             av_crc(av_crc_get_table(AV_CRC_32_IEEE), -1,
278                    tss->section_buf, tss->section_h_size) == 0)
279             tss->section_cb(tss1, tss->section_buf, tss->section_h_size);
280     }
281 }
282
283 static MpegTSFilter *mpegts_open_section_filter(MpegTSContext *ts, unsigned int pid,
284                                          SectionCallback *section_cb, void *opaque,
285                                          int check_crc)
286
287 {
288     MpegTSFilter *filter;
289     MpegTSSectionFilter *sec;
290
291     av_dlog(ts->stream, "Filter: pid=0x%x\n", pid);
292
293     if (pid >= NB_PID_MAX || ts->pids[pid])
294         return NULL;
295     filter = av_mallocz(sizeof(MpegTSFilter));
296     if (!filter)
297         return NULL;
298     ts->pids[pid] = filter;
299     filter->type = MPEGTS_SECTION;
300     filter->pid = pid;
301     filter->last_cc = -1;
302     sec = &filter->u.section_filter;
303     sec->section_cb = section_cb;
304     sec->opaque = opaque;
305     sec->section_buf = av_malloc(MAX_SECTION_SIZE);
306     sec->check_crc = check_crc;
307     if (!sec->section_buf) {
308         av_free(filter);
309         return NULL;
310     }
311     return filter;
312 }
313
314 static MpegTSFilter *mpegts_open_pes_filter(MpegTSContext *ts, unsigned int pid,
315                                      PESCallback *pes_cb,
316                                      void *opaque)
317 {
318     MpegTSFilter *filter;
319     MpegTSPESFilter *pes;
320
321     if (pid >= NB_PID_MAX || ts->pids[pid])
322         return NULL;
323     filter = av_mallocz(sizeof(MpegTSFilter));
324     if (!filter)
325         return NULL;
326     ts->pids[pid] = filter;
327     filter->type = MPEGTS_PES;
328     filter->pid = pid;
329     filter->last_cc = -1;
330     pes = &filter->u.pes_filter;
331     pes->pes_cb = pes_cb;
332     pes->opaque = opaque;
333     return filter;
334 }
335
336 static void mpegts_close_filter(MpegTSContext *ts, MpegTSFilter *filter)
337 {
338     int pid;
339
340     pid = filter->pid;
341     if (filter->type == MPEGTS_SECTION)
342         av_freep(&filter->u.section_filter.section_buf);
343     else if (filter->type == MPEGTS_PES) {
344         PESContext *pes = filter->u.pes_filter.opaque;
345         av_freep(&pes->buffer);
346         /* referenced private data will be freed later in
347          * av_close_input_stream */
348         if (!((PESContext *)filter->u.pes_filter.opaque)->st) {
349             av_freep(&filter->u.pes_filter.opaque);
350         }
351     }
352
353     av_free(filter);
354     ts->pids[pid] = NULL;
355 }
356
357 static int analyze(const uint8_t *buf, int size, int packet_size, int *index){
358     int stat[TS_MAX_PACKET_SIZE];
359     int i;
360     int x=0;
361     int best_score=0;
362
363     memset(stat, 0, packet_size*sizeof(int));
364
365     for(x=i=0; i<size-3; i++){
366         if(buf[i] == 0x47 && !(buf[i+1] & 0x80) && (buf[i+3] & 0x30)){
367             stat[x]++;
368             if(stat[x] > best_score){
369                 best_score= stat[x];
370                 if(index) *index= x;
371             }
372         }
373
374         x++;
375         if(x == packet_size) x= 0;
376     }
377
378     return best_score;
379 }
380
381 /* autodetect fec presence. Must have at least 1024 bytes  */
382 static int get_packet_size(const uint8_t *buf, int size)
383 {
384     int score, fec_score, dvhs_score;
385
386     if (size < (TS_FEC_PACKET_SIZE * 5 + 1))
387         return -1;
388
389     score    = analyze(buf, size, TS_PACKET_SIZE, NULL);
390     dvhs_score    = analyze(buf, size, TS_DVHS_PACKET_SIZE, NULL);
391     fec_score= analyze(buf, size, TS_FEC_PACKET_SIZE, NULL);
392 //    av_log(NULL, AV_LOG_DEBUG, "score: %d, dvhs_score: %d, fec_score: %d \n", score, dvhs_score, fec_score);
393
394     if     (score > fec_score && score > dvhs_score) return TS_PACKET_SIZE;
395     else if(dvhs_score > score && dvhs_score > fec_score) return TS_DVHS_PACKET_SIZE;
396     else if(score < fec_score && dvhs_score < fec_score) return TS_FEC_PACKET_SIZE;
397     else                       return -1;
398 }
399
400 typedef struct SectionHeader {
401     uint8_t tid;
402     uint16_t id;
403     uint8_t version;
404     uint8_t sec_num;
405     uint8_t last_sec_num;
406 } SectionHeader;
407
408 static inline int get8(const uint8_t **pp, const uint8_t *p_end)
409 {
410     const uint8_t *p;
411     int c;
412
413     p = *pp;
414     if (p >= p_end)
415         return -1;
416     c = *p++;
417     *pp = p;
418     return c;
419 }
420
421 static inline int get16(const uint8_t **pp, const uint8_t *p_end)
422 {
423     const uint8_t *p;
424     int c;
425
426     p = *pp;
427     if ((p + 1) >= p_end)
428         return -1;
429     c = AV_RB16(p);
430     p += 2;
431     *pp = p;
432     return c;
433 }
434
435 /* read and allocate a DVB string preceeded by its length */
436 static char *getstr8(const uint8_t **pp, const uint8_t *p_end)
437 {
438     int len;
439     const uint8_t *p;
440     char *str;
441
442     p = *pp;
443     len = get8(&p, p_end);
444     if (len < 0)
445         return NULL;
446     if ((p + len) > p_end)
447         return NULL;
448     str = av_malloc(len + 1);
449     if (!str)
450         return NULL;
451     memcpy(str, p, len);
452     str[len] = '\0';
453     p += len;
454     *pp = p;
455     return str;
456 }
457
458 static int parse_section_header(SectionHeader *h,
459                                 const uint8_t **pp, const uint8_t *p_end)
460 {
461     int val;
462
463     val = get8(pp, p_end);
464     if (val < 0)
465         return -1;
466     h->tid = val;
467     *pp += 2;
468     val = get16(pp, p_end);
469     if (val < 0)
470         return -1;
471     h->id = val;
472     val = get8(pp, p_end);
473     if (val < 0)
474         return -1;
475     h->version = (val >> 1) & 0x1f;
476     val = get8(pp, p_end);
477     if (val < 0)
478         return -1;
479     h->sec_num = val;
480     val = get8(pp, p_end);
481     if (val < 0)
482         return -1;
483     h->last_sec_num = val;
484     return 0;
485 }
486
487 typedef struct {
488     uint32_t stream_type;
489     enum AVMediaType codec_type;
490     enum CodecID codec_id;
491 } StreamType;
492
493 static const StreamType ISO_types[] = {
494     { 0x01, AVMEDIA_TYPE_VIDEO, CODEC_ID_MPEG2VIDEO },
495     { 0x02, AVMEDIA_TYPE_VIDEO, CODEC_ID_MPEG2VIDEO },
496     { 0x03, AVMEDIA_TYPE_AUDIO,        CODEC_ID_MP3 },
497     { 0x04, AVMEDIA_TYPE_AUDIO,        CODEC_ID_MP3 },
498     { 0x0f, AVMEDIA_TYPE_AUDIO,        CODEC_ID_AAC },
499     { 0x10, AVMEDIA_TYPE_VIDEO,      CODEC_ID_MPEG4 },
500     { 0x11, AVMEDIA_TYPE_AUDIO,   CODEC_ID_AAC_LATM }, /* LATM syntax */
501     { 0x1b, AVMEDIA_TYPE_VIDEO,       CODEC_ID_H264 },
502     { 0xd1, AVMEDIA_TYPE_VIDEO,      CODEC_ID_DIRAC },
503     { 0xea, AVMEDIA_TYPE_VIDEO,        CODEC_ID_VC1 },
504     { 0 },
505 };
506
507 static const StreamType HDMV_types[] = {
508     { 0x80, AVMEDIA_TYPE_AUDIO, CODEC_ID_PCM_BLURAY },
509     { 0x81, AVMEDIA_TYPE_AUDIO, CODEC_ID_AC3 },
510     { 0x82, AVMEDIA_TYPE_AUDIO, CODEC_ID_DTS },
511     { 0x83, AVMEDIA_TYPE_AUDIO, CODEC_ID_TRUEHD },
512     { 0x84, AVMEDIA_TYPE_AUDIO, CODEC_ID_EAC3 },
513     { 0x90, AVMEDIA_TYPE_SUBTITLE, CODEC_ID_HDMV_PGS_SUBTITLE },
514     { 0 },
515 };
516
517 /* ATSC ? */
518 static const StreamType MISC_types[] = {
519     { 0x81, AVMEDIA_TYPE_AUDIO,   CODEC_ID_AC3 },
520     { 0x8a, AVMEDIA_TYPE_AUDIO,   CODEC_ID_DTS },
521     { 0 },
522 };
523
524 static const StreamType REGD_types[] = {
525     { MKTAG('d','r','a','c'), AVMEDIA_TYPE_VIDEO, CODEC_ID_DIRAC },
526     { MKTAG('A','C','-','3'), AVMEDIA_TYPE_AUDIO,   CODEC_ID_AC3 },
527     { 0 },
528 };
529
530 /* descriptor present */
531 static const StreamType DESC_types[] = {
532     { 0x6a, AVMEDIA_TYPE_AUDIO,             CODEC_ID_AC3 }, /* AC-3 descriptor */
533     { 0x7a, AVMEDIA_TYPE_AUDIO,            CODEC_ID_EAC3 }, /* E-AC-3 descriptor */
534     { 0x7b, AVMEDIA_TYPE_AUDIO,             CODEC_ID_DTS },
535     { 0x56, AVMEDIA_TYPE_SUBTITLE, CODEC_ID_DVB_TELETEXT },
536     { 0x59, AVMEDIA_TYPE_SUBTITLE, CODEC_ID_DVB_SUBTITLE }, /* subtitling descriptor */
537     { 0 },
538 };
539
540 static void mpegts_find_stream_type(AVStream *st,
541                                     uint32_t stream_type, const StreamType *types)
542 {
543     for (; types->stream_type; types++) {
544         if (stream_type == types->stream_type) {
545             st->codec->codec_type = types->codec_type;
546             st->codec->codec_id   = types->codec_id;
547             return;
548         }
549     }
550 }
551
552 static int mpegts_set_stream_info(AVStream *st, PESContext *pes,
553                                   uint32_t stream_type, uint32_t prog_reg_desc)
554 {
555     av_set_pts_info(st, 33, 1, 90000);
556     st->priv_data = pes;
557     st->codec->codec_type = AVMEDIA_TYPE_DATA;
558     st->codec->codec_id   = CODEC_ID_NONE;
559     st->need_parsing = AVSTREAM_PARSE_FULL;
560     pes->st = st;
561     pes->stream_type = stream_type;
562
563     av_log(pes->stream, AV_LOG_DEBUG,
564            "stream=%d stream_type=%x pid=%x prog_reg_desc=%.4s\n",
565            st->index, pes->stream_type, pes->pid, (char*)&prog_reg_desc);
566
567     st->codec->codec_tag = pes->stream_type;
568
569     mpegts_find_stream_type(st, pes->stream_type, ISO_types);
570     if (prog_reg_desc == AV_RL32("HDMV") &&
571         st->codec->codec_id == CODEC_ID_NONE) {
572         mpegts_find_stream_type(st, pes->stream_type, HDMV_types);
573         if (pes->stream_type == 0x83) {
574             // HDMV TrueHD streams also contain an AC3 coded version of the
575             // audio track - add a second stream for this
576             AVStream *sub_st;
577             // priv_data cannot be shared between streams
578             PESContext *sub_pes = av_malloc(sizeof(*sub_pes));
579             if (!sub_pes)
580                 return AVERROR(ENOMEM);
581             memcpy(sub_pes, pes, sizeof(*sub_pes));
582
583             sub_st = av_new_stream(pes->stream, pes->pid);
584             if (!sub_st) {
585                 av_free(sub_pes);
586                 return AVERROR(ENOMEM);
587             }
588
589             av_set_pts_info(sub_st, 33, 1, 90000);
590             sub_st->priv_data = sub_pes;
591             sub_st->codec->codec_type = AVMEDIA_TYPE_AUDIO;
592             sub_st->codec->codec_id   = CODEC_ID_AC3;
593             sub_st->need_parsing = AVSTREAM_PARSE_FULL;
594             sub_pes->sub_st = pes->sub_st = sub_st;
595         }
596     }
597     if (st->codec->codec_id == CODEC_ID_NONE)
598         mpegts_find_stream_type(st, pes->stream_type, MISC_types);
599
600     return 0;
601 }
602
603 static void new_pes_packet(PESContext *pes, AVPacket *pkt)
604 {
605     av_init_packet(pkt);
606
607     pkt->destruct = av_destruct_packet;
608     pkt->data = pes->buffer;
609     pkt->size = pes->data_index;
610     memset(pkt->data+pkt->size, 0, FF_INPUT_BUFFER_PADDING_SIZE);
611
612     // Separate out the AC3 substream from an HDMV combined TrueHD/AC3 PID
613     if (pes->sub_st && pes->stream_type == 0x83 && pes->extended_stream_id == 0x76)
614         pkt->stream_index = pes->sub_st->index;
615     else
616         pkt->stream_index = pes->st->index;
617     pkt->pts = pes->pts;
618     pkt->dts = pes->dts;
619     /* store position of first TS packet of this PES packet */
620     pkt->pos = pes->ts_packet_pos;
621
622     /* reset pts values */
623     pes->pts = AV_NOPTS_VALUE;
624     pes->dts = AV_NOPTS_VALUE;
625     pes->buffer = NULL;
626     pes->data_index = 0;
627 }
628
629 /* return non zero if a packet could be constructed */
630 static int mpegts_push_data(MpegTSFilter *filter,
631                             const uint8_t *buf, int buf_size, int is_start,
632                             int64_t pos)
633 {
634     PESContext *pes = filter->u.pes_filter.opaque;
635     MpegTSContext *ts = pes->ts;
636     const uint8_t *p;
637     int len, code;
638
639     if(!ts->pkt)
640         return 0;
641
642     if (is_start) {
643         if (pes->state == MPEGTS_PAYLOAD && pes->data_index > 0) {
644             new_pes_packet(pes, ts->pkt);
645             ts->stop_parse = 1;
646         }
647         pes->state = MPEGTS_HEADER;
648         pes->data_index = 0;
649         pes->ts_packet_pos = pos;
650     }
651     p = buf;
652     while (buf_size > 0) {
653         switch(pes->state) {
654         case MPEGTS_HEADER:
655             len = PES_START_SIZE - pes->data_index;
656             if (len > buf_size)
657                 len = buf_size;
658             memcpy(pes->header + pes->data_index, p, len);
659             pes->data_index += len;
660             p += len;
661             buf_size -= len;
662             if (pes->data_index == PES_START_SIZE) {
663                 /* we got all the PES or section header. We can now
664                    decide */
665 #if 0
666                 av_hex_dump_log(pes->stream, AV_LOG_DEBUG, pes->header, pes->data_index);
667 #endif
668                 if (pes->header[0] == 0x00 && pes->header[1] == 0x00 &&
669                     pes->header[2] == 0x01) {
670                     /* it must be an mpeg2 PES stream */
671                     code = pes->header[3] | 0x100;
672                     av_dlog(pes->stream, "pid=%x pes_code=%#x\n", pes->pid, code);
673
674                     if ((pes->st && pes->st->discard == AVDISCARD_ALL) ||
675                         code == 0x1be) /* padding_stream */
676                         goto skip;
677
678 #if FF_API_MAX_STREAMS
679                     if (!pes->st && pes->stream->nb_streams == MAX_STREAMS)
680                         goto skip;
681 #endif
682
683                     /* stream not present in PMT */
684                     if (!pes->st) {
685                         pes->st = av_new_stream(ts->stream, pes->pid);
686                         if (!pes->st)
687                             return AVERROR(ENOMEM);
688                         mpegts_set_stream_info(pes->st, pes, 0, 0);
689                     }
690
691                     pes->total_size = AV_RB16(pes->header + 4);
692                     /* NOTE: a zero total size means the PES size is
693                        unbounded */
694                     if (!pes->total_size)
695                         pes->total_size = MAX_PES_PAYLOAD;
696
697                     /* allocate pes buffer */
698                     pes->buffer = av_malloc(pes->total_size+FF_INPUT_BUFFER_PADDING_SIZE);
699                     if (!pes->buffer)
700                         return AVERROR(ENOMEM);
701
702                     if (code != 0x1bc && code != 0x1bf && /* program_stream_map, private_stream_2 */
703                         code != 0x1f0 && code != 0x1f1 && /* ECM, EMM */
704                         code != 0x1ff && code != 0x1f2 && /* program_stream_directory, DSMCC_stream */
705                         code != 0x1f8) {                  /* ITU-T Rec. H.222.1 type E stream */
706                         pes->state = MPEGTS_PESHEADER;
707                         if (pes->st->codec->codec_id == CODEC_ID_NONE && !pes->st->request_probe) {
708                             av_dlog(pes->stream, "pid=%x stream_type=%x probing\n",
709                                     pes->pid, pes->stream_type);
710                             pes->st->request_probe= 1;
711                         }
712                     } else {
713                         pes->state = MPEGTS_PAYLOAD;
714                         pes->data_index = 0;
715                     }
716                 } else {
717                     /* otherwise, it should be a table */
718                     /* skip packet */
719                 skip:
720                     pes->state = MPEGTS_SKIP;
721                     continue;
722                 }
723             }
724             break;
725             /**********************************************/
726             /* PES packing parsing */
727         case MPEGTS_PESHEADER:
728             len = PES_HEADER_SIZE - pes->data_index;
729             if (len < 0)
730                 return -1;
731             if (len > buf_size)
732                 len = buf_size;
733             memcpy(pes->header + pes->data_index, p, len);
734             pes->data_index += len;
735             p += len;
736             buf_size -= len;
737             if (pes->data_index == PES_HEADER_SIZE) {
738                 pes->pes_header_size = pes->header[8] + 9;
739                 pes->state = MPEGTS_PESHEADER_FILL;
740             }
741             break;
742         case MPEGTS_PESHEADER_FILL:
743             len = pes->pes_header_size - pes->data_index;
744             if (len < 0)
745                 return -1;
746             if (len > buf_size)
747                 len = buf_size;
748             memcpy(pes->header + pes->data_index, p, len);
749             pes->data_index += len;
750             p += len;
751             buf_size -= len;
752             if (pes->data_index == pes->pes_header_size) {
753                 const uint8_t *r;
754                 unsigned int flags, pes_ext, skip;
755
756                 flags = pes->header[7];
757                 r = pes->header + 9;
758                 pes->pts = AV_NOPTS_VALUE;
759                 pes->dts = AV_NOPTS_VALUE;
760                 if ((flags & 0xc0) == 0x80) {
761                     pes->dts = pes->pts = ff_parse_pes_pts(r);
762                     r += 5;
763                 } else if ((flags & 0xc0) == 0xc0) {
764                     pes->pts = ff_parse_pes_pts(r);
765                     r += 5;
766                     pes->dts = ff_parse_pes_pts(r);
767                     r += 5;
768                 }
769                 pes->extended_stream_id = -1;
770                 if (flags & 0x01) { /* PES extension */
771                     pes_ext = *r++;
772                     /* Skip PES private data, program packet sequence counter and P-STD buffer */
773                     skip = (pes_ext >> 4) & 0xb;
774                     skip += skip & 0x9;
775                     r += skip;
776                     if ((pes_ext & 0x41) == 0x01 &&
777                         (r + 2) <= (pes->header + pes->pes_header_size)) {
778                         /* PES extension 2 */
779                         if ((r[0] & 0x7f) > 0 && (r[1] & 0x80) == 0)
780                             pes->extended_stream_id = r[1];
781                     }
782                 }
783
784                 /* we got the full header. We parse it and get the payload */
785                 pes->state = MPEGTS_PAYLOAD;
786                 pes->data_index = 0;
787             }
788             break;
789         case MPEGTS_PAYLOAD:
790             if (buf_size > 0 && pes->buffer) {
791                 if (pes->data_index > 0 && pes->data_index+buf_size > pes->total_size) {
792                     new_pes_packet(pes, ts->pkt);
793                     pes->total_size = MAX_PES_PAYLOAD;
794                     pes->buffer = av_malloc(pes->total_size+FF_INPUT_BUFFER_PADDING_SIZE);
795                     if (!pes->buffer)
796                         return AVERROR(ENOMEM);
797                     ts->stop_parse = 1;
798                 } else if (pes->data_index == 0 && buf_size > pes->total_size) {
799                     // pes packet size is < ts size packet and pes data is padded with 0xff
800                     // not sure if this is legal in ts but see issue #2392
801                     buf_size = pes->total_size;
802                 }
803                 memcpy(pes->buffer+pes->data_index, p, buf_size);
804                 pes->data_index += buf_size;
805             }
806             buf_size = 0;
807             /* emit complete packets with known packet size
808              * decreases demuxer delay for infrequent packets like subtitles from
809              * a couple of seconds to milliseconds for properly muxed files.
810              * total_size is the number of bytes following pes_packet_length
811              * in the pes header, i.e. not counting the first 6 bytes */
812             if (!ts->stop_parse && pes->total_size < MAX_PES_PAYLOAD &&
813                 pes->pes_header_size + pes->data_index == pes->total_size + 6) {
814                 ts->stop_parse = 1;
815                 new_pes_packet(pes, ts->pkt);
816             }
817             break;
818         case MPEGTS_SKIP:
819             buf_size = 0;
820             break;
821         }
822     }
823
824     return 0;
825 }
826
827 static PESContext *add_pes_stream(MpegTSContext *ts, int pid, int pcr_pid)
828 {
829     MpegTSFilter *tss;
830     PESContext *pes;
831
832     /* if no pid found, then add a pid context */
833     pes = av_mallocz(sizeof(PESContext));
834     if (!pes)
835         return 0;
836     pes->ts = ts;
837     pes->stream = ts->stream;
838     pes->pid = pid;
839     pes->pcr_pid = pcr_pid;
840     pes->state = MPEGTS_SKIP;
841     pes->pts = AV_NOPTS_VALUE;
842     pes->dts = AV_NOPTS_VALUE;
843     tss = mpegts_open_pes_filter(ts, pid, mpegts_push_data, pes);
844     if (!tss) {
845         av_free(pes);
846         return 0;
847     }
848     return pes;
849 }
850
851 static int mp4_read_iods(AVFormatContext *s, const uint8_t *buf, unsigned size,
852                          int *es_id, uint8_t **dec_config_descr,
853                          int *dec_config_descr_size)
854 {
855     AVIOContext pb;
856     int tag;
857     unsigned len;
858
859     ffio_init_context(&pb, buf, size, 0, NULL, NULL, NULL, NULL);
860
861     len = ff_mp4_read_descr(s, &pb, &tag);
862     if (tag == MP4IODescrTag) {
863         avio_rb16(&pb); // ID
864         avio_r8(&pb);
865         avio_r8(&pb);
866         avio_r8(&pb);
867         avio_r8(&pb);
868         avio_r8(&pb);
869         len = ff_mp4_read_descr(s, &pb, &tag);
870         if (tag == MP4ESDescrTag) {
871             *es_id = avio_rb16(&pb); /* ES_ID */
872             av_dlog(s, "ES_ID %#x\n", *es_id);
873             avio_r8(&pb); /* priority */
874             len = ff_mp4_read_descr(s, &pb, &tag);
875             if (tag == MP4DecConfigDescrTag) {
876                 *dec_config_descr = av_malloc(len);
877                 if (!*dec_config_descr)
878                     return AVERROR(ENOMEM);
879                 *dec_config_descr_size = len;
880                 avio_read(&pb, *dec_config_descr, len);
881             }
882         }
883     }
884     return 0;
885 }
886
887 int ff_parse_mpeg2_descriptor(AVFormatContext *fc, AVStream *st, int stream_type,
888                               const uint8_t **pp, const uint8_t *desc_list_end,
889                               int mp4_dec_config_descr_len, int mp4_es_id, int pid,
890                               uint8_t *mp4_dec_config_descr)
891 {
892     const uint8_t *desc_end;
893     int desc_len, desc_tag;
894     char language[252];
895     int i;
896
897     desc_tag = get8(pp, desc_list_end);
898     if (desc_tag < 0)
899         return -1;
900     desc_len = get8(pp, desc_list_end);
901     if (desc_len < 0)
902         return -1;
903     desc_end = *pp + desc_len;
904     if (desc_end > desc_list_end)
905         return -1;
906
907     av_dlog(fc, "tag: 0x%02x len=%d\n", desc_tag, desc_len);
908
909     if (st->codec->codec_id == CODEC_ID_NONE &&
910         stream_type == STREAM_TYPE_PRIVATE_DATA)
911         mpegts_find_stream_type(st, desc_tag, DESC_types);
912
913     switch(desc_tag) {
914     case 0x1F: /* FMC descriptor */
915         get16(pp, desc_end);
916         if (st->codec->codec_id == CODEC_ID_AAC_LATM &&
917             mp4_dec_config_descr_len && mp4_es_id == pid) {
918             AVIOContext pb;
919             ffio_init_context(&pb, mp4_dec_config_descr,
920                           mp4_dec_config_descr_len, 0, NULL, NULL, NULL, NULL);
921             ff_mp4_read_dec_config_descr(fc, st, &pb);
922             if (st->codec->codec_id == CODEC_ID_AAC &&
923                 st->codec->extradata_size > 0)
924                 st->need_parsing = 0;
925         }
926         break;
927     case 0x56: /* DVB teletext descriptor */
928         language[0] = get8(pp, desc_end);
929         language[1] = get8(pp, desc_end);
930         language[2] = get8(pp, desc_end);
931         language[3] = 0;
932         av_metadata_set2(&st->metadata, "language", language, 0);
933         break;
934     case 0x59: /* subtitling descriptor */
935         language[0] = get8(pp, desc_end);
936         language[1] = get8(pp, desc_end);
937         language[2] = get8(pp, desc_end);
938         language[3] = 0;
939         /* hearing impaired subtitles detection */
940         switch(get8(pp, desc_end)) {
941         case 0x20: /* DVB subtitles (for the hard of hearing) with no monitor aspect ratio criticality */
942         case 0x21: /* DVB subtitles (for the hard of hearing) for display on 4:3 aspect ratio monitor */
943         case 0x22: /* DVB subtitles (for the hard of hearing) for display on 16:9 aspect ratio monitor */
944         case 0x23: /* DVB subtitles (for the hard of hearing) for display on 2.21:1 aspect ratio monitor */
945         case 0x24: /* DVB subtitles (for the hard of hearing) for display on a high definition monitor */
946         case 0x25: /* DVB subtitles (for the hard of hearing) with plano-stereoscopic disparity for display on a high definition monitor */
947             st->disposition |= AV_DISPOSITION_HEARING_IMPAIRED;
948             break;
949         }
950         if (st->codec->extradata) {
951             if (st->codec->extradata_size == 4 && memcmp(st->codec->extradata, *pp, 4))
952                 av_log_ask_for_sample(fc, "DVB sub with multiple IDs\n");
953         } else {
954             st->codec->extradata = av_malloc(4 + FF_INPUT_BUFFER_PADDING_SIZE);
955             if (st->codec->extradata) {
956                 st->codec->extradata_size = 4;
957                 memcpy(st->codec->extradata, *pp, 4);
958             }
959         }
960         *pp += 4;
961         av_metadata_set2(&st->metadata, "language", language, 0);
962         break;
963     case 0x0a: /* ISO 639 language descriptor */
964         for (i = 0; i + 4 <= desc_len; i += 4) {
965             language[i + 0] = get8(pp, desc_end);
966             language[i + 1] = get8(pp, desc_end);
967             language[i + 2] = get8(pp, desc_end);
968             language[i + 3] = ',';
969         switch (get8(pp, desc_end)) {
970             case 0x01: st->disposition |= AV_DISPOSITION_CLEAN_EFFECTS; break;
971             case 0x02: st->disposition |= AV_DISPOSITION_HEARING_IMPAIRED; break;
972             case 0x03: st->disposition |= AV_DISPOSITION_VISUAL_IMPAIRED; break;
973         }
974         }
975         if (i) {
976             language[i - 1] = 0;
977             av_metadata_set2(&st->metadata, "language", language, 0);
978         }
979         break;
980     case 0x05: /* registration descriptor */
981         st->codec->codec_tag = bytestream_get_le32(pp);
982         av_dlog(fc, "reg_desc=%.4s\n", (char*)&st->codec->codec_tag);
983         if (st->codec->codec_id == CODEC_ID_NONE &&
984             stream_type == STREAM_TYPE_PRIVATE_DATA)
985             mpegts_find_stream_type(st, st->codec->codec_tag, REGD_types);
986         break;
987     default:
988         break;
989     }
990     *pp = desc_end;
991     return 0;
992 }
993
994 static void pmt_cb(MpegTSFilter *filter, const uint8_t *section, int section_len)
995 {
996     MpegTSContext *ts = filter->u.section_filter.opaque;
997     SectionHeader h1, *h = &h1;
998     PESContext *pes;
999     AVStream *st;
1000     const uint8_t *p, *p_end, *desc_list_end;
1001     int program_info_length, pcr_pid, pid, stream_type;
1002     int desc_list_len;
1003     uint32_t prog_reg_desc = 0; /* registration descriptor */
1004     uint8_t *mp4_dec_config_descr = NULL;
1005     int mp4_dec_config_descr_len = 0;
1006     int mp4_es_id = 0;
1007
1008 #ifdef DEBUG
1009     av_dlog(ts->stream, "PMT: len %i\n", section_len);
1010     av_hex_dump_log(ts->stream, AV_LOG_DEBUG, (uint8_t *)section, section_len);
1011 #endif
1012
1013     p_end = section + section_len - 4;
1014     p = section;
1015     if (parse_section_header(h, &p, p_end) < 0)
1016         return;
1017
1018     av_dlog(ts->stream, "sid=0x%x sec_num=%d/%d\n",
1019            h->id, h->sec_num, h->last_sec_num);
1020
1021     if (h->tid != PMT_TID)
1022         return;
1023
1024     clear_program(ts, h->id);
1025     pcr_pid = get16(&p, p_end) & 0x1fff;
1026     if (pcr_pid < 0)
1027         return;
1028     add_pid_to_pmt(ts, h->id, pcr_pid);
1029
1030     av_dlog(ts->stream, "pcr_pid=0x%x\n", pcr_pid);
1031
1032     program_info_length = get16(&p, p_end) & 0xfff;
1033     if (program_info_length < 0)
1034         return;
1035     while(program_info_length >= 2) {
1036         uint8_t tag, len;
1037         tag = get8(&p, p_end);
1038         len = get8(&p, p_end);
1039
1040         av_dlog(ts->stream, "program tag: 0x%02x len=%d\n", tag, len);
1041
1042         if(len > program_info_length - 2)
1043             //something else is broken, exit the program_descriptors_loop
1044             break;
1045         program_info_length -= len + 2;
1046         if (tag == 0x1d) { // IOD descriptor
1047             get8(&p, p_end); // scope
1048             get8(&p, p_end); // label
1049             len -= 2;
1050             mp4_read_iods(ts->stream, p, len, &mp4_es_id,
1051                           &mp4_dec_config_descr, &mp4_dec_config_descr_len);
1052         } else if (tag == 0x05 && len >= 4) { // registration descriptor
1053             prog_reg_desc = bytestream_get_le32(&p);
1054             len -= 4;
1055         }
1056         p += len;
1057     }
1058     p += program_info_length;
1059     if (p >= p_end)
1060         goto out;
1061
1062     // stop parsing after pmt, we found header
1063     if (!ts->stream->nb_streams)
1064         ts->stop_parse = 1;
1065
1066     for(;;) {
1067         st = 0;
1068         stream_type = get8(&p, p_end);
1069         if (stream_type < 0)
1070             break;
1071         pid = get16(&p, p_end) & 0x1fff;
1072         if (pid < 0)
1073             break;
1074
1075         /* now create ffmpeg stream */
1076         if (ts->pids[pid] && ts->pids[pid]->type == MPEGTS_PES) {
1077             pes = ts->pids[pid]->u.pes_filter.opaque;
1078             if (!pes->st)
1079                 pes->st = av_new_stream(pes->stream, pes->pid);
1080             st = pes->st;
1081         } else {
1082             if (ts->pids[pid]) mpegts_close_filter(ts, ts->pids[pid]); //wrongly added sdt filter probably
1083             pes = add_pes_stream(ts, pid, pcr_pid);
1084             if (pes)
1085                 st = av_new_stream(pes->stream, pes->pid);
1086         }
1087
1088         if (!st)
1089             goto out;
1090
1091         if (!pes->stream_type)
1092             mpegts_set_stream_info(st, pes, stream_type, prog_reg_desc);
1093
1094         add_pid_to_pmt(ts, h->id, pid);
1095
1096         ff_program_add_stream_index(ts->stream, h->id, st->index);
1097
1098         desc_list_len = get16(&p, p_end) & 0xfff;
1099         if (desc_list_len < 0)
1100             break;
1101         desc_list_end = p + desc_list_len;
1102         if (desc_list_end > p_end)
1103             break;
1104         for(;;) {
1105             if (ff_parse_mpeg2_descriptor(ts->stream, st, stream_type, &p, desc_list_end,
1106                 mp4_dec_config_descr_len, mp4_es_id, pid, mp4_dec_config_descr) < 0)
1107                 break;
1108
1109             if (prog_reg_desc == AV_RL32("HDMV") && stream_type == 0x83 && pes->sub_st) {
1110                 ff_program_add_stream_index(ts->stream, h->id, pes->sub_st->index);
1111                 pes->sub_st->codec->codec_tag = st->codec->codec_tag;
1112             }
1113         }
1114         p = desc_list_end;
1115     }
1116
1117  out:
1118     av_free(mp4_dec_config_descr);
1119 }
1120
1121 static void pat_cb(MpegTSFilter *filter, const uint8_t *section, int section_len)
1122 {
1123     MpegTSContext *ts = filter->u.section_filter.opaque;
1124     SectionHeader h1, *h = &h1;
1125     const uint8_t *p, *p_end;
1126     int sid, pmt_pid;
1127
1128 #ifdef DEBUG
1129     av_dlog(ts->stream, "PAT:\n");
1130     av_hex_dump_log(ts->stream, AV_LOG_DEBUG, (uint8_t *)section, section_len);
1131 #endif
1132     p_end = section + section_len - 4;
1133     p = section;
1134     if (parse_section_header(h, &p, p_end) < 0)
1135         return;
1136     if (h->tid != PAT_TID)
1137         return;
1138
1139     clear_programs(ts);
1140     for(;;) {
1141         sid = get16(&p, p_end);
1142         if (sid < 0)
1143             break;
1144         pmt_pid = get16(&p, p_end) & 0x1fff;
1145         if (pmt_pid < 0)
1146             break;
1147
1148         av_dlog(ts->stream, "sid=0x%x pid=0x%x\n", sid, pmt_pid);
1149
1150         if (sid == 0x0000) {
1151             /* NIT info */
1152         } else {
1153             av_new_program(ts->stream, sid);
1154             if (ts->pids[pmt_pid])
1155                 mpegts_close_filter(ts, ts->pids[pmt_pid]);
1156             mpegts_open_section_filter(ts, pmt_pid, pmt_cb, ts, 1);
1157             add_pat_entry(ts, sid);
1158             add_pid_to_pmt(ts, sid, 0); //add pat pid to program
1159             add_pid_to_pmt(ts, sid, pmt_pid);
1160         }
1161     }
1162 }
1163
1164 static void sdt_cb(MpegTSFilter *filter, const uint8_t *section, int section_len)
1165 {
1166     MpegTSContext *ts = filter->u.section_filter.opaque;
1167     SectionHeader h1, *h = &h1;
1168     const uint8_t *p, *p_end, *desc_list_end, *desc_end;
1169     int onid, val, sid, desc_list_len, desc_tag, desc_len, service_type;
1170     char *name, *provider_name;
1171
1172 #ifdef DEBUG
1173     av_dlog(ts->stream, "SDT:\n");
1174     av_hex_dump_log(ts->stream, AV_LOG_DEBUG, (uint8_t *)section, section_len);
1175 #endif
1176
1177     p_end = section + section_len - 4;
1178     p = section;
1179     if (parse_section_header(h, &p, p_end) < 0)
1180         return;
1181     if (h->tid != SDT_TID)
1182         return;
1183     onid = get16(&p, p_end);
1184     if (onid < 0)
1185         return;
1186     val = get8(&p, p_end);
1187     if (val < 0)
1188         return;
1189     for(;;) {
1190         sid = get16(&p, p_end);
1191         if (sid < 0)
1192             break;
1193         val = get8(&p, p_end);
1194         if (val < 0)
1195             break;
1196         desc_list_len = get16(&p, p_end) & 0xfff;
1197         if (desc_list_len < 0)
1198             break;
1199         desc_list_end = p + desc_list_len;
1200         if (desc_list_end > p_end)
1201             break;
1202         for(;;) {
1203             desc_tag = get8(&p, desc_list_end);
1204             if (desc_tag < 0)
1205                 break;
1206             desc_len = get8(&p, desc_list_end);
1207             desc_end = p + desc_len;
1208             if (desc_end > desc_list_end)
1209                 break;
1210
1211             av_dlog(ts->stream, "tag: 0x%02x len=%d\n",
1212                    desc_tag, desc_len);
1213
1214             switch(desc_tag) {
1215             case 0x48:
1216                 service_type = get8(&p, p_end);
1217                 if (service_type < 0)
1218                     break;
1219                 provider_name = getstr8(&p, p_end);
1220                 if (!provider_name)
1221                     break;
1222                 name = getstr8(&p, p_end);
1223                 if (name) {
1224                     AVProgram *program = av_new_program(ts->stream, sid);
1225                     if(program) {
1226                         av_metadata_set2(&program->metadata, "service_name", name, 0);
1227                         av_metadata_set2(&program->metadata, "service_provider", provider_name, 0);
1228                     }
1229                 }
1230                 av_free(name);
1231                 av_free(provider_name);
1232                 break;
1233             default:
1234                 break;
1235             }
1236             p = desc_end;
1237         }
1238         p = desc_list_end;
1239     }
1240 }
1241
1242 /* handle one TS packet */
1243 static int handle_packet(MpegTSContext *ts, const uint8_t *packet)
1244 {
1245     AVFormatContext *s = ts->stream;
1246     MpegTSFilter *tss;
1247     int len, pid, cc, cc_ok, afc, is_start;
1248     const uint8_t *p, *p_end;
1249     int64_t pos;
1250
1251     pid = AV_RB16(packet + 1) & 0x1fff;
1252     if(pid && discard_pid(ts, pid))
1253         return 0;
1254     is_start = packet[1] & 0x40;
1255     tss = ts->pids[pid];
1256     if (ts->auto_guess && tss == NULL && is_start) {
1257         add_pes_stream(ts, pid, -1);
1258         tss = ts->pids[pid];
1259     }
1260     if (!tss)
1261         return 0;
1262
1263     /* continuity check (currently not used) */
1264     cc = (packet[3] & 0xf);
1265     cc_ok = (tss->last_cc < 0) || ((((tss->last_cc + 1) & 0x0f) == cc));
1266     tss->last_cc = cc;
1267
1268     /* skip adaptation field */
1269     afc = (packet[3] >> 4) & 3;
1270     p = packet + 4;
1271     if (afc == 0) /* reserved value */
1272         return 0;
1273     if (afc == 2) /* adaptation field only */
1274         return 0;
1275     if (afc == 3) {
1276         /* skip adapation field */
1277         p += p[0] + 1;
1278     }
1279     /* if past the end of packet, ignore */
1280     p_end = packet + TS_PACKET_SIZE;
1281     if (p >= p_end)
1282         return 0;
1283
1284     pos = avio_tell(ts->stream->pb);
1285     ts->pos47= pos % ts->raw_packet_size;
1286
1287     if (tss->type == MPEGTS_SECTION) {
1288         if (is_start) {
1289             /* pointer field present */
1290             len = *p++;
1291             if (p + len > p_end)
1292                 return 0;
1293             if (len && cc_ok) {
1294                 /* write remaining section bytes */
1295                 write_section_data(s, tss,
1296                                    p, len, 0);
1297                 /* check whether filter has been closed */
1298                 if (!ts->pids[pid])
1299                     return 0;
1300             }
1301             p += len;
1302             if (p < p_end) {
1303                 write_section_data(s, tss,
1304                                    p, p_end - p, 1);
1305             }
1306         } else {
1307             if (cc_ok) {
1308                 write_section_data(s, tss,
1309                                    p, p_end - p, 0);
1310             }
1311         }
1312     } else {
1313         int ret;
1314         // Note: The position here points actually behind the current packet.
1315         if ((ret = tss->u.pes_filter.pes_cb(tss, p, p_end - p, is_start,
1316                                             pos - ts->raw_packet_size)) < 0)
1317             return ret;
1318     }
1319
1320     return 0;
1321 }
1322
1323 /* XXX: try to find a better synchro over several packets (use
1324    get_packet_size() ?) */
1325 static int mpegts_resync(AVFormatContext *s)
1326 {
1327     AVIOContext *pb = s->pb;
1328     int c, i;
1329
1330     for(i = 0;i < MAX_RESYNC_SIZE; i++) {
1331         c = avio_r8(pb);
1332         if (url_feof(pb))
1333             return -1;
1334         if (c == 0x47) {
1335             avio_seek(pb, -1, SEEK_CUR);
1336             return 0;
1337         }
1338     }
1339     av_log(s, AV_LOG_ERROR, "max resync size reached, could not find sync byte\n");
1340     /* no sync found */
1341     return -1;
1342 }
1343
1344 /* return -1 if error or EOF. Return 0 if OK. */
1345 static int read_packet(AVFormatContext *s, uint8_t *buf, int raw_packet_size)
1346 {
1347     AVIOContext *pb = s->pb;
1348     int skip, len;
1349
1350     for(;;) {
1351         len = avio_read(pb, buf, TS_PACKET_SIZE);
1352         if (len != TS_PACKET_SIZE)
1353             return len < 0 ? len : AVERROR_EOF;
1354         /* check paquet sync byte */
1355         if (buf[0] != 0x47) {
1356             /* find a new packet start */
1357             avio_seek(pb, -TS_PACKET_SIZE, SEEK_CUR);
1358             if (mpegts_resync(s) < 0)
1359                 return AVERROR(EAGAIN);
1360             else
1361                 continue;
1362         } else {
1363             skip = raw_packet_size - TS_PACKET_SIZE;
1364             if (skip > 0)
1365                 avio_skip(pb, skip);
1366             break;
1367         }
1368     }
1369     return 0;
1370 }
1371
1372 static int handle_packets(MpegTSContext *ts, int nb_packets)
1373 {
1374     AVFormatContext *s = ts->stream;
1375     uint8_t packet[TS_PACKET_SIZE];
1376     int packet_num, ret;
1377
1378     ts->stop_parse = 0;
1379     packet_num = 0;
1380     for(;;) {
1381         if (ts->stop_parse>0)
1382             break;
1383         packet_num++;
1384         if (nb_packets != 0 && packet_num >= nb_packets)
1385             break;
1386         ret = read_packet(s, packet, ts->raw_packet_size);
1387         if (ret != 0)
1388             return ret;
1389         ret = handle_packet(ts, packet);
1390         if (ret != 0)
1391             return ret;
1392     }
1393     return 0;
1394 }
1395
1396 static int mpegts_probe(AVProbeData *p)
1397 {
1398 #if 1
1399     const int size= p->buf_size;
1400     int score, fec_score, dvhs_score;
1401     int check_count= size / TS_FEC_PACKET_SIZE;
1402 #define CHECK_COUNT 10
1403
1404     if (check_count < CHECK_COUNT)
1405         return -1;
1406
1407     score     = analyze(p->buf, TS_PACKET_SIZE     *check_count, TS_PACKET_SIZE     , NULL)*CHECK_COUNT/check_count;
1408     dvhs_score= analyze(p->buf, TS_DVHS_PACKET_SIZE*check_count, TS_DVHS_PACKET_SIZE, NULL)*CHECK_COUNT/check_count;
1409     fec_score = analyze(p->buf, TS_FEC_PACKET_SIZE *check_count, TS_FEC_PACKET_SIZE , NULL)*CHECK_COUNT/check_count;
1410 //    av_log(NULL, AV_LOG_DEBUG, "score: %d, dvhs_score: %d, fec_score: %d \n", score, dvhs_score, fec_score);
1411
1412 // we need a clear definition for the returned score otherwise things will become messy sooner or later
1413     if     (score > fec_score && score > dvhs_score && score > 6) return AVPROBE_SCORE_MAX + score     - CHECK_COUNT;
1414     else if(dvhs_score > score && dvhs_score > fec_score && dvhs_score > 6) return AVPROBE_SCORE_MAX + dvhs_score  - CHECK_COUNT;
1415     else if(                 fec_score > 6) return AVPROBE_SCORE_MAX + fec_score - CHECK_COUNT;
1416     else                                    return -1;
1417 #else
1418     /* only use the extension for safer guess */
1419     if (av_match_ext(p->filename, "ts"))
1420         return AVPROBE_SCORE_MAX;
1421     else
1422         return 0;
1423 #endif
1424 }
1425
1426 /* return the 90kHz PCR and the extension for the 27MHz PCR. return
1427    (-1) if not available */
1428 static int parse_pcr(int64_t *ppcr_high, int *ppcr_low,
1429                      const uint8_t *packet)
1430 {
1431     int afc, len, flags;
1432     const uint8_t *p;
1433     unsigned int v;
1434
1435     afc = (packet[3] >> 4) & 3;
1436     if (afc <= 1)
1437         return -1;
1438     p = packet + 4;
1439     len = p[0];
1440     p++;
1441     if (len == 0)
1442         return -1;
1443     flags = *p++;
1444     len--;
1445     if (!(flags & 0x10))
1446         return -1;
1447     if (len < 6)
1448         return -1;
1449     v = AV_RB32(p);
1450     *ppcr_high = ((int64_t)v << 1) | (p[4] >> 7);
1451     *ppcr_low = ((p[4] & 1) << 8) | p[5];
1452     return 0;
1453 }
1454
1455 static int mpegts_read_header(AVFormatContext *s,
1456                               AVFormatParameters *ap)
1457 {
1458     MpegTSContext *ts = s->priv_data;
1459     AVIOContext *pb = s->pb;
1460     uint8_t buf[5*1024];
1461     int len;
1462     int64_t pos;
1463
1464     if (ap) {
1465         ts->mpeg2ts_compute_pcr = ap->mpeg2ts_compute_pcr;
1466         if(ap->mpeg2ts_raw){
1467             av_log(s, AV_LOG_ERROR, "use mpegtsraw_demuxer!\n");
1468             return -1;
1469         }
1470     }
1471
1472     /* read the first 1024 bytes to get packet size */
1473     pos = avio_tell(pb);
1474     len = avio_read(pb, buf, sizeof(buf));
1475     if (len != sizeof(buf))
1476         goto fail;
1477     ts->raw_packet_size = get_packet_size(buf, sizeof(buf));
1478     if (ts->raw_packet_size <= 0)
1479         goto fail;
1480     ts->stream = s;
1481     ts->auto_guess = 0;
1482
1483     if (s->iformat == &ff_mpegts_demuxer) {
1484         /* normal demux */
1485
1486         /* first do a scaning to get all the services */
1487         if (avio_seek(pb, pos, SEEK_SET) < 0)
1488             av_log(s, AV_LOG_ERROR, "Unable to seek back to the start\n");
1489
1490         mpegts_open_section_filter(ts, SDT_PID, sdt_cb, ts, 1);
1491
1492         mpegts_open_section_filter(ts, PAT_PID, pat_cb, ts, 1);
1493
1494         handle_packets(ts, s->probesize / ts->raw_packet_size);
1495         /* if could not find service, enable auto_guess */
1496
1497         ts->auto_guess = 1;
1498
1499         av_dlog(ts->stream, "tuning done\n");
1500
1501         s->ctx_flags |= AVFMTCTX_NOHEADER;
1502     } else {
1503         AVStream *st;
1504         int pcr_pid, pid, nb_packets, nb_pcrs, ret, pcr_l;
1505         int64_t pcrs[2], pcr_h;
1506         int packet_count[2];
1507         uint8_t packet[TS_PACKET_SIZE];
1508
1509         /* only read packets */
1510
1511         st = av_new_stream(s, 0);
1512         if (!st)
1513             goto fail;
1514         av_set_pts_info(st, 60, 1, 27000000);
1515         st->codec->codec_type = AVMEDIA_TYPE_DATA;
1516         st->codec->codec_id = CODEC_ID_MPEG2TS;
1517
1518         /* we iterate until we find two PCRs to estimate the bitrate */
1519         pcr_pid = -1;
1520         nb_pcrs = 0;
1521         nb_packets = 0;
1522         for(;;) {
1523             ret = read_packet(s, packet, ts->raw_packet_size);
1524             if (ret < 0)
1525                 return -1;
1526             pid = AV_RB16(packet + 1) & 0x1fff;
1527             if ((pcr_pid == -1 || pcr_pid == pid) &&
1528                 parse_pcr(&pcr_h, &pcr_l, packet) == 0) {
1529                 pcr_pid = pid;
1530                 packet_count[nb_pcrs] = nb_packets;
1531                 pcrs[nb_pcrs] = pcr_h * 300 + pcr_l;
1532                 nb_pcrs++;
1533                 if (nb_pcrs >= 2)
1534                     break;
1535             }
1536             nb_packets++;
1537         }
1538
1539         /* NOTE1: the bitrate is computed without the FEC */
1540         /* NOTE2: it is only the bitrate of the start of the stream */
1541         ts->pcr_incr = (pcrs[1] - pcrs[0]) / (packet_count[1] - packet_count[0]);
1542         ts->cur_pcr = pcrs[0] - ts->pcr_incr * packet_count[0];
1543         s->bit_rate = (TS_PACKET_SIZE * 8) * 27e6 / ts->pcr_incr;
1544         st->codec->bit_rate = s->bit_rate;
1545         st->start_time = ts->cur_pcr;
1546 #if 0
1547         av_log(ts->stream, AV_LOG_DEBUG, "start=%0.3f pcr=%0.3f incr=%d\n",
1548                st->start_time / 1000000.0, pcrs[0] / 27e6, ts->pcr_incr);
1549 #endif
1550     }
1551
1552     avio_seek(pb, pos, SEEK_SET);
1553     return 0;
1554  fail:
1555     return -1;
1556 }
1557
1558 #define MAX_PACKET_READAHEAD ((128 * 1024) / 188)
1559
1560 static int mpegts_raw_read_packet(AVFormatContext *s,
1561                                   AVPacket *pkt)
1562 {
1563     MpegTSContext *ts = s->priv_data;
1564     int ret, i;
1565     int64_t pcr_h, next_pcr_h, pos;
1566     int pcr_l, next_pcr_l;
1567     uint8_t pcr_buf[12];
1568
1569     if (av_new_packet(pkt, TS_PACKET_SIZE) < 0)
1570         return AVERROR(ENOMEM);
1571     pkt->pos= avio_tell(s->pb);
1572     ret = read_packet(s, pkt->data, ts->raw_packet_size);
1573     if (ret < 0) {
1574         av_free_packet(pkt);
1575         return ret;
1576     }
1577     if (ts->mpeg2ts_compute_pcr) {
1578         /* compute exact PCR for each packet */
1579         if (parse_pcr(&pcr_h, &pcr_l, pkt->data) == 0) {
1580             /* we read the next PCR (XXX: optimize it by using a bigger buffer */
1581             pos = avio_tell(s->pb);
1582             for(i = 0; i < MAX_PACKET_READAHEAD; i++) {
1583                 avio_seek(s->pb, pos + i * ts->raw_packet_size, SEEK_SET);
1584                 avio_read(s->pb, pcr_buf, 12);
1585                 if (parse_pcr(&next_pcr_h, &next_pcr_l, pcr_buf) == 0) {
1586                     /* XXX: not precise enough */
1587                     ts->pcr_incr = ((next_pcr_h - pcr_h) * 300 + (next_pcr_l - pcr_l)) /
1588                         (i + 1);
1589                     break;
1590                 }
1591             }
1592             avio_seek(s->pb, pos, SEEK_SET);
1593             /* no next PCR found: we use previous increment */
1594             ts->cur_pcr = pcr_h * 300 + pcr_l;
1595         }
1596         pkt->pts = ts->cur_pcr;
1597         pkt->duration = ts->pcr_incr;
1598         ts->cur_pcr += ts->pcr_incr;
1599     }
1600     pkt->stream_index = 0;
1601     return 0;
1602 }
1603
1604 static int mpegts_read_packet(AVFormatContext *s,
1605                               AVPacket *pkt)
1606 {
1607     MpegTSContext *ts = s->priv_data;
1608     int ret, i;
1609
1610     if (avio_tell(s->pb) != ts->last_pos) {
1611         /* seek detected, flush pes buffer */
1612         for (i = 0; i < NB_PID_MAX; i++) {
1613             if (ts->pids[i] && ts->pids[i]->type == MPEGTS_PES) {
1614                 PESContext *pes = ts->pids[i]->u.pes_filter.opaque;
1615                 av_freep(&pes->buffer);
1616                 pes->data_index = 0;
1617                 pes->state = MPEGTS_SKIP; /* skip until pes header */
1618             }
1619         }
1620     }
1621
1622     ts->pkt = pkt;
1623     ret = handle_packets(ts, 0);
1624     if (ret < 0) {
1625         /* flush pes data left */
1626         for (i = 0; i < NB_PID_MAX; i++) {
1627             if (ts->pids[i] && ts->pids[i]->type == MPEGTS_PES) {
1628                 PESContext *pes = ts->pids[i]->u.pes_filter.opaque;
1629                 if (pes->state == MPEGTS_PAYLOAD && pes->data_index > 0) {
1630                     new_pes_packet(pes, pkt);
1631                     pes->state = MPEGTS_SKIP;
1632                     ret = 0;
1633                     break;
1634                 }
1635             }
1636         }
1637     }
1638
1639     ts->last_pos = avio_tell(s->pb);
1640
1641     return ret;
1642 }
1643
1644 static int mpegts_read_close(AVFormatContext *s)
1645 {
1646     MpegTSContext *ts = s->priv_data;
1647     int i;
1648
1649     clear_programs(ts);
1650
1651     for(i=0;i<NB_PID_MAX;i++)
1652         if (ts->pids[i]) mpegts_close_filter(ts, ts->pids[i]);
1653
1654     return 0;
1655 }
1656
1657 static int64_t mpegts_get_pcr(AVFormatContext *s, int stream_index,
1658                               int64_t *ppos, int64_t pos_limit)
1659 {
1660     MpegTSContext *ts = s->priv_data;
1661     int64_t pos, timestamp;
1662     uint8_t buf[TS_PACKET_SIZE];
1663     int pcr_l, pcr_pid = ((PESContext*)s->streams[stream_index]->priv_data)->pcr_pid;
1664     const int find_next= 1;
1665     pos = ((*ppos  + ts->raw_packet_size - 1 - ts->pos47) / ts->raw_packet_size) * ts->raw_packet_size + ts->pos47;
1666     if (find_next) {
1667         for(;;) {
1668             avio_seek(s->pb, pos, SEEK_SET);
1669             if (avio_read(s->pb, buf, TS_PACKET_SIZE) != TS_PACKET_SIZE)
1670                 return AV_NOPTS_VALUE;
1671             if ((pcr_pid < 0 || (AV_RB16(buf + 1) & 0x1fff) == pcr_pid) &&
1672                 parse_pcr(&timestamp, &pcr_l, buf) == 0) {
1673                 break;
1674             }
1675             pos += ts->raw_packet_size;
1676         }
1677     } else {
1678         for(;;) {
1679             pos -= ts->raw_packet_size;
1680             if (pos < 0)
1681                 return AV_NOPTS_VALUE;
1682             avio_seek(s->pb, pos, SEEK_SET);
1683             if (avio_read(s->pb, buf, TS_PACKET_SIZE) != TS_PACKET_SIZE)
1684                 return AV_NOPTS_VALUE;
1685             if ((pcr_pid < 0 || (AV_RB16(buf + 1) & 0x1fff) == pcr_pid) &&
1686                 parse_pcr(&timestamp, &pcr_l, buf) == 0) {
1687                 break;
1688             }
1689         }
1690     }
1691     *ppos = pos;
1692
1693     return timestamp;
1694 }
1695
1696 #ifdef USE_SYNCPOINT_SEARCH
1697
1698 static int read_seek2(AVFormatContext *s,
1699                       int stream_index,
1700                       int64_t min_ts,
1701                       int64_t target_ts,
1702                       int64_t max_ts,
1703                       int flags)
1704 {
1705     int64_t pos;
1706
1707     int64_t ts_ret, ts_adj;
1708     int stream_index_gen_search;
1709     AVStream *st;
1710     AVParserState *backup;
1711
1712     backup = ff_store_parser_state(s);
1713
1714     // detect direction of seeking for search purposes
1715     flags |= (target_ts - min_ts > (uint64_t)(max_ts - target_ts)) ?
1716              AVSEEK_FLAG_BACKWARD : 0;
1717
1718     if (flags & AVSEEK_FLAG_BYTE) {
1719         // use position directly, we will search starting from it
1720         pos = target_ts;
1721     } else {
1722         // search for some position with good timestamp match
1723         if (stream_index < 0) {
1724             stream_index_gen_search = av_find_default_stream_index(s);
1725             if (stream_index_gen_search < 0) {
1726                 ff_restore_parser_state(s, backup);
1727                 return -1;
1728             }
1729
1730             st = s->streams[stream_index_gen_search];
1731             // timestamp for default must be expressed in AV_TIME_BASE units
1732             ts_adj = av_rescale(target_ts,
1733                                 st->time_base.den,
1734                                 AV_TIME_BASE * (int64_t)st->time_base.num);
1735         } else {
1736             ts_adj = target_ts;
1737             stream_index_gen_search = stream_index;
1738         }
1739         pos = av_gen_search(s, stream_index_gen_search, ts_adj,
1740                             0, INT64_MAX, -1,
1741                             AV_NOPTS_VALUE,
1742                             AV_NOPTS_VALUE,
1743                             flags, &ts_ret, mpegts_get_pcr);
1744         if (pos < 0) {
1745             ff_restore_parser_state(s, backup);
1746             return -1;
1747         }
1748     }
1749
1750     // search for actual matching keyframe/starting position for all streams
1751     if (ff_gen_syncpoint_search(s, stream_index, pos,
1752                                 min_ts, target_ts, max_ts,
1753                                 flags) < 0) {
1754         ff_restore_parser_state(s, backup);
1755         return -1;
1756     }
1757
1758     ff_free_parser_state(s, backup);
1759     return 0;
1760 }
1761
1762 static int read_seek(AVFormatContext *s, int stream_index, int64_t target_ts, int flags)
1763 {
1764     int ret;
1765     if (flags & AVSEEK_FLAG_BACKWARD) {
1766         flags &= ~AVSEEK_FLAG_BACKWARD;
1767         ret = read_seek2(s, stream_index, INT64_MIN, target_ts, target_ts, flags);
1768         if (ret < 0)
1769             // for compatibility reasons, seek to the best-fitting timestamp
1770             ret = read_seek2(s, stream_index, INT64_MIN, target_ts, INT64_MAX, flags);
1771     } else {
1772         ret = read_seek2(s, stream_index, target_ts, target_ts, INT64_MAX, flags);
1773         if (ret < 0)
1774             // for compatibility reasons, seek to the best-fitting timestamp
1775             ret = read_seek2(s, stream_index, INT64_MIN, target_ts, INT64_MAX, flags);
1776     }
1777     return ret;
1778 }
1779
1780 #else
1781
1782 static int read_seek(AVFormatContext *s, int stream_index, int64_t target_ts, int flags){
1783     MpegTSContext *ts = s->priv_data;
1784     uint8_t buf[TS_PACKET_SIZE];
1785     int64_t pos;
1786
1787     if(av_seek_frame_binary(s, stream_index, target_ts, flags) < 0)
1788         return -1;
1789
1790     pos= avio_tell(s->pb);
1791
1792     for(;;) {
1793         avio_seek(s->pb, pos, SEEK_SET);
1794         if (avio_read(s->pb, buf, TS_PACKET_SIZE) != TS_PACKET_SIZE)
1795             return -1;
1796 //        pid = AV_RB16(buf + 1) & 0x1fff;
1797         if(buf[1] & 0x40) break;
1798         pos += ts->raw_packet_size;
1799     }
1800     avio_seek(s->pb, pos, SEEK_SET);
1801
1802     return 0;
1803 }
1804
1805 #endif
1806
1807 /**************************************************************/
1808 /* parsing functions - called from other demuxers such as RTP */
1809
1810 MpegTSContext *ff_mpegts_parse_open(AVFormatContext *s)
1811 {
1812     MpegTSContext *ts;
1813
1814     ts = av_mallocz(sizeof(MpegTSContext));
1815     if (!ts)
1816         return NULL;
1817     /* no stream case, currently used by RTP */
1818     ts->raw_packet_size = TS_PACKET_SIZE;
1819     ts->stream = s;
1820     ts->auto_guess = 1;
1821     return ts;
1822 }
1823
1824 /* return the consumed length if a packet was output, or -1 if no
1825    packet is output */
1826 int ff_mpegts_parse_packet(MpegTSContext *ts, AVPacket *pkt,
1827                         const uint8_t *buf, int len)
1828 {
1829     int len1;
1830
1831     len1 = len;
1832     ts->pkt = pkt;
1833     ts->stop_parse = 0;
1834     for(;;) {
1835         if (ts->stop_parse>0)
1836             break;
1837         if (len < TS_PACKET_SIZE)
1838             return -1;
1839         if (buf[0] != 0x47) {
1840             buf++;
1841             len--;
1842         } else {
1843             handle_packet(ts, buf);
1844             buf += TS_PACKET_SIZE;
1845             len -= TS_PACKET_SIZE;
1846         }
1847     }
1848     return len1 - len;
1849 }
1850
1851 void ff_mpegts_parse_close(MpegTSContext *ts)
1852 {
1853     int i;
1854
1855     for(i=0;i<NB_PID_MAX;i++)
1856         av_free(ts->pids[i]);
1857     av_free(ts);
1858 }
1859
1860 AVInputFormat ff_mpegts_demuxer = {
1861     "mpegts",
1862     NULL_IF_CONFIG_SMALL("MPEG-2 transport stream format"),
1863     sizeof(MpegTSContext),
1864     mpegts_probe,
1865     mpegts_read_header,
1866     mpegts_read_packet,
1867     mpegts_read_close,
1868     read_seek,
1869     mpegts_get_pcr,
1870     .flags = AVFMT_SHOW_IDS|AVFMT_TS_DISCONT,
1871 #ifdef USE_SYNCPOINT_SEARCH
1872     .read_seek2 = read_seek2,
1873 #endif
1874 };
1875
1876 AVInputFormat ff_mpegtsraw_demuxer = {
1877     "mpegtsraw",
1878     NULL_IF_CONFIG_SMALL("MPEG-2 raw transport stream format"),
1879     sizeof(MpegTSContext),
1880     NULL,
1881     mpegts_read_header,
1882     mpegts_raw_read_packet,
1883     mpegts_read_close,
1884     read_seek,
1885     mpegts_get_pcr,
1886     .flags = AVFMT_SHOW_IDS|AVFMT_TS_DISCONT,
1887 #ifdef USE_SYNCPOINT_SEARCH
1888     .read_seek2 = read_seek2,
1889 #endif
1890 };