mpeg.c 46.7 KB
Newer Older
F
Fabrice Bellard 已提交
1
/*
2
 * MPEG1/2 mux/demux
F
Fabrice Bellard 已提交
3
 * Copyright (c) 2000, 2001, 2002 Fabrice Bellard.
F
Fabrice Bellard 已提交
4
 *
F
Fabrice Bellard 已提交
5 6 7 8
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2 of the License, or (at your option) any later version.
F
Fabrice Bellard 已提交
9
 *
F
Fabrice Bellard 已提交
10
 * This library is distributed in the hope that it will be useful,
F
Fabrice Bellard 已提交
11
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
F
Fabrice Bellard 已提交
12 13
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
F
Fabrice Bellard 已提交
14
 *
F
Fabrice Bellard 已提交
15 16 17
 * You should have received a copy of the GNU Lesser General Public
 * License along with this library; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
F
Fabrice Bellard 已提交
18 19 20 21
 */
#include "avformat.h"

#define MAX_PAYLOAD_SIZE 4096
M
Michael Niedermayer 已提交
22
#define PRELOAD 45000 //0.5sec
F
Fabrice Bellard 已提交
23
//#define DEBUG_SEEK
F
Fabrice Bellard 已提交
24

25 26 27
#undef NDEBUG
#include <assert.h>

M
Michael Niedermayer 已提交
28 29 30 31 32 33 34 35 36
typedef struct PacketDesc {
    int64_t pts;
    int64_t dts;
    int size;
    int unwritten_size;
    int flags;
    struct PacketDesc *next;
} PacketDesc;

F
Fabrice Bellard 已提交
37
typedef struct {
M
Michael Niedermayer 已提交
38
    FifoBuffer fifo;
39
    uint8_t id;
F
Fabrice Bellard 已提交
40
    int max_buffer_size; /* in bytes */
M
Michael Niedermayer 已提交
41 42 43 44
    int buffer_index;
    PacketDesc *predecode_packet;
    PacketDesc *premux_packet;
    PacketDesc **next_packet;
F
Fabrice Bellard 已提交
45
    int packet_number;
F
Fabrice Bellard 已提交
46 47
    uint8_t lpcm_header[3];
    int lpcm_align;
F
Fabrice Bellard 已提交
48 49 50 51 52 53 54
} StreamInfo;

typedef struct {
    int packet_size; /* required packet size */
    int packet_number;
    int pack_header_freq;     /* frequency (in packets^-1) at which we send pack headers */
    int system_header_freq;
55
    int system_header_size;
F
Fabrice Bellard 已提交
56 57 58 59
    int mux_rate; /* bitrate in units of 50 bytes/s */
    /* stream info */
    int audio_bound;
    int video_bound;
60 61
    int is_mpeg2;
    int is_vcd;
62
    int is_svcd;
63
    int64_t last_scr; /* current system clock */
64

65
    double vcd_padding_bitrate; //FIXME floats
66 67
    int64_t vcd_padding_bytes_written;

F
Fabrice Bellard 已提交
68 69 70 71
} MpegMuxContext;

#define PACK_START_CODE             ((unsigned int)0x000001ba)
#define SYSTEM_HEADER_START_CODE    ((unsigned int)0x000001bb)
72
#define SEQUENCE_END_CODE           ((unsigned int)0x000001b7)
F
Fabrice Bellard 已提交
73 74 75 76 77 78 79 80 81 82 83 84 85
#define PACKET_START_CODE_MASK      ((unsigned int)0xffffff00)
#define PACKET_START_CODE_PREFIX    ((unsigned int)0x00000100)
#define ISO_11172_END_CODE          ((unsigned int)0x000001b9)
  
/* mpeg2 */
#define PROGRAM_STREAM_MAP 0x1bc
#define PRIVATE_STREAM_1   0x1bd
#define PADDING_STREAM     0x1be
#define PRIVATE_STREAM_2   0x1bf


#define AUDIO_ID 0xc0
#define VIDEO_ID 0xe0
F
Fabrice Bellard 已提交
86
#define AC3_ID   0x80
87
#define DTS_ID   0x8a
F
Fabrice Bellard 已提交
88
#define LPCM_ID  0xa0
F
Fabrice Bellard 已提交
89

90 91
static const int lpcm_freq_tab[4] = { 48000, 96000, 44100, 32000 };

92
#ifdef CONFIG_ENCODERS
F
Falk Hüffner 已提交
93 94 95 96
static AVOutputFormat mpeg1system_mux;
static AVOutputFormat mpeg1vcd_mux;
static AVOutputFormat mpeg2vob_mux;
static AVOutputFormat mpeg2svcd_mux;
97

F
Fabrice Bellard 已提交
98
static int put_pack_header(AVFormatContext *ctx, 
99
                           uint8_t *buf, int64_t timestamp)
F
Fabrice Bellard 已提交
100 101 102 103
{
    MpegMuxContext *s = ctx->priv_data;
    PutBitContext pb;
    
A
Alex Beregszaszi 已提交
104
    init_put_bits(&pb, buf, 128);
F
Fabrice Bellard 已提交
105 106

    put_bits(&pb, 32, PACK_START_CODE);
107
    if (s->is_mpeg2) {
108
        put_bits(&pb, 2, 0x1);
109 110 111
    } else {
        put_bits(&pb, 4, 0x2);
    }
112
    put_bits(&pb, 3, (uint32_t)((timestamp >> 30) & 0x07));
F
Fabrice Bellard 已提交
113
    put_bits(&pb, 1, 1);
114
    put_bits(&pb, 15, (uint32_t)((timestamp >> 15) & 0x7fff));
F
Fabrice Bellard 已提交
115
    put_bits(&pb, 1, 1);
116
    put_bits(&pb, 15, (uint32_t)((timestamp) & 0x7fff));
F
Fabrice Bellard 已提交
117
    put_bits(&pb, 1, 1);
118 119 120 121
    if (s->is_mpeg2) {
        /* clock extension */
        put_bits(&pb, 9, 0);
    }
F
Fabrice Bellard 已提交
122 123 124
    put_bits(&pb, 1, 1);
    put_bits(&pb, 22, s->mux_rate);
    put_bits(&pb, 1, 1);
125
    if (s->is_mpeg2) {
126
        put_bits(&pb, 1, 1);
127 128 129
        put_bits(&pb, 5, 0x1f); /* reserved */
        put_bits(&pb, 3, 0); /* stuffing length */
    }
F
Fabrice Bellard 已提交
130
    flush_put_bits(&pb);
131
    return pbBufPtr(&pb) - pb.buf;
F
Fabrice Bellard 已提交
132 133
}

