8e1848c9cab9e5d4054b1dbc729771bf2ca4b8c8
[ffmpeg.git] / libavformat / mpeg.c
1 /*
2  * MPEG1/2 demuxer
3  * Copyright (c) 2000, 2001, 2002 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 "avformat.h"
23 #include "internal.h"
24 #include "mpeg.h"
25
26 #if CONFIG_VOBSUB_DEMUXER
27 # include "subtitles.h"
28 # include "libavutil/bprint.h"
29 #endif
30
31 #undef NDEBUG
32 #include <assert.h>
33 #include "libavutil/avassert.h"
34
35 /*********************************************/
36 /* demux code */
37
38 #define MAX_SYNC_SIZE 100000
39
40 static int check_pes(const uint8_t *p, const uint8_t *end)
41 {
42     int pes1;
43     int pes2 = (p[3] & 0xC0) == 0x80 &&
44                (p[4] & 0xC0) != 0x40 &&
45                ((p[4] & 0xC0) == 0x00 ||
46                 (p[4] & 0xC0) >> 2 == (p[6] & 0xF0));
47
48     for (p += 3; p < end && *p == 0xFF; p++) ;
49     if ((*p & 0xC0) == 0x40)
50         p += 2;
51
52     if ((*p & 0xF0) == 0x20)
53         pes1 = p[0] & p[2] & p[4] & 1;
54     else if ((*p & 0xF0) == 0x30)
55         pes1 = p[0] & p[2] & p[4] & p[5] & p[7] & p[9] & 1;
56     else
57         pes1 = *p == 0x0F;
58
59     return pes1 || pes2;
60 }
61
62 static int check_pack_header(const uint8_t *buf)
63 {
64     return (buf[1] & 0xC0) == 0x40 || (buf[1] & 0xF0) == 0x20;
65 }
66
67 static int mpegps_probe(AVProbeData *p)
68 {
69     uint32_t code = -1;
70     int i;
71     int sys = 0, pspack = 0, priv1 = 0, vid = 0;
72     int audio = 0, invalid = 0, score = 0;
73     int endpes = 0;
74
75     for (i = 0; i < p->buf_size; i++) {
76         code = (code << 8) + p->buf[i];
77         if ((code & 0xffffff00) == 0x100) {
78             int len  = p->buf[i + 1] << 8 | p->buf[i + 2];
79             int pes  = endpes <= i && check_pes(p->buf + i, p->buf + p->buf_size);
80             int pack = check_pack_header(p->buf + i);
81
82             if (code == SYSTEM_HEADER_START_CODE)
83                 sys++;
84             else if (code == PACK_START_CODE && pack)
85                 pspack++;
86             else if ((code & 0xf0) == VIDEO_ID && pes) {
87                 endpes = i + len;
88                 vid++;
89             }
90             // skip pes payload to avoid start code emulation for private
91             // and audio streams
92             else if ((code & 0xe0) == AUDIO_ID &&  pes) {audio++; i+=len;}
93             else if (code == PRIVATE_STREAM_1  &&  pes) {priv1++; i+=len;}
94             else if (code == 0x1fd             &&  pes) vid++; //VC1
95
96             else if ((code & 0xf0) == VIDEO_ID && !pes) invalid++;
97             else if ((code & 0xe0) == AUDIO_ID && !pes) invalid++;
98             else if (code == PRIVATE_STREAM_1  && !pes) invalid++;
99         }
100     }
101
102     if (vid + audio > invalid + 1) /* invalid VDR files nd short PES streams */
103         score = AVPROBE_SCORE_EXTENSION / 2;
104
105     if (sys > invalid && sys * 9 <= pspack * 10)
106         return (audio > 12 || vid > 3 || pspack > 2) ? AVPROBE_SCORE_EXTENSION + 2
107                                                      : AVPROBE_SCORE_EXTENSION / 2 + 1; // 1 more than mp3
108     if (pspack > invalid && (priv1 + vid + audio) * 10 >= pspack * 9)
109         return pspack > 2 ? AVPROBE_SCORE_EXTENSION + 2
110                           : AVPROBE_SCORE_EXTENSION / 2; // 1 more than .mpg
111     if ((!!vid ^ !!audio) && (audio > 4 || vid > 1) && !sys &&
112         !pspack && p->buf_size > 2048 && vid + audio > invalid) /* PES stream */
113         return (audio > 12 || vid > 3 + 2 * invalid) ? AVPROBE_SCORE_EXTENSION + 2
114                                                      : AVPROBE_SCORE_EXTENSION / 2;
115
116     // 02-Penguin.flac has sys:0 priv1:0 pspack:0 vid:0 audio:1
117     // mp3_misidentified_2.mp3 has sys:0 priv1:0 pspack:0 vid:0 audio:6
118     // Have\ Yourself\ a\ Merry\ Little\ Christmas.mp3 0 0 0 5 0 1 len:21618
119     return score;
120 }
121
122 typedef struct MpegDemuxContext {
123     int32_t header_state;
124     unsigned char psm_es_type[256];
125     int sofdec;
126     int dvd;
127     int imkh_cctv;
128 #if CONFIG_VOBSUB_DEMUXER
129     AVFormatContext *sub_ctx;
130     FFDemuxSubtitlesQueue q[32];
131 #endif
132 } MpegDemuxContext;
133
134 static int mpegps_read_header(AVFormatContext *s)
135 {
136     MpegDemuxContext *m = s->priv_data;
137     char buffer[7];
138     int64_t last_pos = avio_tell(s->pb);
139
140     m->header_state = 0xff;
141     s->ctx_flags   |= AVFMTCTX_NOHEADER;
142
143     avio_get_str(s->pb, 6, buffer, sizeof(buffer));
144     if (!memcmp("IMKH", buffer, 4)) {
145         m->imkh_cctv = 1;
146     } else if (!memcmp("Sofdec", buffer, 6)) {
147         m->sofdec = 1;
148     } else
149        avio_seek(s->pb, last_pos, SEEK_SET);
150
151     /* no need to do more */
152     return 0;
153 }
154
155 static int64_t get_pts(AVIOContext *pb, int c)
156 {
157     uint8_t buf[5];
158
159     buf[0] = c < 0 ? avio_r8(pb) : c;
160     avio_read(pb, buf + 1, 4);
161
162     return ff_parse_pes_pts(buf);
163 }
164
165 static int find_next_start_code(AVIOContext *pb, int *size_ptr,
166                                 int32_t *header_state)
167 {
168     unsigned int state, v;
169     int val, n;
170
171     state = *header_state;
172     n     = *size_ptr;
173     while (n > 0) {
174         if (avio_feof(pb))
175             break;
176         v = avio_r8(pb);
177         n--;
178         if (state == 0x000001) {
179             state = ((state << 8) | v) & 0xffffff;
180             val   = state;
181             goto found;
182         }
183         state = ((state << 8) | v) & 0xffffff;
184     }
185     val = -1;
186
187 found:
188     *header_state = state;
189     *size_ptr     = n;
190     return val;
191 }
192
193 /**
194  * Extract stream types from a program stream map
195  * According to ISO/IEC 13818-1 ('MPEG-2 Systems') table 2-35
196  *
197  * @return number of bytes occupied by PSM in the bitstream
198  */
199 static long mpegps_psm_parse(MpegDemuxContext *m, AVIOContext *pb)
200 {
201     int psm_length, ps_info_length, es_map_length;
202
203     psm_length = avio_rb16(pb);
204     avio_r8(pb);
205     avio_r8(pb);
206     ps_info_length = avio_rb16(pb);
207
208     /* skip program_stream_info */
209     avio_skip(pb, ps_info_length);
210     es_map_length = avio_rb16(pb);
211     /* Ignore es_map_length, trust psm_length */
212     es_map_length = psm_length - ps_info_length - 10;
213
214     /* at least one es available? */
215     while (es_map_length >= 4) {
216         unsigned char type      = avio_r8(pb);
217         unsigned char es_id     = avio_r8(pb);
218         uint16_t es_info_length = avio_rb16(pb);
219
220         /* remember mapping from stream id to stream type */
221         m->psm_es_type[es_id] = type;
222         /* skip program_stream_info */
223         avio_skip(pb, es_info_length);
224         es_map_length -= 4 + es_info_length;
225     }
226     avio_rb32(pb); /* crc32 */
227     return 2 + psm_length;
228 }
229
230 /* read the next PES header. Return its position in ppos
231  * (if not NULL), and its start code, pts and dts.
232  */
233 static int mpegps_read_pes_header(AVFormatContext *s,
234                                   int64_t *ppos, int *pstart_code,
235                                   int64_t *ppts, int64_t *pdts)
236 {
237     MpegDemuxContext *m = s->priv_data;
238     int len, size, startcode, c, flags, header_len;
239     int pes_ext, ext2_len, id_ext, skip;
240     int64_t pts, dts;
241     int64_t last_sync = avio_tell(s->pb);
242
243 error_redo:
244     avio_seek(s->pb, last_sync, SEEK_SET);
245 redo:
246     /* next start code (should be immediately after) */
247     m->header_state = 0xff;
248     size      = MAX_SYNC_SIZE;
249     startcode = find_next_start_code(s->pb, &size, &m->header_state);
250     last_sync = avio_tell(s->pb);
251     if (startcode < 0) {
252         if (avio_feof(s->pb))
253             return AVERROR_EOF;
254         // FIXME we should remember header_state
255         return AVERROR(EAGAIN);
256     }
257
258     if (startcode == PACK_START_CODE)
259         goto redo;
260     if (startcode == SYSTEM_HEADER_START_CODE)
261         goto redo;
262     if (startcode == PADDING_STREAM) {
263         avio_skip(s->pb, avio_rb16(s->pb));
264         goto redo;
265     }
266     if (startcode == PRIVATE_STREAM_2) {
267         if (!m->sofdec) {
268             /* Need to detect whether this from a DVD or a 'Sofdec' stream */
269             int len = avio_rb16(s->pb);
270             int bytesread = 0;
271             uint8_t *ps2buf = av_malloc(len);
272
273             if (ps2buf) {
274                 bytesread = avio_read(s->pb, ps2buf, len);
275
276                 if (bytesread != len) {
277                     avio_skip(s->pb, len - bytesread);
278                 } else {
279                     uint8_t *p = 0;
280                     if (len >= 6)
281                         p = memchr(ps2buf, 'S', len - 5);
282
283                     if (p)
284                         m->sofdec = !memcmp(p+1, "ofdec", 5);
285
286                     m->sofdec -= !m->sofdec;
287
288                     if (m->sofdec < 0) {
289                         if (len == 980  && ps2buf[0] == 0) {
290                             /* PCI structure? */
291                             uint32_t startpts = AV_RB32(ps2buf + 0x0d);
292                             uint32_t endpts = AV_RB32(ps2buf + 0x11);
293                             uint8_t hours = ((ps2buf[0x19] >> 4) * 10) + (ps2buf[0x19] & 0x0f);
294                             uint8_t mins  = ((ps2buf[0x1a] >> 4) * 10) + (ps2buf[0x1a] & 0x0f);
295                             uint8_t secs  = ((ps2buf[0x1b] >> 4) * 10) + (ps2buf[0x1b] & 0x0f);
296
297                             m->dvd = (hours <= 23 &&
298                                       mins  <= 59 &&
299                                       secs  <= 59 &&
300                                       (ps2buf[0x19] & 0x0f) < 10 &&
301                                       (ps2buf[0x1a] & 0x0f) < 10 &&
302                                       (ps2buf[0x1b] & 0x0f) < 10 &&
303                                       endpts >= startpts);
304                         } else if (len == 1018 && ps2buf[0] == 1) {
305                             /* DSI structure? */
306                             uint8_t hours = ((ps2buf[0x1d] >> 4) * 10) + (ps2buf[0x1d] & 0x0f);
307                             uint8_t mins  = ((ps2buf[0x1e] >> 4) * 10) + (ps2buf[0x1e] & 0x0f);
308                             uint8_t secs  = ((ps2buf[0x1f] >> 4) * 10) + (ps2buf[0x1f] & 0x0f);
309
310                             m->dvd = (hours <= 23 &&
311                                       mins  <= 59 &&
312                                       secs  <= 59 &&
313                                       (ps2buf[0x1d] & 0x0f) < 10 &&
314                                       (ps2buf[0x1e] & 0x0f) < 10 &&
315                                       (ps2buf[0x1f] & 0x0f) < 10);
316                         }
317                     }
318                 }
319
320                 av_free(ps2buf);
321
322                 /* If this isn't a DVD packet or no memory
323                  * could be allocated, just ignore it.
324                  * If we did, move back to the start of the
325                  * packet (plus 'length' field) */
326                 if (!m->dvd || avio_skip(s->pb, -(len + 2)) < 0) {
327                     /* Skip back failed.
328                      * This packet will be lost but that can't be helped
329                      * if we can't skip back
330                      */
331                     goto redo;
332                 }
333             } else {
334                 /* No memory */
335                 avio_skip(s->pb, len);
336                 goto redo;
337             }
338         } else if (!m->dvd) {
339             int len = avio_rb16(s->pb);
340             avio_skip(s->pb, len);
341             goto redo;
342         }
343     }
344     if (startcode == PROGRAM_STREAM_MAP) {
345         mpegps_psm_parse(m, s->pb);
346         goto redo;
347     }
348
349     /* find matching stream */
350     if (!((startcode >= 0x1c0 && startcode <= 0x1df) ||
351           (startcode >= 0x1e0 && startcode <= 0x1ef) ||
352           (startcode == 0x1bd) ||
353           (startcode == PRIVATE_STREAM_2) ||
354           (startcode == 0x1fd)))
355         goto redo;
356     if (ppos) {
357         *ppos = avio_tell(s->pb) - 4;
358     }
359     len = avio_rb16(s->pb);
360     pts =
361     dts = AV_NOPTS_VALUE;
362     if (startcode != PRIVATE_STREAM_2)
363     {
364     /* stuffing */
365     for (;;) {
366         if (len < 1)
367             goto error_redo;
368         c = avio_r8(s->pb);
369         len--;
370         /* XXX: for mpeg1, should test only bit 7 */
371         if (c != 0xff)
372             break;
373     }
374     if ((c & 0xc0) == 0x40) {
375         /* buffer scale & size */
376         avio_r8(s->pb);
377         c    = avio_r8(s->pb);
378         len -= 2;
379     }
380     if ((c & 0xe0) == 0x20) {
381         dts  =
382         pts  = get_pts(s->pb, c);
383         len -= 4;
384         if (c & 0x10) {
385             dts  = get_pts(s->pb, -1);
386             len -= 5;
387         }
388     } else if ((c & 0xc0) == 0x80) {
389         /* mpeg 2 PES */
390         flags      = avio_r8(s->pb);
391         header_len = avio_r8(s->pb);
392         len       -= 2;
393         if (header_len > len)
394             goto error_redo;
395         len -= header_len;
396         if (flags & 0x80) {
397             dts         = pts = get_pts(s->pb, -1);
398             header_len -= 5;
399             if (flags & 0x40) {
400                 dts         = get_pts(s->pb, -1);
401                 header_len -= 5;
402             }
403         }
404         if (flags & 0x3f && header_len == 0) {
405             flags &= 0xC0;
406             av_log(s, AV_LOG_WARNING, "Further flags set but no bytes left\n");
407         }
408         if (flags & 0x01) { /* PES extension */
409             pes_ext = avio_r8(s->pb);
410             header_len--;
411             /* Skip PES private data, program packet sequence counter
412              * and P-STD buffer */
413             skip  = (pes_ext >> 4) & 0xb;
414             skip += skip & 0x9;
415             if (pes_ext & 0x40 || skip > header_len) {
416                 av_log(s, AV_LOG_WARNING, "pes_ext %X is invalid\n", pes_ext);
417                 pes_ext = skip = 0;
418             }
419             avio_skip(s->pb, skip);
420             header_len -= skip;
421
422             if (pes_ext & 0x01) { /* PES extension 2 */
423                 ext2_len = avio_r8(s->pb);
424                 header_len--;
425                 if ((ext2_len & 0x7f) > 0) {
426                     id_ext = avio_r8(s->pb);
427                     if ((id_ext & 0x80) == 0)
428                         startcode = ((startcode & 0xff) << 8) | id_ext;
429                     header_len--;
430                 }
431             }
432         }
433         if (header_len < 0)
434             goto error_redo;
435         avio_skip(s->pb, header_len);
436     } else if (c != 0xf)
437         goto redo;
438     }
439
440     if (startcode == PRIVATE_STREAM_1) {
441         startcode = avio_r8(s->pb);
442         len--;
443     }
444     if (len < 0)
445         goto error_redo;
446     if (dts != AV_NOPTS_VALUE && ppos) {
447         int i;
448         for (i = 0; i < s->nb_streams; i++) {
449             if (startcode == s->streams[i]->id &&
450                 s->pb->seekable /* index useless on streams anyway */) {
451                 ff_reduce_index(s, i);
452                 av_add_index_entry(s->streams[i], *ppos, dts, 0, 0,
453                                    AVINDEX_KEYFRAME /* FIXME keyframe? */);
454             }
455         }
456     }
457
458     *pstart_code = startcode;
459     *ppts        = pts;
460     *pdts        = dts;
461     return len;
462 }
463
464 static int mpegps_read_packet(AVFormatContext *s,
465                               AVPacket *pkt)
466 {
467     MpegDemuxContext *m = s->priv_data;
468     AVStream *st;
469     int len, startcode, i, es_type, ret;
470     int lpcm_header_len = -1; //Init to suppress warning
471     int request_probe= 0;
472     enum AVCodecID codec_id = AV_CODEC_ID_NONE;
473     enum AVMediaType type;
474     int64_t pts, dts, dummy_pos; // dummy_pos is needed for the index building to work
475
476 redo:
477     len = mpegps_read_pes_header(s, &dummy_pos, &startcode, &pts, &dts);
478     if (len < 0)
479         return len;
480
481     if (startcode >= 0x80 && startcode <= 0xcf) {
482         if (len < 4)
483             goto skip;
484
485         /* audio: skip header */
486         avio_r8(s->pb);
487         lpcm_header_len = avio_rb16(s->pb);
488         len -= 3;
489         if (startcode >= 0xb0 && startcode <= 0xbf) {
490             /* MLP/TrueHD audio has a 4-byte header */
491             avio_r8(s->pb);
492             len--;
493         }
494     }
495
496     /* now find stream */
497     for (i = 0; i < s->nb_streams; i++) {
498         st = s->streams[i];
499         if (st->id == startcode)
500             goto found;
501     }
502
503     es_type = m->psm_es_type[startcode & 0xff];
504         if (es_type == STREAM_TYPE_VIDEO_MPEG1) {
505             codec_id = AV_CODEC_ID_MPEG2VIDEO;
506             type     = AVMEDIA_TYPE_VIDEO;
507         } else if (es_type == STREAM_TYPE_VIDEO_MPEG2) {
508             codec_id = AV_CODEC_ID_MPEG2VIDEO;
509             type     = AVMEDIA_TYPE_VIDEO;
510         } else if (es_type == STREAM_TYPE_AUDIO_MPEG1 ||
511                    es_type == STREAM_TYPE_AUDIO_MPEG2) {
512             codec_id = AV_CODEC_ID_MP3;
513             type     = AVMEDIA_TYPE_AUDIO;
514         } else if (es_type == STREAM_TYPE_AUDIO_AAC) {
515             codec_id = AV_CODEC_ID_AAC;
516             type     = AVMEDIA_TYPE_AUDIO;
517         } else if (es_type == STREAM_TYPE_VIDEO_MPEG4) {
518             codec_id = AV_CODEC_ID_MPEG4;
519             type     = AVMEDIA_TYPE_VIDEO;
520         } else if (es_type == STREAM_TYPE_VIDEO_H264) {
521             codec_id = AV_CODEC_ID_H264;
522             type     = AVMEDIA_TYPE_VIDEO;
523         } else if (es_type == STREAM_TYPE_AUDIO_AC3) {
524             codec_id = AV_CODEC_ID_AC3;
525             type     = AVMEDIA_TYPE_AUDIO;
526         } else if (m->imkh_cctv && es_type == 0x91) {
527             codec_id = AV_CODEC_ID_PCM_MULAW;
528             type     = AVMEDIA_TYPE_AUDIO;
529     } else if (startcode >= 0x1e0 && startcode <= 0x1ef) {
530         static const unsigned char avs_seqh[4] = { 0, 0, 1, 0xb0 };
531         unsigned char buf[8];
532
533         avio_read(s->pb, buf, 8);
534         avio_seek(s->pb, -8, SEEK_CUR);
535         if (!memcmp(buf, avs_seqh, 4) && (buf[6] != 0 || buf[7] != 1))
536             codec_id = AV_CODEC_ID_CAVS;
537         else
538             request_probe= 1;
539         type = AVMEDIA_TYPE_VIDEO;
540     } else if (startcode == PRIVATE_STREAM_2) {
541         type = AVMEDIA_TYPE_DATA;
542         codec_id = AV_CODEC_ID_DVD_NAV;
543     } else if (startcode >= 0x1c0 && startcode <= 0x1df) {
544         type     = AVMEDIA_TYPE_AUDIO;
545         if (m->sofdec > 0) {
546             codec_id = AV_CODEC_ID_ADPCM_ADX;
547             // Auto-detect AC-3
548             request_probe = 50;
549         } else {
550             codec_id = AV_CODEC_ID_MP2;
551         }
552     } else if (startcode >= 0x80 && startcode <= 0x87) {
553         type     = AVMEDIA_TYPE_AUDIO;
554         codec_id = AV_CODEC_ID_AC3;
555     } else if ((startcode >= 0x88 && startcode <= 0x8f) ||
556                (startcode >= 0x98 && startcode <= 0x9f)) {
557         /* 0x90 - 0x97 is reserved for SDDS in DVD specs */
558         type     = AVMEDIA_TYPE_AUDIO;
559         codec_id = AV_CODEC_ID_DTS;
560     } else if (startcode >= 0xa0 && startcode <= 0xaf) {
561         type     = AVMEDIA_TYPE_AUDIO;
562         if (lpcm_header_len == 6) {
563             codec_id = AV_CODEC_ID_MLP;
564         } else {
565             codec_id = AV_CODEC_ID_PCM_DVD;
566         }
567     } else if (startcode >= 0xb0 && startcode <= 0xbf) {
568         type     = AVMEDIA_TYPE_AUDIO;
569         codec_id = AV_CODEC_ID_TRUEHD;
570     } else if (startcode >= 0xc0 && startcode <= 0xcf) {
571         /* Used for both AC-3 and E-AC-3 in EVOB files */
572         type     = AVMEDIA_TYPE_AUDIO;
573         codec_id = AV_CODEC_ID_AC3;
574     } else if (startcode >= 0x20 && startcode <= 0x3f) {
575         type     = AVMEDIA_TYPE_SUBTITLE;
576         codec_id = AV_CODEC_ID_DVD_SUBTITLE;
577     } else if (startcode >= 0xfd55 && startcode <= 0xfd5f) {
578         type     = AVMEDIA_TYPE_VIDEO;
579         codec_id = AV_CODEC_ID_VC1;
580     } else {
581 skip:
582         /* skip packet */
583         avio_skip(s->pb, len);
584         goto redo;
585     }
586     /* no stream found: add a new stream */
587     st = avformat_new_stream(s, NULL);
588     if (!st)
589         goto skip;
590     st->id                = startcode;
591     st->codec->codec_type = type;
592     st->codec->codec_id   = codec_id;
593     if (st->codec->codec_id == AV_CODEC_ID_PCM_MULAW) {
594         st->codec->channels = 1;
595         st->codec->channel_layout = AV_CH_LAYOUT_MONO;
596         st->codec->sample_rate = 8000;
597     }
598     st->request_probe     = request_probe;
599     st->need_parsing      = AVSTREAM_PARSE_FULL;
600
601 found:
602     if (st->discard >= AVDISCARD_ALL)
603         goto skip;
604     if (startcode >= 0xa0 && startcode <= 0xaf) {
605       if (lpcm_header_len == 6 && st->codec->codec_id == AV_CODEC_ID_MLP) {
606             if (len < 6)
607                 goto skip;
608             avio_skip(s->pb, 6);
609             len -=6;
610       }
611     }
612     ret = av_get_packet(s->pb, pkt, len);
613
614     pkt->pts          = pts;
615     pkt->dts          = dts;
616     pkt->pos          = dummy_pos;
617     pkt->stream_index = st->index;
618     av_dlog(s, "%d: pts=%0.3f dts=%0.3f size=%d\n",
619             pkt->stream_index, pkt->pts / 90000.0, pkt->dts / 90000.0,
620             pkt->size);
621
622     return (ret < 0) ? ret : 0;
623 }
624
625 static int64_t mpegps_read_dts(AVFormatContext *s, int stream_index,
626                                int64_t *ppos, int64_t pos_limit)
627 {
628     int len, startcode;
629     int64_t pos, pts, dts;
630
631     pos = *ppos;
632     if (avio_seek(s->pb, pos, SEEK_SET) < 0)
633         return AV_NOPTS_VALUE;
634
635     for (;;) {
636         len = mpegps_read_pes_header(s, &pos, &startcode, &pts, &dts);
637         if (len < 0) {
638             av_dlog(s, "none (ret=%d)\n", len);
639             return AV_NOPTS_VALUE;
640         }
641         if (startcode == s->streams[stream_index]->id &&
642             dts != AV_NOPTS_VALUE) {
643             break;
644         }
645         avio_skip(s->pb, len);
646     }
647     av_dlog(s, "pos=0x%"PRIx64" dts=0x%"PRIx64" %0.3f\n",
648             pos, dts, dts / 90000.0);
649     *ppos = pos;
650     return dts;
651 }
652
653 AVInputFormat ff_mpegps_demuxer = {
654     .name           = "mpeg",
655     .long_name      = NULL_IF_CONFIG_SMALL("MPEG-PS (MPEG-2 Program Stream)"),
656     .priv_data_size = sizeof(MpegDemuxContext),
657     .read_probe     = mpegps_probe,
658     .read_header    = mpegps_read_header,
659     .read_packet    = mpegps_read_packet,
660     .read_timestamp = mpegps_read_dts,
661     .flags          = AVFMT_SHOW_IDS | AVFMT_TS_DISCONT,
662 };
663
664 #if CONFIG_VOBSUB_DEMUXER
665
666 #define REF_STRING "# VobSub index file,"
667 #define MAX_LINE_SIZE 2048
668
669 static int vobsub_probe(AVProbeData *p)
670 {
671     if (!strncmp(p->buf, REF_STRING, sizeof(REF_STRING) - 1))
672         return AVPROBE_SCORE_MAX;
673     return 0;
674 }
675
676 static int vobsub_read_header(AVFormatContext *s)
677 {
678     int i, ret = 0, header_parsed = 0, langidx = 0;
679     MpegDemuxContext *vobsub = s->priv_data;
680     char *sub_name = NULL;
681     size_t fname_len;
682     char *ext, *header_str;
683     AVBPrint header;
684     int64_t delay = 0;
685     AVStream *st = NULL;
686     int stream_id = -1;
687     char id[64] = {0};
688     char alt[MAX_LINE_SIZE] = {0};
689     AVInputFormat *iformat;
690
691     sub_name = av_strdup(s->filename);
692     fname_len = strlen(sub_name);
693     ext = sub_name - 3 + fname_len;
694     if (fname_len < 4 || *(ext - 1) != '.') {
695         av_log(s, AV_LOG_ERROR, "The input index filename is too short "
696                "to guess the associated .SUB file\n");
697         ret = AVERROR_INVALIDDATA;
698         goto end;
699     }
700     memcpy(ext, !strncmp(ext, "IDX", 3) ? "SUB" : "sub", 3);
701     av_log(s, AV_LOG_VERBOSE, "IDX/SUB: %s -> %s\n", s->filename, sub_name);
702
703     if (!(iformat = av_find_input_format("mpeg"))) {
704         ret = AVERROR_DEMUXER_NOT_FOUND;
705         goto end;
706     }
707
708     vobsub->sub_ctx = avformat_alloc_context();
709     if (!vobsub->sub_ctx) {
710         ret = AVERROR(ENOMEM);
711         goto end;
712     }
713
714     if ((ret = ff_copy_whitelists(vobsub->sub_ctx, s)) < 0)
715         goto end;
716
717     ret = avformat_open_input(&vobsub->sub_ctx, sub_name, iformat, NULL);
718     if (ret < 0) {
719         av_log(s, AV_LOG_ERROR, "Unable to open %s as MPEG subtitles\n", sub_name);
720         goto end;
721     }
722
723     av_bprint_init(&header, 0, AV_BPRINT_SIZE_UNLIMITED);
724     while (!avio_feof(s->pb)) {
725         char line[MAX_LINE_SIZE];
726         int len = ff_get_line(s->pb, line, sizeof(line));
727
728         if (!len)
729             break;
730
731         line[strcspn(line, "\r\n")] = 0;
732
733         if (!strncmp(line, "id:", 3)) {
734             if (sscanf(line, "id: %63[^,], index: %u", id, &stream_id) != 2) {
735                 av_log(s, AV_LOG_WARNING, "Unable to parse index line '%s', "
736                        "assuming 'id: und, index: 0'\n", line);
737                 strcpy(id, "und");
738                 stream_id = 0;
739             }
740
741             if (stream_id >= FF_ARRAY_ELEMS(vobsub->q)) {
742                 av_log(s, AV_LOG_ERROR, "Maximum number of subtitles streams reached\n");
743                 ret = AVERROR(EINVAL);
744                 goto end;
745             }
746
747             header_parsed = 1;
748             alt[0] = '\0';
749             /* We do not create the stream immediately to avoid adding empty
750              * streams. See the following timestamp entry. */
751
752             av_log(s, AV_LOG_DEBUG, "IDX stream[%d] id=%s\n", stream_id, id);
753
754         } else if (!strncmp(line, "timestamp:", 10)) {
755             AVPacket *sub;
756             int hh, mm, ss, ms;
757             int64_t pos, timestamp;
758             const char *p = line + 10;
759
760             if (stream_id == -1) {
761                 av_log(s, AV_LOG_ERROR, "Timestamp declared before any stream\n");
762                 ret = AVERROR_INVALIDDATA;
763                 goto end;
764             }
765
766             if (!st || st->id != stream_id) {
767                 st = avformat_new_stream(s, NULL);
768                 if (!st) {
769                     ret = AVERROR(ENOMEM);
770                     goto end;
771                 }
772                 st->id = stream_id;
773                 st->codec->codec_type = AVMEDIA_TYPE_SUBTITLE;
774                 st->codec->codec_id   = AV_CODEC_ID_DVD_SUBTITLE;
775                 avpriv_set_pts_info(st, 64, 1, 1000);
776                 av_dict_set(&st->metadata, "language", id, 0);
777                 if (alt[0])
778                     av_dict_set(&st->metadata, "title", alt, 0);
779             }
780
781             if (sscanf(p, "%02d:%02d:%02d:%03d, filepos: %"SCNx64,
782                        &hh, &mm, &ss, &ms, &pos) != 5) {
783                 av_log(s, AV_LOG_ERROR, "Unable to parse timestamp line '%s', "
784                        "abort parsing\n", line);
785                 ret = AVERROR_INVALIDDATA;
786                 goto end;
787             }
788             timestamp = (hh*3600LL + mm*60LL + ss) * 1000LL + ms + delay;
789             timestamp = av_rescale_q(timestamp, av_make_q(1, 1000), st->time_base);
790
791             sub = ff_subtitles_queue_insert(&vobsub->q[s->nb_streams - 1], "", 0, 0);
792             if (!sub) {
793                 ret = AVERROR(ENOMEM);
794                 goto end;
795             }
796             sub->pos = pos;
797             sub->pts = timestamp;
798             sub->stream_index = s->nb_streams - 1;
799
800         } else if (!strncmp(line, "alt:", 4)) {
801             const char *p = line + 4;
802
803             while (*p == ' ')
804                 p++;
805             av_log(s, AV_LOG_DEBUG, "IDX stream[%d] name=%s\n", stream_id, p);
806             av_strlcpy(alt, p, sizeof(alt));
807             header_parsed = 1;
808
809         } else if (!strncmp(line, "delay:", 6)) {
810             int sign = 1, hh = 0, mm = 0, ss = 0, ms = 0;
811             const char *p = line + 6;
812
813             while (*p == ' ')
814                 p++;
815             if (*p == '-' || *p == '+') {
816                 sign = *p == '-' ? -1 : 1;
817                 p++;
818             }
819             sscanf(p, "%d:%d:%d:%d", &hh, &mm, &ss, &ms);
820             delay = ((hh*3600LL + mm*60LL + ss) * 1000LL + ms) * sign;
821
822         } else if (!strncmp(line, "langidx:", 8)) {
823             const char *p = line + 8;
824
825             if (sscanf(p, "%d", &langidx) != 1)
826                 av_log(s, AV_LOG_ERROR, "Invalid langidx specified\n");
827
828         } else if (!header_parsed) {
829             if (line[0] && line[0] != '#')
830                 av_bprintf(&header, "%s\n", line);
831         }
832     }
833
834     if (langidx < s->nb_streams)
835         s->streams[langidx]->disposition |= AV_DISPOSITION_DEFAULT;
836
837     for (i = 0; i < s->nb_streams; i++) {
838         vobsub->q[i].sort = SUB_SORT_POS_TS;
839         ff_subtitles_queue_finalize(&vobsub->q[i]);
840     }
841
842     if (!av_bprint_is_complete(&header)) {
843         av_bprint_finalize(&header, NULL);
844         ret = AVERROR(ENOMEM);
845         goto end;
846     }
847     av_bprint_finalize(&header, &header_str);
848     for (i = 0; i < s->nb_streams; i++) {
849         AVStream *sub_st = s->streams[i];
850         sub_st->codec->extradata      = av_strdup(header_str);
851         sub_st->codec->extradata_size = header.len;
852     }
853     av_free(header_str);
854
855 end:
856     av_free(sub_name);
857     return ret;
858 }
859
860 static int vobsub_read_packet(AVFormatContext *s, AVPacket *pkt)
861 {
862     MpegDemuxContext *vobsub = s->priv_data;
863     FFDemuxSubtitlesQueue *q;
864     AVIOContext *pb = vobsub->sub_ctx->pb;
865     int ret, psize, total_read = 0, i;
866     AVPacket idx_pkt;
867
868     int64_t min_ts = INT64_MAX;
869     int sid = 0;
870     for (i = 0; i < s->nb_streams; i++) {
871         FFDemuxSubtitlesQueue *tmpq = &vobsub->q[i];
872         int64_t ts;
873         av_assert0(tmpq->nb_subs);
874         ts = tmpq->subs[tmpq->current_sub_idx].pts;
875         if (ts < min_ts) {
876             min_ts = ts;
877             sid = i;
878         }
879     }
880     q = &vobsub->q[sid];
881     ret = ff_subtitles_queue_read_packet(q, &idx_pkt);
882     if (ret < 0)
883         return ret;
884
885     /* compute maximum packet size using the next packet position. This is
886      * useful when the len in the header is non-sense */
887     if (q->current_sub_idx < q->nb_subs) {
888         psize = q->subs[q->current_sub_idx].pos - idx_pkt.pos;
889     } else {
890         int64_t fsize = avio_size(pb);
891         psize = fsize < 0 ? 0xffff : fsize - idx_pkt.pos;
892     }
893
894     avio_seek(pb, idx_pkt.pos, SEEK_SET);
895
896     av_init_packet(pkt);
897     pkt->size = 0;
898     pkt->data = NULL;
899
900     do {
901         int n, to_read, startcode;
902         int64_t pts, dts;
903         int64_t old_pos = avio_tell(pb), new_pos;
904         int pkt_size;
905
906         ret = mpegps_read_pes_header(vobsub->sub_ctx, NULL, &startcode, &pts, &dts);
907         if (ret < 0) {
908             if (pkt->size) // raise packet even if incomplete
909                 break;
910             goto fail;
911         }
912         to_read = ret & 0xffff;
913         new_pos = avio_tell(pb);
914         pkt_size = ret + (new_pos - old_pos);
915
916         /* this prevents reads above the current packet */
917         if (total_read + pkt_size > psize)
918             break;
919         total_read += pkt_size;
920
921         /* the current chunk doesn't match the stream index (unlikely) */
922         if ((startcode & 0x1f) != idx_pkt.stream_index)
923             break;
924
925         ret = av_grow_packet(pkt, to_read);
926         if (ret < 0)
927             goto fail;
928
929         n = avio_read(pb, pkt->data + (pkt->size - to_read), to_read);
930         if (n < to_read)
931             pkt->size -= to_read - n;
932     } while (total_read < psize);
933
934     pkt->pts = pkt->dts = idx_pkt.pts;
935     pkt->pos = idx_pkt.pos;
936     pkt->stream_index = idx_pkt.stream_index;
937
938     av_free_packet(&idx_pkt);
939     return 0;
940
941 fail:
942     av_free_packet(pkt);
943     av_free_packet(&idx_pkt);
944     return ret;
945 }
946
947 static int vobsub_read_seek(AVFormatContext *s, int stream_index,
948                             int64_t min_ts, int64_t ts, int64_t max_ts, int flags)
949 {
950     MpegDemuxContext *vobsub = s->priv_data;
951
952     /* Rescale requested timestamps based on the first stream (timebase is the
953      * same for all subtitles stream within a .idx/.sub). Rescaling is done just
954      * like in avformat_seek_file(). */
955     if (stream_index == -1 && s->nb_streams != 1) {
956         int i, ret = 0;
957         AVRational time_base = s->streams[0]->time_base;
958         ts = av_rescale_q(ts, AV_TIME_BASE_Q, time_base);
959         min_ts = av_rescale_rnd(min_ts, time_base.den,
960                                 time_base.num * (int64_t)AV_TIME_BASE,
961                                 AV_ROUND_UP   | AV_ROUND_PASS_MINMAX);
962         max_ts = av_rescale_rnd(max_ts, time_base.den,
963                                 time_base.num * (int64_t)AV_TIME_BASE,
964                                 AV_ROUND_DOWN | AV_ROUND_PASS_MINMAX);
965         for (i = 0; i < s->nb_streams; i++) {
966             int r = ff_subtitles_queue_seek(&vobsub->q[i], s, stream_index,
967                                             min_ts, ts, max_ts, flags);
968             if (r < 0)
969                 ret = r;
970         }
971         return ret;
972     }
973
974     if (stream_index == -1) // only 1 stream
975         stream_index = 0;
976     return ff_subtitles_queue_seek(&vobsub->q[stream_index], s, stream_index,
977                                    min_ts, ts, max_ts, flags);
978 }
979
980 static int vobsub_read_close(AVFormatContext *s)
981 {
982     int i;
983     MpegDemuxContext *vobsub = s->priv_data;
984
985     for (i = 0; i < s->nb_streams; i++)
986         ff_subtitles_queue_clean(&vobsub->q[i]);
987     if (vobsub->sub_ctx)
988         avformat_close_input(&vobsub->sub_ctx);
989     return 0;
990 }
991
992 AVInputFormat ff_vobsub_demuxer = {
993     .name           = "vobsub",
994     .long_name      = NULL_IF_CONFIG_SMALL("VobSub subtitle format"),
995     .priv_data_size = sizeof(MpegDemuxContext),
996     .read_probe     = vobsub_probe,
997     .read_header    = vobsub_read_header,
998     .read_packet    = vobsub_read_packet,
999     .read_seek2     = vobsub_read_seek,
1000     .read_close     = vobsub_read_close,
1001     .flags          = AVFMT_SHOW_IDS,
1002     .extensions     = "idx",
1003 };
1004 #endif