1 /*****************************************************************************
2 * ps.h: Program Stream demuxer helper
3 *****************************************************************************
4 * Copyright (C) 2004-2009 VLC authors and VideoLAN
7 * Authors: Laurent Aimar <fenrir@via.ecp.fr>
9 * This program is free software; you can redistribute it and/or modify it
10 * under the terms of the GNU Lesser General Public License as published by
11 * the Free Software Foundation; either version 2.1 of the License, or
12 * (at your option) any later version.
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 * GNU Lesser General Public License for more details.
19 * You should have received a copy of the GNU Lesser General Public License
20 * along with this program; if not, write to the Free Software Foundation,
21 * Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301, USA.
22 *****************************************************************************/
25 #include <vlc_demux.h>
26 #include <vlc_memory.h>
28 /* 256-0xC0 for normal stream, 256 for 0xbd stream, 256 for 0xfd stream, 8 for 0xa0 AOB stream */
29 #define PS_TK_COUNT (256+256+256+8 - 0xc0)
31 #define PS_ID_TO_TK( id ) ((id) <= 0xff ? (id) - 0xc0 : \
32 ((id)&0xff) + (((id)&0xff00) == 0xbd00 ? 256-0xC0 : 512-0xc0) )
34 static inline int ps_id_to_tk( unsigned i_id )
38 else if( (i_id & 0xff00) == 0xbd00 )
39 return 256-0xC0 + (i_id & 0xff);
40 else if( (i_id & 0xff00) == 0xfd00 )
41 return 512-0xc0 + (i_id & 0xff);
43 return 768-0xc0 + (i_id & 0x07);
45 #define PS_ID_TO_TK( id ) ps_id_to_tk( id )
48 typedef struct ps_psm_t ps_psm_t;
49 static inline int ps_id_to_type( const ps_psm_t *, int );
50 static inline const uint8_t *ps_id_to_lang( const ps_psm_t *, int );
64 /* Init a set of track */
65 static inline void ps_track_init( ps_track_t tk[PS_TK_COUNT] )
68 for( i = 0; i < PS_TK_COUNT; i++ )
74 tk[i].i_first_pts = -1;
75 tk[i].i_last_pts = -1;
76 es_format_Init( &tk[i].fmt, UNKNOWN_ES, 0 );
80 /* From id fill i_skip and es_format_t */
81 static inline int ps_track_fill( ps_track_t *tk, ps_psm_t *p_psm, int i_id, block_t *p_pkt )
85 if( ( i_id&0xff00 ) == 0xbd00 ) /* 0xBD00 -> 0xBDFF, Private Stream 1 */
87 if( ( i_id&0xf8 ) == 0x88 || /* 0x88 -> 0x8f - Can be DTS-HD primary audio in evob */
88 ( i_id&0xf8 ) == 0x98 ) /* 0x98 -> 0x9f - Can be DTS-HD secondary audio in evob */
90 es_format_Init( &tk->fmt, AUDIO_ES, VLC_CODEC_DTS );
93 else if( ( i_id&0xf8 ) == 0x80 || /* 0x80 -> 0x87 */
94 ( i_id&0xf0 ) == 0xc0 ) /* 0xc0 -> 0xcf AC-3, Can also be DD+/E-AC3 in evob */
97 if( ( i_id&0xf0 ) == 0xc0 && p_pkt && p_pkt->i_buffer > 8 )
99 unsigned i_start = 9 + p_pkt->p_buffer[8];
100 /* AC-3 marking, see vlc_a52_header_Parse */
101 if( p_pkt->p_buffer[i_start + 4] == 0x0b ||
102 p_pkt->p_buffer[i_start + 5] == 0x77 )
104 int bsid = p_pkt->p_buffer[i_start + 9] >> 3;
110 es_format_Init( &tk->fmt, AUDIO_ES, b_eac3 ? VLC_CODEC_EAC3 : VLC_CODEC_A52 );
113 else if( ( i_id&0xfc ) == 0x00 ) /* 0x00 -> 0x03 */
115 es_format_Init( &tk->fmt, SPU_ES, VLC_CODEC_CVD );
117 else if( ( i_id&0xff ) == 0x10 ) /* 0x10 */
119 es_format_Init( &tk->fmt, SPU_ES, VLC_CODEC_TELETEXT );
121 else if( ( i_id&0xe0 ) == 0x20 ) /* 0x20 -> 0x3f */
123 es_format_Init( &tk->fmt, SPU_ES, VLC_CODEC_SPU );
126 else if( ( i_id&0xff ) == 0x70 ) /* 0x70 */
128 es_format_Init( &tk->fmt, SPU_ES, VLC_CODEC_OGT );
130 else if( ( i_id&0xf0 ) == 0xa0 ) /* 0xa0 -> 0xaf */
132 es_format_Init( &tk->fmt, AUDIO_ES, VLC_CODEC_DVD_LPCM );
135 else if( ( i_id&0xf0 ) == 0xb0 ) /* 0xb0 -> 0xbf */
137 es_format_Init( &tk->fmt, AUDIO_ES, VLC_CODEC_TRUEHD );
142 es_format_Init( &tk->fmt, UNKNOWN_ES, 0 );
146 else if( (i_id&0xff00) == 0xfd00 ) /* 0xFD00 -> 0xFDFF */
148 uint8_t i_sub_id = i_id & 0xff;
149 if( ( i_sub_id >= 0x55 && i_sub_id <= 0x5f ) || /* Can be primary VC-1 in evob */
150 ( i_sub_id >= 0x75 && i_sub_id <= 0x7f ) ) /* Secondary VC-1 */
152 es_format_Init( &tk->fmt, VIDEO_ES, VLC_CODEC_VC1 );
156 es_format_Init( &tk->fmt, UNKNOWN_ES, 0 );
160 else if( (i_id&0xff00) == 0xa000 ) /* 0xA000 -> 0xA0FF */
162 uint8_t i_sub_id = i_id & 0x07;
165 es_format_Init( &tk->fmt, AUDIO_ES, VLC_CODEC_DVDA_LPCM );
168 else if( i_sub_id == 1 )
170 es_format_Init( &tk->fmt, AUDIO_ES, VLC_CODEC_MLP );
171 tk->i_skip = -1; /* It's a hack for variable skip value */
175 es_format_Init( &tk->fmt, UNKNOWN_ES, 0 );
181 int i_type = ps_id_to_type( p_psm , i_id );
183 es_format_Init( &tk->fmt, UNKNOWN_ES, 0 );
185 if( (i_id&0xf0) == 0xe0 ) /* 0xe0 -> 0xef */
189 es_format_Init( &tk->fmt, VIDEO_ES, VLC_CODEC_H264 );
191 else if( i_type == 0x10 )
193 es_format_Init( &tk->fmt, VIDEO_ES, VLC_CODEC_MP4V );
195 else if( i_type == 0x01 ||
198 es_format_Init( &tk->fmt, VIDEO_ES, VLC_CODEC_MPGV );
200 else if( i_id == 0xe2 || /* Primary H.264 in evob */
201 i_id == 0xe3 ) /* Seconday H.264 in evob */
203 es_format_Init( &tk->fmt, VIDEO_ES, VLC_CODEC_H264 );
205 else if( tk->fmt.i_cat == UNKNOWN_ES )
207 es_format_Init( &tk->fmt, VIDEO_ES, VLC_CODEC_MPGV );
210 else if( ( i_id&0xe0 ) == 0xc0 ) /* 0xc0 -> 0xdf */
212 if( i_type == 0x03 ||
215 es_format_Init( &tk->fmt, AUDIO_ES, VLC_CODEC_MPGA );
217 else if( i_type == 0x0f )
219 es_format_Init( &tk->fmt, AUDIO_ES, VLC_CODEC_MP4A );
221 else if( i_type == 0x11 )
223 es_format_Init( &tk->fmt, AUDIO_ES, VLC_CODEC_MP4A );
225 else if( tk->fmt.i_cat == UNKNOWN_ES )
227 es_format_Init( &tk->fmt, AUDIO_ES, VLC_CODEC_MPGA );
230 else if( tk->fmt.i_cat == UNKNOWN_ES ) return VLC_EGENERIC;
233 /* PES packets usually contain truncated frames */
234 tk->fmt.b_packetized = false;
236 if( ps_id_to_lang( p_psm, i_id ) )
238 tk->fmt.psz_language = malloc( 4 );
239 if( tk->fmt.psz_language )
241 memcpy( tk->fmt.psz_language, ps_id_to_lang( p_psm , i_id ), 3 );
242 tk->fmt.psz_language[3] = 0;
249 /* return the id of a PES (should be valid) */
250 static inline int ps_pkt_id( block_t *p_pkt )
252 if( p_pkt->p_buffer[3] == 0xbd &&
253 p_pkt->i_buffer >= 9 &&
254 p_pkt->i_buffer >= 9 + (size_t)p_pkt->p_buffer[8] )
256 const unsigned i_start = 9 + p_pkt->p_buffer[8];
257 const uint8_t i_sub_id = p_pkt->p_buffer[i_start];
259 if( (i_sub_id & 0xfe) == 0xa0 &&
260 p_pkt->i_buffer >= i_start + 7 &&
261 ( p_pkt->p_buffer[i_start + 5] >= 0xc0 ||
262 p_pkt->p_buffer[i_start + 6] != 0x80 ) )
264 /* AOB LPCM/MLP extension
265 * XXX for MLP I think that the !=0x80 test is not good and
266 * will fail for some valid files */
267 return 0xa000 | (i_sub_id & 0x01);
271 return 0xbd00 | i_sub_id;
273 else if( p_pkt->p_buffer[3] == 0xfd &&
274 p_pkt->i_buffer >= 9 &&
275 (p_pkt->p_buffer[6]&0xC0) == 0x80 && /* mpeg2 */
276 (p_pkt->p_buffer[7]&0x01) == 0x01 ) /* extension_flag */
278 /* ISO 13818 amendment 2 and SMPTE RP 227 */
279 const uint8_t i_flags = p_pkt->p_buffer[7];
280 unsigned int i_skip = 9;
282 /* Find PES extension */
283 if( (i_flags & 0x80 ) )
285 i_skip += 5; /* pts */
286 if( (i_flags & 0x40) )
287 i_skip += 5; /* dts */
289 if( (i_flags & 0x20 ) )
291 if( (i_flags & 0x10 ) )
293 if( (i_flags & 0x08 ) )
295 if( (i_flags & 0x04 ) )
297 if( (i_flags & 0x02 ) )
300 if( i_skip < p_pkt->i_buffer && (p_pkt->p_buffer[i_skip]&0x01) )
302 const uint8_t i_flags2 = p_pkt->p_buffer[i_skip];
304 /* Find PES extension 2 */
306 if( i_flags2 & 0x80 )
308 if( (i_flags2 & 0x40) && i_skip < p_pkt->i_buffer )
309 i_skip += 1 + p_pkt->p_buffer[i_skip];
310 if( i_flags2 & 0x20 )
312 if( i_flags2 & 0x10 )
315 if( i_skip + 1 < p_pkt->i_buffer )
317 const int i_extension_field_length = p_pkt->p_buffer[i_skip]&0x7f;
318 if( i_extension_field_length >=1 )
320 int i_stream_id_extension_flag = (p_pkt->p_buffer[i_skip+1] >> 7)&0x1;
321 if( i_stream_id_extension_flag == 0 )
322 return 0xfd00 | (p_pkt->p_buffer[i_skip+1]&0x7f);
327 return p_pkt->p_buffer[3];
330 /* return the size of the next packet */
331 static inline int ps_pkt_size( const uint8_t *p, int i_peek )
333 if( unlikely(i_peek < 4) )
337 else if( p[3] == 0xb9 )
341 else if( p[3] == 0xba )
343 if( i_peek >= 14 && (p[4] >> 6) == 0x01 )
345 return 14 + (p[13]&0x07);
347 else if( i_peek >= 12 && (p[4] >> 4) == 0x02 )
353 else if( i_peek >= 6 )
355 return 6 + ((p[4]<<8) | p[5] );
360 /* parse a PACK PES */
361 static inline int ps_pkt_parse_pack( block_t *p_pkt, int64_t *pi_scr,
364 uint8_t *p = p_pkt->p_buffer;
365 if( p_pkt->i_buffer >= 14 && (p[4] >> 6) == 0x01 )
367 *pi_scr =((((int64_t)p[4]&0x38) << 27 )|
368 (((int64_t)p[4]&0x03) << 28 )|
369 ((int64_t)p[5] << 20 )|
370 (((int64_t)p[6]&0xf8) << 12 )|
371 (((int64_t)p[6]&0x03) << 13 )|
372 ((int64_t)p[7] << 5 )|
373 ((int64_t)p[8] >> 3 )) * 100 / 9;
375 *pi_mux_rate = ( p[10] << 14 )|( p[11] << 6 )|( p[12] >> 2);
377 else if( p_pkt->i_buffer >= 12 && (p[4] >> 4) == 0x02 )
379 *pi_scr =((((int64_t)p[4]&0x0e) << 29 )|
380 ((int64_t)p[5] << 22 )|
381 (((int64_t)p[6]&0xfe) << 14 )|
382 ((int64_t)p[7] << 7 )|
383 ((int64_t)p[8] >> 1 )) * 100 / 9;
385 *pi_mux_rate = ( ( p[9]&0x7f )<< 15 )|( p[10] << 7 )|( p[11] >> 1);
394 /* Parse a SYSTEM PES */
395 static inline int ps_pkt_parse_system( block_t *p_pkt, ps_psm_t *p_psm,
396 ps_track_t tk[PS_TK_COUNT] )
398 uint8_t *p = &p_pkt->p_buffer[6 + 3 + 1 + 1 + 1];
400 /* System header is not useable if it references private streams (0xBD)
401 * or 'all audio streams' (0xB8) or 'all video streams' (0xB9) */
402 while( p < &p_pkt->p_buffer[p_pkt->i_buffer] )
406 /* fprintf( stderr, " SYSTEM_START_CODEEE: id=0x%x\n", p[0] ); */
407 if( p[0] >= 0xBC || p[0] == 0xB8 || p[0] == 0xB9 ) p += 2;
412 int i_tk = PS_ID_TO_TK( i_id );
414 if( !tk[i_tk].b_seen )
416 if( !ps_track_fill( &tk[i_tk], p_psm, i_id, p_pkt ) )
418 tk[i_tk].b_seen = true;
426 /* Parse a PES (and skip i_skip_extra in the payload) */
427 static inline int ps_pkt_parse_pes( block_t *p_pes, int i_skip_extra )
430 unsigned int i_skip = 0;
434 memcpy( header, p_pes->p_buffer, __MIN( p_pes->i_buffer, 34 ) );
438 case 0xBC: /* Program stream map */
439 case 0xBE: /* Padding */
440 case 0xBF: /* Private stream 2 */
443 case 0xFF: /* Program stream directory */
444 case 0xF2: /* DSMCC stream */
445 case 0xF8: /* ITU-T H.222.1 type E stream */
450 if( ( header[6]&0xC0 ) == 0x80 )
453 i_skip = header[8] + 9;
455 if( header[7]&0x80 ) /* has pts */
457 i_pts = ((mtime_t)(header[ 9]&0x0e ) << 29)|
458 (mtime_t)(header[10] << 22)|
459 ((mtime_t)(header[11]&0xfe) << 14)|
460 (mtime_t)(header[12] << 7)|
461 (mtime_t)(header[13] >> 1);
463 if( header[7]&0x40 ) /* has dts */
465 i_dts = ((mtime_t)(header[14]&0x0e ) << 29)|
466 (mtime_t)(header[15] << 22)|
467 ((mtime_t)(header[16]&0xfe) << 14)|
468 (mtime_t)(header[17] << 7)|
469 (mtime_t)(header[18] >> 1);
476 while( i_skip < 23 && header[i_skip] == 0xff )
482 /* msg_Err( p_demux, "too much MPEG-1 stuffing" ); */
485 if( ( header[i_skip] & 0xC0 ) == 0x40 )
490 if( header[i_skip]&0x20 )
492 i_pts = ((mtime_t)(header[i_skip]&0x0e ) << 29)|
493 (mtime_t)(header[i_skip+1] << 22)|
494 ((mtime_t)(header[i_skip+2]&0xfe) << 14)|
495 (mtime_t)(header[i_skip+3] << 7)|
496 (mtime_t)(header[i_skip+4] >> 1);
498 if( header[i_skip]&0x10 ) /* has dts */
500 i_dts = ((mtime_t)(header[i_skip+5]&0x0e ) << 29)|
501 (mtime_t)(header[i_skip+6] << 22)|
502 ((mtime_t)(header[i_skip+7]&0xfe) << 14)|
503 (mtime_t)(header[i_skip+8] << 7)|
504 (mtime_t)(header[i_skip+9] >> 1);
519 if( i_skip_extra >= 0 )
520 i_skip += i_skip_extra;
521 else if( p_pes->i_buffer > i_skip + 3 &&
522 ( ps_pkt_id( p_pes ) == 0xa001 || ps_pkt_id( p_pes ) == 0xbda1 ) )
523 i_skip += 4 + p_pes->p_buffer[i_skip+3];
525 if( p_pes->i_buffer <= i_skip )
530 p_pes->p_buffer += i_skip;
531 p_pes->i_buffer -= i_skip;
534 p_pes->i_dts = VLC_TS_0 + 100 * i_dts / 9;
536 p_pes->i_pts = VLC_TS_0 + 100 * i_pts / 9;
541 /* Program stream map handling */
542 typedef struct ps_es_t
548 uint8_t *p_descriptor;
550 /* Language is iso639-2T */
563 static inline int ps_id_to_type( const ps_psm_t *p_psm, int i_id )
566 for( i = 0; p_psm && i < p_psm->i_es; i++ )
568 if( p_psm->es[i]->i_id == i_id ) return p_psm->es[i]->i_type;
573 static inline const uint8_t *ps_id_to_lang( const ps_psm_t *p_psm, int i_id )
576 for( i = 0; p_psm && i < p_psm->i_es; i++ )
578 if( p_psm->es[i]->i_id == i_id ) return p_psm->es[i]->lang;
583 static inline void ps_psm_init( ps_psm_t *p_psm )
585 p_psm->i_version = 0xFFFF;
590 static inline void ps_psm_destroy( ps_psm_t *p_psm )
592 while( p_psm->i_es-- )
594 free( p_psm->es[p_psm->i_es]->p_descriptor );
595 free( p_psm->es[p_psm->i_es] );
603 static inline int ps_psm_fill( ps_psm_t *p_psm, block_t *p_pkt,
604 ps_track_t tk[PS_TK_COUNT], es_out_t *out )
606 int i_buffer = p_pkt->i_buffer;
607 uint8_t *p_buffer = p_pkt->p_buffer;
608 int i_length, i_version, i_info_length, i_es_base;
610 if( !p_psm || p_buffer[3] != 0xbc ) return VLC_EGENERIC;
612 i_length = (uint16_t)(p_buffer[4] << 8) + p_buffer[5] + 6;
613 if( i_length > i_buffer ) return VLC_EGENERIC;
615 //i_current_next_indicator = (p_buffer[6] & 0x01);
616 i_version = (p_buffer[6] & 0xf8);
618 if( p_psm->i_version == i_version ) return VLC_EGENERIC;
620 ps_psm_destroy( p_psm );
622 i_info_length = (uint16_t)(p_buffer[8] << 8) + p_buffer[9];
623 if( i_info_length + 10 > i_length ) return VLC_EGENERIC;
625 /* Elementary stream map */
626 /* int i_esm_length = (uint16_t)(p_buffer[ 10 + i_info_length ] << 8) +
627 p_buffer[ 11 + i_info_length]; */
628 i_es_base = 12 + i_info_length;
630 while( i_es_base + 4 < i_length )
634 es.lang[0] = es.lang[1] = es.lang[2] = 0;
636 es.i_type = p_buffer[ i_es_base ];
637 es.i_id = p_buffer[ i_es_base + 1 ];
638 i_info_length = (uint16_t)(p_buffer[ i_es_base + 2 ] << 8) +
639 p_buffer[ i_es_base + 3 ];
641 if( i_es_base + 4 + i_info_length > i_length ) break;
643 /* TODO Add support for VC-1 stream:
644 * stream_type=0xea, stream_id=0xfd AND registration
645 * descriptor 0x5 with format_identifier == 0x56432D31 (VC-1)
646 * (I need a sample that use PSM with VC-1) */
649 es.i_descriptor = i_info_length;
650 if( i_info_length > 0 )
654 es.p_descriptor = malloc( i_info_length );
655 if( es.p_descriptor )
657 memcpy( es.p_descriptor, p_buffer + i_es_base + 4, i_info_length);
659 while( i <= es.i_descriptor - 2 )
661 /* Look for the ISO639 language descriptor */
662 if( es.p_descriptor[i] != 0x0a )
664 i += es.p_descriptor[i+1] + 2;
668 if( i <= es.i_descriptor - 6 )
670 es.lang[0] = es.p_descriptor[i+2];
671 es.lang[1] = es.p_descriptor[i+3];
672 es.lang[2] = es.p_descriptor[i+4];
679 tmp_es = realloc( p_psm->es, sizeof(ps_es_t *) * (p_psm->i_es+1) );
683 p_psm->es[p_psm->i_es] = malloc( sizeof(ps_es_t) );
684 if( p_psm->es[p_psm->i_es] )
686 *p_psm->es[p_psm->i_es++] = es;
687 i_es_base += 4 + i_info_length;
694 p_psm->i_version = i_version;
696 /* Check/Modify our existing tracks */
697 for( int i = 0; i < PS_TK_COUNT; i++ )
701 if( !tk[i].b_seen || !tk[i].es ) continue;
703 if( ps_track_fill( &tk_tmp, p_psm, tk[i].i_id, p_pkt ) != VLC_SUCCESS )
706 if( tk_tmp.fmt.i_codec == tk[i].fmt.i_codec )
708 es_format_Clean( &tk_tmp.fmt );
712 es_out_Del( out, tk[i].es );
713 es_format_Clean( &tk[i].fmt );
715 tk_tmp.b_seen = true;
717 tk[i].es = es_out_Add( out, &tk[i].fmt );