134
static int put_system_header(AVFormatContext *ctx, uint8_t *buf,int only_for_stream_id)
F
Fabrice Bellard 已提交
135 136
{
    MpegMuxContext *s = ctx->priv_data;
M
Michael Niedermayer 已提交
137
    int size, i, private_stream_coded, id;
F
Fabrice Bellard 已提交
138 139
    PutBitContext pb;

A
Alex Beregszaszi 已提交
140
    init_put_bits(&pb, buf, 128);
F
Fabrice Bellard 已提交
141 142 143 144 145

    put_bits(&pb, 32, SYSTEM_HEADER_START_CODE);
    put_bits(&pb, 16, 0);
    put_bits(&pb, 1, 1);
    
M
Michael Niedermayer 已提交
146
    put_bits(&pb, 22, s->mux_rate); /* maximum bit rate of the multiplexed stream */
F
Fabrice Bellard 已提交
147
    put_bits(&pb, 1, 1); /* marker */
148 149 150 151 152
    if (s->is_vcd && only_for_stream_id==VIDEO_ID) {
        /* This header applies only to the video stream (see VCD standard p. IV-7)*/
        put_bits(&pb, 6, 0);
    } else
        put_bits(&pb, 6, s->audio_bound);
F
Fabrice Bellard 已提交
153

154 155 156 157 158 159 160 161
    if (s->is_vcd) {
        /* see VCD standard, p. IV-7*/
        put_bits(&pb, 1, 0); 
        put_bits(&pb, 1, 1);
    } else {
        put_bits(&pb, 1, 0); /* variable bitrate*/
        put_bits(&pb, 1, 0); /* non constrainted bit stream */
    }
F
Fabrice Bellard 已提交
162
    
163 164 165 166 167 168 169 170 171
    if (s->is_vcd) {
        /* see VCD standard p IV-7 */
        put_bits(&pb, 1, 1); /* audio locked */
        put_bits(&pb, 1, 1); /* video locked */
    } else {
        put_bits(&pb, 1, 0); /* audio locked */
        put_bits(&pb, 1, 0); /* video locked */
    }

F
Fabrice Bellard 已提交
172 173
    put_bits(&pb, 1, 1); /* marker */

174 175 176 177 178 179
    if (s->is_vcd && only_for_stream_id==AUDIO_ID) {
        /* This header applies only to the audio stream (see VCD standard p. IV-7)*/
        put_bits(&pb, 5, 0);
    } else
        put_bits(&pb, 5, s->video_bound);

F
Fabrice Bellard 已提交
180 181 182 183 184 185
    put_bits(&pb, 8, 0xff); /* reserved byte */
    
    /* audio stream info */
    private_stream_coded = 0;
    for(i=0;i<ctx->nb_streams;i++) {
        StreamInfo *stream = ctx->streams[i]->priv_data;
186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211
        
        /* For VCDs, only include the stream info for the stream
           that the pack which contains this system belongs to.
           (see VCD standard p. IV-7) */
        if ( !s->is_vcd || stream->id==only_for_stream_id
            || only_for_stream_id==0) {

            id = stream->id;
            if (id < 0xc0) {
                /* special case for private streams (AC3 use that) */
                if (private_stream_coded)
                    continue;
                private_stream_coded = 1;
                id = 0xbd;
            }
            put_bits(&pb, 8, id); /* stream ID */
            put_bits(&pb, 2, 3);
            if (id < 0xe0) {
                /* audio */
                put_bits(&pb, 1, 0);
                put_bits(&pb, 13, stream->max_buffer_size / 128);
            } else {
                /* video */
                put_bits(&pb, 1, 1);
                put_bits(&pb, 13, stream->max_buffer_size / 1024);
            }
F
Fabrice Bellard 已提交
212 213 214
        }
    }
    flush_put_bits(&pb);
215
    size = pbBufPtr(&pb) - pb.buf;
F
Fabrice Bellard 已提交
216 217 218 219 220 221 222
    /* patch packet size */
    buf[4] = (size - 6) >> 8;
    buf[5] = (size - 6) & 0xff;

    return size;
}

223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241
static int get_system_header_size(AVFormatContext *ctx)
{
    int buf_index, i, private_stream_coded;
    StreamInfo *stream;

    buf_index = 12;
    private_stream_coded = 0;
    for(i=0;i<ctx->nb_streams;i++) {
        stream = ctx->streams[i]->priv_data;
        if (stream->id < 0xc0) {
            if (private_stream_coded)
                continue;
            private_stream_coded = 1;
        }
        buf_index += 3;
    }
    return buf_index;
}

F
Fabrice Bellard 已提交
242 243
static int mpeg_mux_init(AVFormatContext *ctx)
{
244
    MpegMuxContext *s = ctx->priv_data;
245
    int bitrate, i, mpa_id, mpv_id, ac3_id, dts_id, lpcm_id, j;
F
Fabrice Bellard 已提交
246 247
    AVStream *st;
    StreamInfo *stream;
248 249
    int audio_bitrate;
    int video_bitrate;
F
Fabrice Bellard 已提交
250 251

    s->packet_number = 0;
252
    s->is_vcd = (ctx->oformat == &mpeg1vcd_mux);
253 254
    s->is_svcd = (ctx->oformat == &mpeg2svcd_mux);
    s->is_mpeg2 = (ctx->oformat == &mpeg2vob_mux || ctx->oformat == &mpeg2svcd_mux);
255
    
256 257
    if (s->is_vcd || s->is_svcd)
        s->packet_size = 2324; /* VCD/SVCD packet size */
258 259
    else
        s->packet_size = 2048;
260 261 262

    s->vcd_padding_bytes_written = 0;
    s->vcd_padding_bitrate=0;
263
        
F
Fabrice Bellard 已提交
264 265 266
    s->audio_bound = 0;
    s->video_bound = 0;
    mpa_id = AUDIO_ID;
F
Fabrice Bellard 已提交
267
    ac3_id = AC3_ID;
268
    dts_id = DTS_ID;
F
Fabrice Bellard 已提交
269
    mpv_id = VIDEO_ID;
F
Fabrice Bellard 已提交
270
    lpcm_id = LPCM_ID;
F
Fabrice Bellard 已提交
271 272 273 274 275 276 277 278 279
    for(i=0;i<ctx->nb_streams;i++) {
        st = ctx->streams[i];
        stream = av_mallocz(sizeof(StreamInfo));
        if (!stream)
            goto fail;
        st->priv_data = stream;

        switch(st->codec.codec_type) {
        case CODEC_TYPE_AUDIO:
F
Fabrice Bellard 已提交
280
            if (st->codec.codec_id == CODEC_ID_AC3) {
F
Fabrice Bellard 已提交
281
                stream->id = ac3_id++;
282 283
            } else if (st->codec.codec_id == CODEC_ID_DTS) {
                stream->id = dts_id++;
F
Fabrice Bellard 已提交
284 285 286 287 288 289 290 291 292 293 294 295 296 297 298
            } else if (st->codec.codec_id == CODEC_ID_PCM_S16BE) {
                stream->id = lpcm_id++;
                for(j = 0; j < 4; j++) {
                    if (lpcm_freq_tab[j] == st->codec.sample_rate)
                        break;
                }
                if (j == 4)
                    goto fail;
                if (st->codec.channels > 8)
                    return -1;
                stream->lpcm_header[0] = 0x0c;
                stream->lpcm_header[1] = (st->codec.channels - 1) | (j << 4);
                stream->lpcm_header[2] = 0x80;
                stream->lpcm_align = st->codec.channels * 2;
            } else {
F
Fabrice Bellard 已提交
299
                stream->id = mpa_id++;
F
Fabrice Bellard 已提交
300
            }
301 302 303

            /* This value HAS to be used for VCD (see VCD standard, p. IV-7).
               Right now it is also used for everything else.*/
F
Fabrice Bellard 已提交
304 305 306 307 308
            stream->max_buffer_size = 4 * 1024; 
            s->audio_bound++;
            break;
        case CODEC_TYPE_VIDEO:
            stream->id = mpv_id++;
M
Michael Niedermayer 已提交
309 310 311 312 313
            if (st->codec.rc_buffer_size)
                stream->max_buffer_size = 6*1024 + st->codec.rc_buffer_size/8;
            else
                stream->max_buffer_size = 230*1024; //FIXME this is probably too small as default
#if 0
314 315 316 317 318 319
                /* see VCD standard, p. IV-7*/
                stream->max_buffer_size = 46 * 1024; 
            else
                /* This value HAS to be used for SVCD (see SVCD standard, p. 26 V.2.3.2).
                   Right now it is also used for everything else.*/
                stream->max_buffer_size = 230 * 1024; 
M
Michael Niedermayer 已提交
320
#endif
F
Fabrice Bellard 已提交
321 322
            s->video_bound++;
            break;
323
        default:
M
Michael Niedermayer 已提交
324
            return -1;
F
Fabrice Bellard 已提交
325
        }
M
Michael Niedermayer 已提交
326 327
        fifo_init(&stream->fifo, 2*stream->max_buffer_size + 100*MAX_PAYLOAD_SIZE); //FIXME think about the size maybe dynamically realloc
        stream->next_packet= &stream->premux_packet;
F
Fabrice Bellard 已提交
328
    }
329 330 331
    bitrate = 0;
    audio_bitrate = 0;
    video_bitrate = 0;
F
Fabrice Bellard 已提交
332
    for(i=0;i<ctx->nb_streams;i++) {
M
Michael Niedermayer 已提交
333
        int codec_rate;
F
Fabrice Bellard 已提交
334
        st = ctx->streams[i];
335
        stream = (StreamInfo*) st->priv_data;
M
Michael Niedermayer 已提交
336 337 338 339 340 341 342 343 344 345

        if(st->codec.rc_max_rate || stream->id==VIDEO_ID)
            codec_rate= st->codec.rc_max_rate;
        else
            codec_rate= st->codec.bit_rate;
                
        if(!codec_rate)
            codec_rate= (1<<21)*8*50/ctx->nb_streams;
            
        bitrate += codec_rate;
346 347

        if (stream->id==AUDIO_ID)
M
Michael Niedermayer 已提交
348
            audio_bitrate += codec_rate;
349
        else if (stream->id==VIDEO_ID)
M
Michael Niedermayer 已提交
350
            video_bitrate += codec_rate;
351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383
    }

    if (s->is_vcd) {
        double overhead_rate;

        /* The VCD standard mandates that the mux_rate field is 3528
           (see standard p. IV-6).
           The value is actually "wrong", i.e. if you calculate
           it using the normal formula and the 75 sectors per second transfer
           rate you get a different value because the real pack size is 2324,
           not 2352. But the standard explicitly specifies that the mux_rate
           field in the header must have this value.*/
        s->mux_rate=2352 * 75 / 50;    /* = 3528*/

        /* The VCD standard states that the muxed stream must be
           exactly 75 packs / second (the data rate of a single speed cdrom).
           Since the video bitrate (probably 1150000 bits/sec) will be below
           the theoretical maximum we have to add some padding packets
           to make up for the lower data rate.
           (cf. VCD standard p. IV-6 )*/

        /* Add the header overhead to the data rate.
           2279 data bytes per audio pack, 2294 data bytes per video pack*/
        overhead_rate = ((audio_bitrate / 8.0) / 2279) * (2324 - 2279);
        overhead_rate += ((video_bitrate / 8.0) / 2294) * (2324 - 2294);
        overhead_rate *= 8;
        
        /* Add padding so that the full bitrate is 2324*75 bytes/sec */
        s->vcd_padding_bitrate = 2324 * 75 * 8 - (bitrate + overhead_rate);

    } else {
        /* we increase slightly the bitrate to take into account the
           headers. XXX: compute it exactly */
M
Michael Niedermayer 已提交
384 385
        bitrate += bitrate*5/100;
        bitrate += 10000;
386
        s->mux_rate = (bitrate + (8 * 50) - 1) / (8 * 50);
F
Fabrice Bellard 已提交
387
    }
388
    
389
    if (s->is_vcd || s->is_mpeg2)
390 391 392 393 394
        /* every packet */
        s->pack_header_freq = 1;
    else
        /* every 2 seconds */
        s->pack_header_freq = 2 * bitrate / s->packet_size / 8;
395 396 397 398

    /* the above seems to make pack_header_freq zero sometimes */
    if (s->pack_header_freq == 0)
       s->pack_header_freq = 1;
399
    
400 401 402 403
    if (s->is_mpeg2)
        /* every 200 packets. Need to look at the spec.  */
        s->system_header_freq = s->pack_header_freq * 40;
    else if (s->is_vcd)
404 405 406 407
        /* the standard mandates that there are only two system headers
           in the whole file: one in the first packet of each stream.
           (see standard p. IV-7 and IV-8) */
        s->system_header_freq = 0x7fffffff;
408 409 410
    else
        s->system_header_freq = s->pack_header_freq * 5;
    
F
Fabrice Bellard 已提交
411 412 413 414
    for(i=0;i<ctx->nb_streams;i++) {
        stream = ctx->streams[i]->priv_data;
        stream->packet_number = 0;
    }
415
    s->system_header_size = get_system_header_size(ctx);
416
    s->last_scr = 0;
F
Fabrice Bellard 已提交
417 418 419
    return 0;
 fail:
    for(i=0;i<ctx->nb_streams;i++) {
420
        av_free(ctx->streams[i]->priv_data);
F
Fabrice Bellard 已提交
421 422 423 424
    }
    return -ENOMEM;
}

