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