425 426 427 428 429 430 431 432 433 434
static inline void put_timestamp(ByteIOContext *pb, int id, int64_t timestamp)
{
    put_byte(pb, 
             (id << 4) | 
             (((timestamp >> 30) & 0x07) << 1) | 
             1);
    put_be16(pb, (uint16_t)((((timestamp >> 15) & 0x7fff) << 1) | 1));
    put_be16(pb, (uint16_t)((((timestamp) & 0x7fff) << 1) | 1));
}

435

436 437 438 439 440 441 442 443 444 445 446
/* return the number of padding bytes that should be inserted into
   the multiplexed stream.*/
static int get_vcd_padding_size(AVFormatContext *ctx, int64_t pts)
{
    MpegMuxContext *s = ctx->priv_data;
    int pad_bytes = 0;

    if (s->vcd_padding_bitrate > 0 && pts!=AV_NOPTS_VALUE)
    {
        int64_t full_pad_bytes;
        
M
Michael Niedermayer 已提交
447
        full_pad_bytes = (int64_t)((s->vcd_padding_bitrate * (pts / 90000.0)) / 8.0); //FIXME this is wrong
448 449 450 451 452 453 454 455 456 457 458 459
        pad_bytes = (int) (full_pad_bytes - s->vcd_padding_bytes_written);

        if (pad_bytes<0)
            /* might happen if we have already padded to a later timestamp. This
               can occur if another stream has already advanced further.*/
            pad_bytes=0;
    }

    return pad_bytes;
}


460 461 462 463 464 465 466 467 468 469
/* return the exact available payload size for the next packet for
   stream 'stream_index'. 'pts' and 'dts' are only used to know if
   timestamps are needed in the packet header. */
static int get_packet_payload_size(AVFormatContext *ctx, int stream_index,
                                   int64_t pts, int64_t dts)
{
    MpegMuxContext *s = ctx->priv_data;
    int buf_index;
    StreamInfo *stream;

470 471
    stream = ctx->streams[stream_index]->priv_data;

472 473 474 475 476 477 478
    buf_index = 0;
    if (((s->packet_number % s->pack_header_freq) == 0)) {
        /* pack header size */
        if (s->is_mpeg2) 
            buf_index += 14;
        else
            buf_index += 12;
479 480 481 482 483 484 485 486 487 488 489 490 491 492 493
        
        if (s->is_vcd) {
            /* there is exactly one system header for each stream in a VCD MPEG,
               One in the very first video packet and one in the very first
               audio packet (see VCD standard p. IV-7 and IV-8).*/
            
            if (stream->packet_number==0)
                /* The system headers refer only to the stream they occur in,
                   so they have a constant size.*/
                buf_index += 15;

        } else {            
            if ((s->packet_number % s->system_header_freq) == 0)
                buf_index += s->system_header_size;
        }
494 495
    }

496 497
    if ((s->is_vcd && stream->packet_number==0)
        || (s->is_svcd && s->packet_number==0))
498 499 500 501 502 503 504
        /* the first pack of each stream contains only the pack header,
           the system header and some padding (see VCD standard p. IV-6) 
           Add the padding size, so that the actual payload becomes 0.*/
        buf_index += s->packet_size - buf_index;
    else {
        /* packet header size */
        buf_index += 6;
505
        if (s->is_mpeg2) {
F
Fabrice Bellard 已提交
506
            buf_index += 3;
507 508 509 510
            if (stream->packet_number==0)
                buf_index += 3; /* PES extension */
            buf_index += 1;    /* obligatory stuffing byte */
        }
511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533
        if (pts != AV_NOPTS_VALUE) {
            if (dts != pts)
                buf_index += 5 + 5;
            else
                buf_index += 5;

        } else {
            if (!s->is_mpeg2)
                buf_index++;
        }
    
        if (stream->id < 0xc0) {
            /* AC3/LPCM private data header */
            buf_index += 4;
            if (stream->id >= 0xa0) {
                int n;
                buf_index += 3;
                /* NOTE: we round the payload size to an integer number of
                   LPCM samples */
                n = (s->packet_size - buf_index) % stream->lpcm_align;
                if (n)
                    buf_index += (stream->lpcm_align - n);
            }
F
Fabrice Bellard 已提交
534
        }
535 536 537 538 539

        if (s->is_vcd && stream->id == AUDIO_ID)
            /* The VCD standard demands that 20 zero bytes follow
               each audio packet (see standard p. IV-8).*/
            buf_index+=20;
540 541 542 543
    }
    return s->packet_size - buf_index; 
}

544
/* Write an MPEG padding packet header. */
545
static void put_padding_packet(AVFormatContext *ctx, ByteIOContext *pb,int packet_bytes)
546 547
{
    MpegMuxContext *s = ctx->priv_data;
548 549 550 551
    int i;
    
    put_be32(pb, PADDING_STREAM);
    put_be16(pb, packet_bytes - 6);
552
    if (!s->is_mpeg2) {
553 554
        put_byte(pb, 0x0f);
        packet_bytes -= 7;
555
    } else
556
        packet_bytes -= 6;
557 558 559 560 561

    for(i=0;i<packet_bytes;i++)
        put_byte(pb, 0xff);
}

M
Michael Niedermayer 已提交
562 563 564 565 566 567 568 569 570 571 572 573 574
static int get_nb_frames(AVFormatContext *ctx, StreamInfo *stream, int len){
    int nb_frames=0;
    PacketDesc *pkt_desc= stream->premux_packet;

    while(len>0){ 
        if(pkt_desc->size == pkt_desc->unwritten_size)
            nb_frames++;
        len -= pkt_desc->unwritten_size;
        pkt_desc= pkt_desc->next;
    }

    return nb_frames;
}
575

F
Fabrice Bellard 已提交
576
/* flush the packet on stream stream_index */
M
Michael Niedermayer 已提交
577 578
static int flush_packet(AVFormatContext *ctx, int stream_index, 
                         int64_t pts, int64_t dts, int64_t scr, int trailer_size)
F
Fabrice Bellard 已提交
579 580 581
{
    MpegMuxContext *s = ctx->priv_data;
    StreamInfo *stream = ctx->streams[stream_index]->priv_data;
582
    uint8_t *buf_ptr;
583 584
    int size, payload_size, startcode, id, stuffing_size, i, header_len;
    int packet_size;
585
    uint8_t buffer[128];
586 587
    int zero_trail_bytes = 0;
    int pad_packet_bytes = 0;
588 589
    int pes_flags;
    int general_pack = 0;  /*"general" pack without data specific to one stream?*/
M
Michael Niedermayer 已提交
590
    int nb_frames;
591
    
F
Fabrice Bellard 已提交
592
    id = stream->id;
593
    
F
Fabrice Bellard 已提交
594 595
#if 0
    printf("packet ID=%2x PTS=%0.3f\n", 
596
           id, pts / 90000.0);
F
Fabrice Bellard 已提交
597 598 599
#endif

    buf_ptr = buffer;
600

M
Michael Niedermayer 已提交
601
    if ((s->packet_number % s->pack_header_freq) == 0 || s->last_scr != scr) {
F
Fabrice Bellard 已提交
602
        /* output pack and systems header if needed */
603
        size = put_pack_header(ctx, buf_ptr, scr);
F
Fabrice Bellard 已提交
604
        buf_ptr += size;
M
Michael Niedermayer 已提交
605
        s->last_scr= scr;
606 607 608 609 610 611 612 613 614 615 616 617 618 619 620

        if (s->is_vcd) {
            /* there is exactly one system header for each stream in a VCD MPEG,
               One in the very first video packet and one in the very first
               audio packet (see VCD standard p. IV-7 and IV-8).*/
            
            if (stream->packet_number==0) {
                size = put_system_header(ctx, buf_ptr, id);
                buf_ptr += size;
            }
        } else {
            if ((s->packet_number % s->system_header_freq) == 0) {
                size = put_system_header(ctx, buf_ptr, 0);
                buf_ptr += size;
            }
F
Fabrice Bellard 已提交
621 622 623 624 625
        }
    }
    size = buf_ptr - buffer;
    put_buffer(&ctx->pb, buffer, size);

626 627 628 629 630 631 632
    packet_size = s->packet_size - size;

    if (s->is_vcd && id == AUDIO_ID)
        /* The VCD standard demands that 20 zero bytes follow
           each audio pack (see standard p. IV-8).*/
        zero_trail_bytes += 20;
            
633 634 635
    if ((s->is_vcd && stream->packet_number==0)
        || (s->is_svcd && s->packet_number==0)) {
        /* for VCD the first pack of each stream contains only the pack header,
636 637 638
           the system header and lots of padding (see VCD standard p. IV-6).
           In the case of an audio pack, 20 zero bytes are also added at
           the end.*/
639 640 641 642
        /* For SVCD we fill the very first pack to increase compatibility with
           some DVD players. Not mandated by the standard.*/
        if (s->is_svcd)
            general_pack = 1;    /* the system header refers to both streams and no stream data*/
643
        pad_packet_bytes = packet_size - zero_trail_bytes;
644 645
    }

646
    packet_size -= pad_packet_bytes + zero_trail_bytes;
647

648
    if (packet_size > 0) {
F
Fabrice Bellard 已提交
649

650 651 652 653 654 655
        /* packet header size */
        packet_size -= 6;
        
        /* packet header */
        if (s->is_mpeg2) {
            header_len = 3;
656 657 658
            if (stream->packet_number==0)
                header_len += 3; /* PES extension */
            header_len += 1; /* obligatory stuffing byte */
659 660 661 662 663 664 665 666 667 668 669 670
        } else {
            header_len = 0;
        }
        if (pts != AV_NOPTS_VALUE) {
            if (dts != pts)
                header_len += 5 + 5;
            else
                header_len += 5;
        } else {
            if (!s->is_mpeg2)
                header_len++;
        }
671

672 673 674 675 676 677 678 679 680
        payload_size = packet_size - header_len;
        if (id < 0xc0) {
            startcode = PRIVATE_STREAM_1;
            payload_size -= 4;
            if (id >= 0xa0)
                payload_size -= 3;
        } else {
            startcode = 0x100 + id;
        }
681

M
Michael Niedermayer 已提交
682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698
        stuffing_size = payload_size - fifo_size(&stream->fifo, stream->fifo.rptr);

        // first byte doesnt fit -> reset pts/dts + stuffing
        if(payload_size <= trailer_size && pts != AV_NOPTS_VALUE){
            int timestamp_len=0;
            if(dts != pts) 
                timestamp_len += 5;
            if(pts != AV_NOPTS_VALUE)
                timestamp_len += s->is_mpeg2 ? 5 : 4;
            pts=dts= AV_NOPTS_VALUE;
            header_len -= timestamp_len;
            payload_size += timestamp_len;
            stuffing_size += timestamp_len;
            if(payload_size > trailer_size)
                stuffing_size += payload_size - trailer_size;
        }

699 700
        if (stuffing_size < 0)
            stuffing_size = 0;
701 702 703 704 705 706
        if (stuffing_size > 16) {    /*<=16 for MPEG-1, <=32 for MPEG-2*/
            pad_packet_bytes += stuffing_size;
            packet_size -= stuffing_size;
            payload_size -= stuffing_size;
            stuffing_size = 0;
        }
M
Michael Niedermayer 已提交
707 708
        
        nb_frames= get_nb_frames(ctx, stream, payload_size - stuffing_size);
709

710
        put_be32(&ctx->pb, startcode);
711

712 713 714 715 716 717 718 719 720
        put_be16(&ctx->pb, packet_size);
        
        if (!s->is_mpeg2)
            for(i=0;i<stuffing_size;i++)
                put_byte(&ctx->pb, 0xff);

        if (s->is_mpeg2) {
            put_byte(&ctx->pb, 0x80); /* mpeg2 id */

721 722
            pes_flags=0;

723
            if (pts != AV_NOPTS_VALUE) {
724 725 726
                pes_flags |= 0x80;
                if (dts != pts)
                    pes_flags |= 0x40;
727
            }
728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753

            /* Both the MPEG-2 and the SVCD standards demand that the
               P-STD_buffer_size field be included in the first packet of
               every stream. (see SVCD standard p. 26 V.2.3.1 and V.2.3.2
               and MPEG-2 standard 2.7.7) */
            if (stream->packet_number == 0)
                pes_flags |= 0x01;

            put_byte(&ctx->pb, pes_flags); /* flags */
            put_byte(&ctx->pb, header_len - 3 + stuffing_size);

            if (pes_flags & 0x80)  /*write pts*/
                put_timestamp(&ctx->pb, (pes_flags & 0x40) ? 0x03 : 0x02, pts);
            if (pes_flags & 0x40)  /*write dts*/
                put_timestamp(&ctx->pb, 0x01, dts);
            
            if (pes_flags & 0x01) {  /*write pes extension*/
                put_byte(&ctx->pb, 0x10); /* flags */

                /* P-STD buffer info */                
                if (id == AUDIO_ID)
                    put_be16(&ctx->pb, 0x4000 | stream->max_buffer_size/128);
                else
                    put_be16(&ctx->pb, 0x6000 | stream->max_buffer_size/1024);
            }

754
        } else {
755 756 757 758 759 760 761
            if (pts != AV_NOPTS_VALUE) {
                if (dts != pts) {
                    put_timestamp(&ctx->pb, 0x03, pts);
                    put_timestamp(&ctx->pb, 0x01, dts);
                } else {
                    put_timestamp(&ctx->pb, 0x02, pts);
                }
762
            } else {
763
                put_byte(&ctx->pb, 0x0f);
764 765
            }
        }
F
Fabrice Bellard 已提交
766

767 768 769 770 771 772 773 774 775
        if (s->is_mpeg2) {
            /* special stuffing byte that is always written
               to prevent accidental generation of start codes. */
            put_byte(&ctx->pb, 0xff);

            for(i=0;i<stuffing_size;i++)
                put_byte(&ctx->pb, 0xff);
        }

776 777 778 779 780 781 782 783 784 785 786
        if (startcode == PRIVATE_STREAM_1) {
            put_byte(&ctx->pb, id);
            if (id >= 0xa0) {
                /* LPCM (XXX: check nb_frames) */
                put_byte(&ctx->pb, 7);
                put_be16(&ctx->pb, 4); /* skip 3 header bytes */
                put_byte(&ctx->pb, stream->lpcm_header[0]);
                put_byte(&ctx->pb, stream->lpcm_header[1]);
                put_byte(&ctx->pb, stream->lpcm_header[2]);
            } else {
                /* AC3 */
M
Michael Niedermayer 已提交
787 788
                put_byte(&ctx->pb, nb_frames);
                put_be16(&ctx->pb, trailer_size+1);
789
            }
F
Fabrice Bellard 已提交
790
        }
791 792

        /* output data */
M
Michael Niedermayer 已提交
793 794 795 796 797
        if(put_fifo(&ctx->pb, &stream->fifo, payload_size - stuffing_size, &stream->fifo.rptr) < 0)
            return -1;
    }else{
        payload_size=
        stuffing_size= 0;
F
Fabrice Bellard 已提交
798 799
    }

800 801
    if (pad_packet_bytes > 0)
        put_padding_packet(ctx,&ctx->pb, pad_packet_bytes);    
802

803 804 805
    for(i=0;i<zero_trail_bytes;i++)
        put_byte(&ctx->pb, 0x00);
        
F
Fabrice Bellard 已提交
806 807 808
    put_flush_packet(&ctx->pb);
    
    s->packet_number++;
809 810 811 812 813 814

    /* only increase the stream packet number if this pack actually contains
       something that is specific to this stream! I.e. a dedicated header
       or some data.*/
    if (!general_pack)
        stream->packet_number++;
M
Michael Niedermayer 已提交
815 816
    
    return payload_size - stuffing_size;
F
Fabrice Bellard 已提交
817 818
}

819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843
static void put_vcd_padding_sector(AVFormatContext *ctx)
{
    /* There are two ways to do this padding: writing a sector/pack
       of 0 values, or writing an MPEG padding pack. Both seem to
       work with most decoders, BUT the VCD standard only allows a 0-sector
       (see standard p. IV-4, IV-5).
       So a 0-sector it is...*/

    MpegMuxContext *s = ctx->priv_data;
    int i;

    for(i=0;i<s->packet_size;i++)
        put_byte(&ctx->pb, 0);

    s->vcd_padding_bytes_written += s->packet_size;
        
    put_flush_packet(&ctx->pb);
    
    /* increasing the packet number is correct. The SCR of the following packs
       is calculated from the packet_number and it has to include the padding
       sector (it represents the sector index, not the MPEG pack index)
       (see VCD standard p. IV-6)*/
    s->packet_number++;
}

M
cleanup  
Michael Niedermayer 已提交
844
static int64_t get_vcd_scr(AVFormatContext *ctx,int stream_index,int64_t pts)
845 846 847 848 849 850 851 852 853 854 855 856 857 858 859
{
    MpegMuxContext *s = ctx->priv_data;
    int64_t scr;

        /* Since the data delivery rate is constant, SCR is computed
           using the formula C + i * 1200 where C is the start constant
           and i is the pack index.
           It is recommended that SCR 0 is at the beginning of the VCD front
           margin (a sequence of empty Form 2 sectors on the CD).
           It is recommended that the front margin is 30 sectors long, so
           we use C = 30*1200 = 36000
           (Note that even if the front margin is not 30 sectors the file
           will still be correct according to the standard. It just won't have
           the "recommended" value).*/
        scr = 36000 + s->packet_number * 1200;
860

861 862 863
    return scr;
}    

M
Michael Niedermayer 已提交
864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971
static int remove_decoded_packets(AVFormatContext *ctx, int64_t scr){
//    MpegMuxContext *s = ctx->priv_data;
    int i;

    for(i=0; i<ctx->nb_streams; i++){
        AVStream *st = ctx->streams[i];
        StreamInfo *stream = st->priv_data;
        PacketDesc *pkt_desc= stream->predecode_packet;
        
        while(pkt_desc && scr > pkt_desc->dts){ //FIXME > vs >=
            if(stream->buffer_index < pkt_desc->size || 
               stream->predecode_packet == stream->premux_packet){
                av_log(ctx, AV_LOG_ERROR, "buffer underflow\n");
                break;
            }
            stream->buffer_index -= pkt_desc->size;

            stream->predecode_packet= pkt_desc->next;
            av_freep(&pkt_desc);
        }
    }
    
    return 0;
}

static int output_packet(AVFormatContext *ctx, int flush){
    MpegMuxContext *s = ctx->priv_data;
    AVStream *st;
    StreamInfo *stream;
    int i, avail_space, es_size, trailer_size;
    int best_i= -1;
    int best_score= INT_MIN;
    int ignore_constraints=0;
    int64_t scr= s->last_scr;

retry:
    for(i=0; i<ctx->nb_streams; i++){
        AVStream *st = ctx->streams[i];
        StreamInfo *stream = st->priv_data;
        const int avail_data=  fifo_size(&stream->fifo, stream->fifo.rptr);
        const int space= stream->max_buffer_size - stream->buffer_index;
        int rel_space= 1024*space / stream->max_buffer_size;

        if(s->packet_size > avail_data && !flush)
            return 0;
        if(avail_data==0)
            continue;
        assert(avail_data>0);

        if(space < s->packet_size && !ignore_constraints)
            continue;
            
        if(rel_space > best_score){
            best_score= rel_space;
            best_i = i;
            avail_space= space;
        }
    }
    
    if(best_i < 0){
        int64_t best_dts= INT64_MAX;

        for(i=0; i<ctx->nb_streams; i++){
            AVStream *st = ctx->streams[i];
            StreamInfo *stream = st->priv_data;
            PacketDesc *pkt_desc= stream->predecode_packet;
            if(pkt_desc && pkt_desc->dts < best_dts)
                best_dts= pkt_desc->dts;
        }

#if 0
        av_log(ctx, AV_LOG_DEBUG, "bumping scr, scr:%f, dts:%f\n", 
               scr/90000.0, best_dts/90000.0);
#endif
        if(best_dts == INT64_MAX)
            return 0;

        if(scr >= best_dts+1 && !ignore_constraints){
            av_log(ctx, AV_LOG_ERROR, "packet too large, ignoring buffer limits to mux it\n");
            ignore_constraints= 1;
        }
        scr= FFMAX(best_dts+1, scr);
        if(remove_decoded_packets(ctx, scr) < 0)
            return -1;
        goto retry;
    }

    assert(best_i >= 0);
    
    st = ctx->streams[best_i];
    stream = st->priv_data;
    
    assert(fifo_size(&stream->fifo, stream->fifo.rptr) > 0);

    assert(avail_space >= s->packet_size || ignore_constraints);
    
    if(stream->premux_packet->unwritten_size == stream->premux_packet->size)
        trailer_size= 0;
    else
        trailer_size= stream->premux_packet->unwritten_size;

    es_size= flush_packet(ctx, best_i, stream->premux_packet->pts, stream->premux_packet->dts, scr, trailer_size);

    if (s->is_vcd) {
        /* Write one or more padding sectors, if necessary, to reach
           the constant overall bitrate.*/
        int vcd_pad_bytes;

M
cleanup  
Michael Niedermayer 已提交
972
        while((vcd_pad_bytes = get_vcd_padding_size(ctx,stream->premux_packet->pts) ) >= s->packet_size){ //FIXME pts cannot be correct here
M
Michael Niedermayer 已提交
973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992
            put_vcd_padding_sector(ctx);
            s->last_scr += s->packet_size*90000LL / (s->mux_rate*50LL); //FIXME rounding and first few bytes of each packet
        }
    }
    
    stream->buffer_index += es_size;
    s->last_scr += s->packet_size*90000LL / (s->mux_rate*50LL); //FIXME rounding and first few bytes of each packet
    
    while(stream->premux_packet && stream->premux_packet->unwritten_size <= es_size){
        es_size -= stream->premux_packet->unwritten_size;
        stream->premux_packet= stream->premux_packet->next;
    }
    if(es_size)
        stream->premux_packet->unwritten_size -= es_size;
    
    if(remove_decoded_packets(ctx, s->last_scr) < 0)
        return -1;

    return 1;
}
993

994
static int mpeg_mux_write_packet(AVFormatContext *ctx, AVPacket *pkt)
F
Fabrice Bellard 已提交
995 996
{
    MpegMuxContext *s = ctx->priv_data;
997 998 999
    int stream_index= pkt->stream_index;
    int size= pkt->size;
    uint8_t *buf= pkt->data;
F
Fabrice Bellard 已提交
1000 1001
    AVStream *st = ctx->streams[stream_index];
    StreamInfo *stream = st->priv_data;
M
cleanup  
Michael Niedermayer 已提交
1002
    int64_t pts, dts;
M
Michael Niedermayer 已提交
1003
    PacketDesc *pkt_desc;
1004
    
1005 1006
    pts= pkt->pts;
    dts= pkt->dts;
1007

1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028
    if(s->is_svcd) {
        /* offset pts and dts slightly into the future to be able
           to do the compatibility fix below.*/
        pts = (pts + 2) & ((1LL << 33) - 1);
        dts = (dts + 2) & ((1LL << 33) - 1);

        if (stream->packet_number == 0 && dts == pts)
            /* For the very first packet we want to force the DTS to be included.
               This increases compatibility with lots of DVD players.
               Since the MPEG-2 standard mandates that DTS is only written when
               it is different from PTS we have to move it slightly into the past.*/
            dts = (dts - 2) & ((1LL << 33) - 1);
    }
    if(s->is_vcd) {
        /* We have to offset the PTS, so that it is consistent with the SCR.
           SCR starts at 36000, but the first two packs contain only padding
           and the first pack from the other stream, respectively, may also have
           been written before.
           So the real data starts at SCR 36000+3*1200. */
        pts = (pts + 36000 + 3600) & ((1LL << 33) - 1);
        dts = (dts + 36000 + 3600) & ((1LL << 33) - 1);
M
Michael Niedermayer 已提交
1029 1030 1031
    }else{
        pts = (pts + PRELOAD) & ((1LL << 33) - 1);
        dts = (dts + PRELOAD) & ((1LL << 33) - 1);
1032
    }
1033
    
M
Michael Niedermayer 已提交
1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048
    *stream->next_packet=
    pkt_desc= av_mallocz(sizeof(PacketDesc));
    pkt_desc->pts= pts;
    pkt_desc->dts= dts;
    pkt_desc->unwritten_size=
    pkt_desc->size= size;
    if(!stream->predecode_packet)
        stream->predecode_packet= pkt_desc;
    stream->next_packet= &pkt_desc->next;

    if(stream->fifo.end - stream->fifo.buffer - fifo_size(&stream->fifo, stream->fifo.rptr) < size){
        av_log(ctx, AV_LOG_ERROR, "fifo overflow\n");
        return -1;
    }
    fifo_write(&stream->fifo, buf, size, &stream->fifo.wptr);
1049

M
Michael Niedermayer 已提交
1050 1051
    for(;;){
        int ret= output_packet(ctx, 0);
M
cleanup  
Michael Niedermayer 已提交
1052
        if(ret<=0) 
M
Michael Niedermayer 已提交
1053
            return ret;
1054
    }
F
Fabrice Bellard 已提交
1055 1056 1057 1058
}

static int mpeg_mux_end(AVFormatContext *ctx)
{
M
Michael Niedermayer 已提交
1059
//    MpegMuxContext *s = ctx->priv_data;
F
Fabrice Bellard 已提交
1060 1061
    StreamInfo *stream;
    int i;
M
Michael Niedermayer 已提交
1062 1063 1064 1065 1066 1067 1068
    
    for(;;){
        int ret= output_packet(ctx, 1);
        if(ret<0) 
            return ret;
        else if(ret==0)
            break;
F
Fabrice Bellard 已提交
1069 1070
    }

1071 1072 1073
    /* End header according to MPEG1 systems standard. We do not write
       it as it is usually not needed by decoders and because it
       complicates MPEG stream concatenation. */
1074 1075
    //put_be32(&ctx->pb, ISO_11172_END_CODE);
    //put_flush_packet(&ctx->pb);
1076

M
Michael Niedermayer 已提交
1077 1078 1079 1080 1081 1082
    for(i=0;i<ctx->nb_streams;i++) {
        stream = ctx->streams[i]->priv_data;

        assert(fifo_size(&stream->fifo, stream->fifo.rptr) == 0);
        fifo_free(&stream->fifo);
    }
F
Fabrice Bellard 已提交
1083 1084
    return 0;
}
1085
#endif //CONFIG_ENCODERS
F
Fabrice Bellard 已提交
1086 1087 1088 1089 1090 1091

/*********************************************/
/* demux code */

#define MAX_SYNC_SIZE 100000

1092 1093
static int mpegps_probe(AVProbeData *p)
{
1094 1095 1096
    int i;
    int size= FFMIN(20, p->buf_size);
    uint32_t code=0xFF;
1097 1098 1099 1100

    /* we search the first start code. If it is a packet start code,
       then we decide it is mpeg ps. We do not send highest value to
       give a chance to mpegts */
1101 1102 1103
    /* NOTE: the search range was restricted to avoid too many false
       detections */

1104 1105
    for (i = 0; i < size; i++) {
        code = (code << 8) | p->buf[i];
1106 1107 1108 1109 1110 1111 1112 1113 1114
        if ((code & 0xffffff00) == 0x100) {
            if (code == PACK_START_CODE ||
                code == SYSTEM_HEADER_START_CODE ||
                (code >= 0x1e0 && code <= 0x1ef) ||
                (code >= 0x1c0 && code <= 0x1df) ||
                code == PRIVATE_STREAM_2 ||
                code == PROGRAM_STREAM_MAP ||
                code == PRIVATE_STREAM_1 ||
                code == PADDING_STREAM)
1115
                return AVPROBE_SCORE_MAX - 2;
1116 1117 1118
            else
                return 0;
        }
1119 1120 1121 1122 1123
    }
    return 0;
}


F
Fabrice Bellard 已提交
1124 1125 1126 1127
typedef struct MpegDemuxContext {
    int header_state;
} MpegDemuxContext;

F
Fabrice Bellard 已提交
1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155
static int mpegps_read_header(AVFormatContext *s,
                              AVFormatParameters *ap)
{
    MpegDemuxContext *m = s->priv_data;
    m->header_state = 0xff;
    s->ctx_flags |= AVFMTCTX_NOHEADER;

    /* no need to do more */
    return 0;
}

static int64_t get_pts(ByteIOContext *pb, int c)
{
    int64_t pts;
    int val;

    if (c < 0)
        c = get_byte(pb);
    pts = (int64_t)((c >> 1) & 0x07) << 30;
    val = get_be16(pb);
    pts |= (int64_t)(val >> 1) << 15;
    val = get_be16(pb);
    pts |= (int64_t)(val >> 1);
    return pts;
}

static int find_next_start_code(ByteIOContext *pb, int *size_ptr, 
                                uint32_t *header_state)
F
Fabrice Bellard 已提交
1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180
{
    unsigned int state, v;
    int val, n;

    state = *header_state;
    n = *size_ptr;
    while (n > 0) {
        if (url_feof(pb))
            break;
        v = get_byte(pb);
        n--;
        if (state == 0x000001) {
            state = ((state << 8) | v) & 0xffffff;
            val = state;
            goto found;
        }
        state = ((state << 8) | v) & 0xffffff;
    }
    val = -1;
 found:
    *header_state = state;
    *size_ptr = n;
    return val;
}

F
Fabrice Bellard 已提交
1181 1182
/* XXX: optimize */
static int find_prev_start_code(ByteIOContext *pb, int *size_ptr)
F
Fabrice Bellard 已提交
1183
{
F
Fabrice Bellard 已提交
1184 1185
    int64_t pos, pos_start;
    int max_size, start_code;
1186

F
Fabrice Bellard 已提交
1187 1188
    max_size = *size_ptr;
    pos_start = url_ftell(pb);
F
Fabrice Bellard 已提交
1189

F
Fabrice Bellard 已提交
1190 1191 1192 1193 1194 1195
    /* in order to go faster, we fill the buffer */
    pos = pos_start - 16386;
    if (pos < 0)
        pos = 0;
    url_fseek(pb, pos, SEEK_SET);
    get_byte(pb);
F
Fabrice Bellard 已提交
1196

F
Fabrice Bellard 已提交
1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211
    pos = pos_start;
    for(;;) {
        pos--;
        if (pos < 0 || (pos_start - pos) >= max_size) {
            start_code = -1;
            goto the_end;
        }
        url_fseek(pb, pos, SEEK_SET);
        start_code = get_be32(pb);
        if ((start_code & 0xffffff00) == 0x100)
            break;
    }
 the_end:
    *size_ptr = pos_start - pos;
    return start_code;
F
Fabrice Bellard 已提交
1212 1213
}

1214
/* read the next PES header. Return its position in ppos 
F
Fabrice Bellard 已提交
1215 1216 1217 1218
   (if not NULL), and its start code, pts and dts.
 */
static int mpegps_read_pes_header(AVFormatContext *s,
                                  int64_t *ppos, int *pstart_code, 
1219
                                  int64_t *ppts, int64_t *pdts)
F
Fabrice Bellard 已提交
1220 1221
{
    MpegDemuxContext *m = s->priv_data;
F
Fabrice Bellard 已提交
1222 1223
    int len, size, startcode, c, flags, header_len;
    int64_t pts, dts, last_pos;
F
Fabrice Bellard 已提交
1224

F
Fabrice Bellard 已提交
1225
    last_pos = -1;
F
Fabrice Bellard 已提交
1226
 redo:
F
Fabrice Bellard 已提交
1227 1228 1229 1230
        /* next start code (should be immediately after) */
        m->header_state = 0xff;
        size = MAX_SYNC_SIZE;
        startcode = find_next_start_code(&s->pb, &size, &m->header_state);
1231
    //printf("startcode=%x pos=0x%Lx\n", startcode, url_ftell(&s->pb));
F
Fabrice Bellard 已提交
1232
    if (startcode < 0)
1233
        return AVERROR_IO;
F
Fabrice Bellard 已提交
1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249
    if (startcode == PACK_START_CODE)
        goto redo;
    if (startcode == SYSTEM_HEADER_START_CODE)
        goto redo;
    if (startcode == PADDING_STREAM ||
        startcode == PRIVATE_STREAM_2) {
        /* skip them */
        len = get_be16(&s->pb);
        url_fskip(&s->pb, len);
        goto redo;
    }
    /* find matching stream */
    if (!((startcode >= 0x1c0 && startcode <= 0x1df) ||
          (startcode >= 0x1e0 && startcode <= 0x1ef) ||
          (startcode == 0x1bd)))
        goto redo;
F
Fabrice Bellard 已提交
1250 1251 1252
    if (ppos) {
        *ppos = url_ftell(&s->pb) - 4;
    }
F
Fabrice Bellard 已提交
1253
    len = get_be16(&s->pb);
1254 1255
    pts = AV_NOPTS_VALUE;
    dts = AV_NOPTS_VALUE;
F
Fabrice Bellard 已提交
1256 1257
    /* stuffing */
    for(;;) {
F
Fabrice Bellard 已提交
1258 1259
        if (len < 1)
            goto redo;
F
Fabrice Bellard 已提交
1260 1261 1262 1263 1264 1265 1266 1267
        c = get_byte(&s->pb);
        len--;
        /* XXX: for mpeg1, should test only bit 7 */
        if (c != 0xff) 
            break;
    }
    if ((c & 0xc0) == 0x40) {
        /* buffer scale & size */
F
Fabrice Bellard 已提交
1268 1269
        if (len < 2)
            goto redo;
F
Fabrice Bellard 已提交
1270 1271 1272 1273 1274
        get_byte(&s->pb);
        c = get_byte(&s->pb);
        len -= 2;
    }
    if ((c & 0xf0) == 0x20) {
F
Fabrice Bellard 已提交
1275 1276 1277
        if (len < 4)
            goto redo;
        dts = pts = get_pts(&s->pb, c);
F
Fabrice Bellard 已提交
1278 1279
        len -= 4;
    } else if ((c & 0xf0) == 0x30) {
F
Fabrice Bellard 已提交
1280 1281
        if (len < 9)
            goto redo;
F
Fabrice Bellard 已提交
1282 1283 1284 1285 1286 1287
        pts = get_pts(&s->pb, c);
        dts = get_pts(&s->pb, -1);
        len -= 9;
    } else if ((c & 0xc0) == 0x80) {
        /* mpeg 2 PES */
        if ((c & 0x30) != 0) {
F
Fabrice Bellard 已提交
1288 1289
            /* Encrypted multiplex not handled */
            goto redo;
F
Fabrice Bellard 已提交
1290 1291 1292 1293 1294 1295
        }
        flags = get_byte(&s->pb);
        header_len = get_byte(&s->pb);
        len -= 2;
        if (header_len > len)
            goto redo;
1296
        if ((flags & 0xc0) == 0x80) {
F
Fabrice Bellard 已提交
1297 1298 1299
            dts = pts = get_pts(&s->pb, -1);
            if (header_len < 5)
                goto redo;
F
Fabrice Bellard 已提交
1300 1301 1302 1303 1304
            header_len -= 5;
            len -= 5;
        } if ((flags & 0xc0) == 0xc0) {
            pts = get_pts(&s->pb, -1);
            dts = get_pts(&s->pb, -1);
F
Fabrice Bellard 已提交
1305 1306
            if (header_len < 10)
                goto redo;
F
Fabrice Bellard 已提交
1307 1308 1309 1310 1311 1312 1313 1314 1315
            header_len -= 10;
            len -= 10;
        }
        len -= header_len;
        while (header_len > 0) {
            get_byte(&s->pb);
            header_len--;
        }
    }
1316 1317 1318
    else if( c!= 0xf )
        goto redo;

F
Fabrice Bellard 已提交
1319
    if (startcode == 0x1bd) {
F
Fabrice Bellard 已提交
1320 1321
        if (len < 1)
            goto redo;
F
Fabrice Bellard 已提交
1322 1323 1324 1325
        startcode = get_byte(&s->pb);
        len--;
        if (startcode >= 0x80 && startcode <= 0xbf) {
            /* audio: skip header */
F
Fabrice Bellard 已提交
1326 1327
            if (len < 3)
                goto redo;
F
Fabrice Bellard 已提交
1328 1329 1330 1331 1332 1333
            get_byte(&s->pb);
            get_byte(&s->pb);
            get_byte(&s->pb);
            len -= 3;
        }
    }
1334 1335 1336 1337
    if(dts != AV_NOPTS_VALUE && ppos){
        int i;
        for(i=0; i<s->nb_streams; i++){
            if(startcode == s->streams[i]->id) {
1338
                av_add_index_entry(s->streams[i], *ppos, dts, 0, 0 /* FIXME keyframe? */);
1339 1340 1341 1342
            }
        }
    }
    
F
Fabrice Bellard 已提交
1343 1344 1345 1346 1347 1348 1349 1350 1351 1352
    *pstart_code = startcode;
    *ppts = pts;
    *pdts = dts;
    return len;
}

static int mpegps_read_packet(AVFormatContext *s,
                              AVPacket *pkt)
{
    AVStream *st;
1353
    int len, startcode, i, type, codec_id = 0;
1354
    int64_t pts, dts, dummy_pos; //dummy_pos is needed for the index building to work
F
Fabrice Bellard 已提交
1355 1356

 redo:
1357
    len = mpegps_read_pes_header(s, &dummy_pos, &startcode, &pts, &dts);
F
Fabrice Bellard 已提交
1358 1359
    if (len < 0)
        return len;
1360
    
F
Fabrice Bellard 已提交
1361 1362 1363 1364 1365 1366
    /* now find stream */
    for(i=0;i<s->nb_streams;i++) {
        st = s->streams[i];
        if (st->id == startcode)
            goto found;
    }
1367 1368
    if (startcode >= 0x1e0 && startcode <= 0x1ef) {
        type = CODEC_TYPE_VIDEO;
1369
        codec_id = CODEC_ID_MPEG2VIDEO;
1370 1371 1372
    } else if (startcode >= 0x1c0 && startcode <= 0x1df) {
        type = CODEC_TYPE_AUDIO;
        codec_id = CODEC_ID_MP2;
1373
    } else if (startcode >= 0x80 && startcode <= 0x89) {
1374 1375
        type = CODEC_TYPE_AUDIO;
        codec_id = CODEC_ID_AC3;
1376 1377 1378
    } else if (startcode >= 0x8a && startcode <= 0x9f) {
        type = CODEC_TYPE_AUDIO;
        codec_id = CODEC_ID_DTS;
1379 1380 1381
    } else if (startcode >= 0xa0 && startcode <= 0xbf) {
        type = CODEC_TYPE_AUDIO;
        codec_id = CODEC_ID_PCM_S16BE;
1382 1383 1384 1385 1386 1387
    } else {
    skip:
        /* skip packet */
        url_fskip(&s->pb, len);
        goto redo;
    }
1388 1389 1390 1391
    /* no stream found: add a new stream */
    st = av_new_stream(s, startcode);
    if (!st) 
        goto skip;
1392 1393
    st->codec.codec_type = type;
    st->codec.codec_id = codec_id;
F
Fabrice Bellard 已提交
1394 1395
    if (codec_id != CODEC_ID_PCM_S16BE)
        st->need_parsing = 1;
F
Fabrice Bellard 已提交
1396
 found:
1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412
    if (startcode >= 0xa0 && startcode <= 0xbf) {
        int b1, freq;

        /* for LPCM, we just skip the header and consider it is raw
           audio data */
        if (len <= 3)
            goto skip;
        get_byte(&s->pb); /* emphasis (1), muse(1), reserved(1), frame number(5) */
        b1 = get_byte(&s->pb); /* quant (2), freq(2), reserved(1), channels(3) */
        get_byte(&s->pb); /* dynamic range control (0x80 = off) */
        len -= 3;
        freq = (b1 >> 4) & 3;
        st->codec.sample_rate = lpcm_freq_tab[freq];
        st->codec.channels = 1 + (b1 & 7);
        st->codec.bit_rate = st->codec.channels * st->codec.sample_rate * 2;
    }
F
Fabrice Bellard 已提交
1413 1414 1415
    av_new_packet(pkt, len);
    get_buffer(&s->pb, pkt->data, pkt->size);
    pkt->pts = pts;
F
Fabrice Bellard 已提交
1416
    pkt->dts = dts;
1417
    pkt->stream_index = st->index;
1418
#if 0
1419
    av_log(s, AV_LOG_DEBUG, "%d: pts=%0.3f dts=%0.3f\n",
1420 1421
           pkt->stream_index, pkt->pts / 90000.0, pkt->dts / 90000.0);
#endif
1422

F
Fabrice Bellard 已提交
1423 1424 1425
    return 0;
}

1426
static int mpegps_read_close(AVFormatContext *s)
F
Fabrice Bellard 已提交
1427 1428 1429 1430
{
    return 0;
}

F
Fabrice Bellard 已提交
1431
static int64_t mpegps_read_dts(AVFormatContext *s, int stream_index, 
1432
                               int64_t *ppos, int64_t pos_limit)
F
Fabrice Bellard 已提交
1433 1434 1435 1436 1437 1438 1439 1440 1441 1442
{
    int len, startcode;
    int64_t pos, pts, dts;

    pos = *ppos;
#ifdef DEBUG_SEEK
    printf("read_dts: pos=0x%llx next=%d -> ", pos, find_next);
#endif
    url_fseek(&s->pb, pos, SEEK_SET);
    for(;;) {
1443
        len = mpegps_read_pes_header(s, &pos, &startcode, &pts, &dts);
F
Fabrice Bellard 已提交
1444 1445 1446 1447 1448 1449 1450 1451 1452 1453
        if (len < 0) {
#ifdef DEBUG_SEEK
            printf("none (ret=%d)\n", len);
#endif
            return AV_NOPTS_VALUE;
        }
        if (startcode == s->streams[stream_index]->id && 
            dts != AV_NOPTS_VALUE) {
            break;
        }
1454
        url_fskip(&s->pb, len);
F
Fabrice Bellard 已提交
1455 1456 1457 1458 1459
    }
#ifdef DEBUG_SEEK
    printf("pos=0x%llx dts=0x%llx %0.3f\n", pos, dts, dts / 90000.0);
#endif
    *ppos = pos;
1460
    return dts;
F
Fabrice Bellard 已提交
1461 1462
}

1463
#ifdef CONFIG_ENCODERS
1464
static AVOutputFormat mpeg1system_mux = {
F
Fabrice Bellard 已提交
1465
    "mpeg",
1466
    "MPEG1 System format",
1467
    "video/mpeg",
1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479
    "mpg,mpeg",
    sizeof(MpegMuxContext),
    CODEC_ID_MP2,
    CODEC_ID_MPEG1VIDEO,
    mpeg_mux_init,
    mpeg_mux_write_packet,
    mpeg_mux_end,
};

static AVOutputFormat mpeg1vcd_mux = {
    "vcd",
    "MPEG1 System format (VCD)",
1480
    "video/mpeg",
1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492
    NULL,
    sizeof(MpegMuxContext),
    CODEC_ID_MP2,
    CODEC_ID_MPEG1VIDEO,
    mpeg_mux_init,
    mpeg_mux_write_packet,
    mpeg_mux_end,
};

static AVOutputFormat mpeg2vob_mux = {
    "vob",
    "MPEG2 PS format (VOB)",
1493
    "video/mpeg",
1494
    "vob",
1495
    sizeof(MpegMuxContext),
F
Fabrice Bellard 已提交
1496
    CODEC_ID_MP2,
1497
    CODEC_ID_MPEG2VIDEO,
F
Fabrice Bellard 已提交
1498 1499 1500
    mpeg_mux_init,
    mpeg_mux_write_packet,
    mpeg_mux_end,
1501
};
1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518

/* Same as mpeg2vob_mux except that the pack size is 2324 */
static AVOutputFormat mpeg2svcd_mux = {
    "svcd",
    "MPEG2 PS format (VOB)",
    "video/mpeg",
    "vob",
    sizeof(MpegMuxContext),
    CODEC_ID_MP2,
    CODEC_ID_MPEG2VIDEO,
    mpeg_mux_init,
    mpeg_mux_write_packet,
    mpeg_mux_end,
};



1519
#endif //CONFIG_ENCODERS
F
Fabrice Bellard 已提交
1520

F
Fabrice Bellard 已提交
1521
AVInputFormat mpegps_demux = {
1522 1523 1524 1525 1526 1527 1528
    "mpeg",
    "MPEG PS format",
    sizeof(MpegDemuxContext),
    mpegps_probe,
    mpegps_read_header,
    mpegps_read_packet,
    mpegps_read_close,
1529 1530
    NULL, //mpegps_read_seek,
    mpegps_read_dts,
F
Fabrice Bellard 已提交
1531
};
1532 1533 1534

int mpegps_init(void)
{
1535
#ifdef CONFIG_ENCODERS
1536 1537 1538
    av_register_output_format(&mpeg1system_mux);
    av_register_output_format(&mpeg1vcd_mux);
    av_register_output_format(&mpeg2vob_mux);
1539
    av_register_output_format(&mpeg2svcd_mux);
1540
#endif //CONFIG_ENCODERS
1541 1542 1543
    av_register_input_format(&mpegps_demux);
    return 0;
}