1 /*****************************************************************************
2 * ps.h: Program Stream demuxer helper
3 *****************************************************************************
4 * Copyright (C) 2004 the VideoLAN team
7 * Authors: Laurent Aimar <fenrir@via.ecp.fr>
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 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 General Public License for more details.
19 * You should have received a copy of the GNU General Public License
20 * along with this program; if not, write to the Free Software
21 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301, USA.
22 *****************************************************************************/
24 #include <vlc_demux.h>
27 /* 256-0xC0 for normal stream, 256 for 0xbd stream, 256 for 0xfd stream */
28 #define PS_TK_COUNT (768 - 0xc0)
29 #define PS_ID_TO_TK( id ) ((id) <= 0xff ? (id) - 0xc0 : \
30 ((id)&0xff) + (((id)&0xff00) == 0xbd00 ? 256-0xC0 : 512-0xc0) )
32 typedef struct ps_psm_t ps_psm_t
;
33 static inline int ps_id_to_type( const ps_psm_t
*, int );
34 static inline const uint8_t *ps_id_to_lang( const ps_psm_t
*, int );
48 /* Init a set of track */
49 static inline void ps_track_init( ps_track_t tk
[PS_TK_COUNT
] )
52 for( i
= 0; i
< PS_TK_COUNT
; i
++ )
58 tk
[i
].i_first_pts
= -1;
59 tk
[i
].i_last_pts
= -1;
60 es_format_Init( &tk
[i
].fmt
, UNKNOWN_ES
, 0 );
64 /* From id fill i_skip and es_format_t */
65 static inline int ps_track_fill( ps_track_t
*tk
, ps_psm_t
*p_psm
, int i_id
)
69 if( ( i_id
&0xff00 ) == 0xbd00 )
71 if( ( i_id
&0xf8 ) == 0x88 || (i_id
&0xf8) == 0x98 )
73 es_format_Init( &tk
->fmt
, AUDIO_ES
, VLC_FOURCC('d','t','s',' ') );
76 else if( ( i_id
&0xf0 ) == 0x80
77 || (i_id
&0xf0) == 0xc0 ) /* AC-3, Can also be used for DD+/E-AC-3 */
79 es_format_Init( &tk
->fmt
, AUDIO_ES
, VLC_FOURCC('a','5','2',' ') );
82 else if( (i_id
&0xf0) == 0xb0 )
84 es_format_Init( &tk
->fmt
, AUDIO_ES
, VLC_FOURCC('m','l','p',' ') );
85 /* FIXME / untested ... no known decoder (at least not in VLC/ffmpeg) */
87 else if( ( i_id
&0xe0 ) == 0x20 )
89 es_format_Init( &tk
->fmt
, SPU_ES
, VLC_FOURCC('s','p','u',' ') );
92 else if( ( i_id
&0xf0 ) == 0xa0 )
94 es_format_Init( &tk
->fmt
, AUDIO_ES
, VLC_FOURCC('l','p','c','m') );
97 else if( ( i_id
&0xff ) == 0x70 )
99 es_format_Init( &tk
->fmt
, SPU_ES
, VLC_FOURCC('o','g','t',' ') );
101 else if( ( i_id
&0xfc ) == 0x00 )
103 es_format_Init( &tk
->fmt
, SPU_ES
, VLC_FOURCC('c','v','d',' ') );
105 else if( ( i_id
&0xff ) == 0x10 )
107 es_format_Init( &tk
->fmt
, SPU_ES
, VLC_FOURCC('t','e','l','x') );
111 es_format_Init( &tk
->fmt
, UNKNOWN_ES
, 0 );
115 else if( (i_id
&0xff00) == 0xfd00 )
117 uint8_t i_sub_id
= i_id
& 0xff;
118 if( i_sub_id
>= 0x55 && i_sub_id
<= 0x5f )
120 es_format_Init( &tk
->fmt
, VIDEO_ES
, VLC_FOURCC('W','V','C','1') );
124 es_format_Init( &tk
->fmt
, UNKNOWN_ES
, 0 );
130 int i_type
= ps_id_to_type( p_psm
, i_id
);
132 es_format_Init( &tk
->fmt
, UNKNOWN_ES
, 0 );
134 if( (i_id
&0xf0) == 0xe0 && i_type
== 0x1b )
136 es_format_Init( &tk
->fmt
, VIDEO_ES
, VLC_FOURCC('h','2','6','4') );
138 else if( (i_id
&0xf0) == 0xe0 && i_type
== 0x10 )
140 es_format_Init( &tk
->fmt
, VIDEO_ES
, VLC_FOURCC('m','p','4','v') );
142 else if( (i_id
&0xf0) == 0xe0 && i_type
== 0x02 )
144 es_format_Init( &tk
->fmt
, VIDEO_ES
, VLC_FOURCC('m','p','g','v') );
146 else if( ( i_id
&0xe0 ) == 0xc0 && i_type
== 0x0f )
148 es_format_Init( &tk
->fmt
, AUDIO_ES
, VLC_FOURCC('m','p','4','a') );
150 else if( ( i_id
&0xe0 ) == 0xc0 && i_type
== 0x03 )
152 es_format_Init( &tk
->fmt
, AUDIO_ES
, VLC_FOURCC('m','p','g','a') );
155 if( tk
->fmt
.i_cat
== UNKNOWN_ES
&& ( i_id
&0xf0 ) == 0xe0 )
157 es_format_Init( &tk
->fmt
, VIDEO_ES
, VLC_FOURCC('m','p','g','v') );
159 else if( tk
->fmt
.i_cat
== UNKNOWN_ES
&& ( i_id
&0xe0 ) == 0xc0 )
161 es_format_Init( &tk
->fmt
, AUDIO_ES
, VLC_FOURCC('m','p','g','a') );
163 else if( tk
->fmt
.i_cat
== UNKNOWN_ES
) return VLC_EGENERIC
;
166 /* PES packets usually contain truncated frames */
167 tk
->fmt
.b_packetized
= false;
169 if( ps_id_to_lang( p_psm
, i_id
) )
171 tk
->fmt
.psz_language
= malloc( 4 );
172 if( tk
->fmt
.psz_language
)
174 memcpy( tk
->fmt
.psz_language
, ps_id_to_lang( p_psm
, i_id
), 3 );
175 tk
->fmt
.psz_language
[3] = 0;
182 /* return the id of a PES (should be valid) */
183 static inline int ps_pkt_id( block_t
*p_pkt
)
185 if( p_pkt
->p_buffer
[3] == 0xbd &&
186 p_pkt
->i_buffer
>= 9 &&
187 p_pkt
->i_buffer
>= 9 + (size_t)p_pkt
->p_buffer
[8] )
190 return 0xbd00 | p_pkt
->p_buffer
[9+p_pkt
->p_buffer
[8]];
192 else if( p_pkt
->p_buffer
[3] == 0xfd &&
193 p_pkt
->i_buffer
>= 9 &&
194 (p_pkt
->p_buffer
[6]&0xC0) == 0x80 && /* mpeg2 */
195 (p_pkt
->p_buffer
[7]&0x01) == 0x01 ) /* extension_flag */
197 /* ISO 13818 amendment 2 and SMPTE RP 227 */
198 const uint8_t i_flags
= p_pkt
->p_buffer
[7];
199 unsigned int i_skip
= 9;
201 /* Find PES extension */
202 if( (i_flags
& 0x80 ) )
204 i_skip
+= 5; /* pts */
205 if( (i_flags
& 0x40) )
206 i_skip
+= 5; /* dts */
208 if( (i_flags
& 0x20 ) )
210 if( (i_flags
& 0x10 ) )
212 if( (i_flags
& 0x08 ) )
214 if( (i_flags
& 0x04 ) )
216 if( (i_flags
& 0x02 ) )
219 if( i_skip
< p_pkt
->i_buffer
&& (p_pkt
->p_buffer
[i_skip
]&0x01) )
221 const uint8_t i_flags2
= p_pkt
->p_buffer
[i_skip
];
223 /* Find PES extension 2 */
225 if( i_flags2
& 0x80 )
227 if( (i_flags2
& 0x40) && i_skip
< p_pkt
->i_buffer
)
228 i_skip
+= 1 + p_pkt
->p_buffer
[i_skip
];
229 if( i_flags2
& 0x20 )
231 if( i_flags2
& 0x10 )
234 if( i_skip
+ 1 < p_pkt
->i_buffer
)
236 const int i_extension_field_length
= p_pkt
->p_buffer
[i_skip
]&0x7f;
237 if( i_extension_field_length
>=1 )
239 int i_stream_id_extension_flag
= (p_pkt
->p_buffer
[i_skip
+1] >> 7)&0x1;
240 if( i_stream_id_extension_flag
== 0 )
241 return 0xfd00 | (p_pkt
->p_buffer
[i_skip
+1]&0x7f);
246 return p_pkt
->p_buffer
[3];
249 /* return the size of the next packet
250 * You need to give him at least 14 bytes (and it need to start as a
251 * valid packet) It does not handle less than 6 bytes */
252 static inline int ps_pkt_size( const uint8_t *p
, int i_peek
)
254 assert( i_peek
>= 6 );
255 if( p
[3] == 0xb9 && i_peek
>= 4 )
259 else if( p
[3] == 0xba )
261 if( (p
[4] >> 6) == 0x01 && i_peek
>= 14 )
263 return 14 + (p
[13]&0x07);
265 else if( (p
[4] >> 4) == 0x02 && i_peek
>= 12 )
271 else if( i_peek
>= 6 )
273 return 6 + ((p
[4]<<8) | p
[5] );
278 /* parse a PACK PES */
279 static inline int ps_pkt_parse_pack( block_t
*p_pkt
, int64_t *pi_scr
,
282 uint8_t *p
= p_pkt
->p_buffer
;
283 if( p_pkt
->i_buffer
>= 14 && (p
[4] >> 6) == 0x01 )
285 *pi_scr
=((((int64_t)p
[4]&0x38) << 27 )|
286 (((int64_t)p
[4]&0x03) << 28 )|
287 ((int64_t)p
[5] << 20 )|
288 (((int64_t)p
[6]&0xf8) << 12 )|
289 (((int64_t)p
[6]&0x03) << 13 )|
290 ((int64_t)p
[7] << 5 )|
291 ((int64_t)p
[8] >> 3 )) * 100 / 9;
293 *pi_mux_rate
= ( p
[10] << 14 )|( p
[11] << 6 )|( p
[12] >> 2);
295 else if( p_pkt
->i_buffer
>= 12 && (p
[4] >> 4) == 0x02 )
297 *pi_scr
=((((int64_t)p
[4]&0x0e) << 29 )|
298 ((int64_t)p
[5] << 22 )|
299 (((int64_t)p
[6]&0xfe) << 14 )|
300 ((int64_t)p
[7] << 7 )|
301 ((int64_t)p
[8] >> 1 )) * 100 / 9;
303 *pi_mux_rate
= ( ( p
[9]&0x7f )<< 15 )|( p
[10] << 7 )|( p
[11] >> 1);
312 /* Parse a SYSTEM PES */
313 static inline int ps_pkt_parse_system( block_t
*p_pkt
, ps_psm_t
*p_psm
,
314 ps_track_t tk
[PS_TK_COUNT
] )
316 uint8_t *p
= &p_pkt
->p_buffer
[6 + 3 + 1 + 1 + 1];
318 /* System header is not useable if it references private streams (0xBD)
319 * or 'all audio streams' (0xB8) or 'all video streams' (0xB9) */
320 while( p
< &p_pkt
->p_buffer
[p_pkt
->i_buffer
] )
324 /* fprintf( stderr, " SYSTEM_START_CODEEE: id=0x%x\n", p[0] ); */
325 if( p
[0] >= 0xBC || p
[0] == 0xB8 || p
[0] == 0xB9 ) p
+= 2;
330 int i_tk
= PS_ID_TO_TK( i_id
);
332 if( !tk
[i_tk
].b_seen
)
334 if( !ps_track_fill( &tk
[i_tk
], p_psm
, i_id
) )
336 tk
[i_tk
].b_seen
= true;
344 /* Parse a PES (and skip i_skip_extra in the payload) */
345 static inline int ps_pkt_parse_pes( block_t
*p_pes
, int i_skip_extra
)
348 unsigned int i_skip
= 0;
350 memcpy( header
, p_pes
->p_buffer
, __MIN( p_pes
->i_buffer
, 34 ) );
354 case 0xBC: /* Program stream map */
355 case 0xBE: /* Padding */
356 case 0xBF: /* Private stream 2 */
359 case 0xFF: /* Program stream directory */
360 case 0xF2: /* DSMCC stream */
361 case 0xF8: /* ITU-T H.222.1 type E stream */
366 if( ( header
[6]&0xC0 ) == 0x80 )
369 i_skip
= header
[8] + 9;
371 if( header
[7]&0x80 ) /* has pts */
373 p_pes
->i_pts
= ((mtime_t
)(header
[ 9]&0x0e ) << 29)|
374 (mtime_t
)(header
[10] << 22)|
375 ((mtime_t
)(header
[11]&0xfe) << 14)|
376 (mtime_t
)(header
[12] << 7)|
377 (mtime_t
)(header
[13] >> 1);
379 if( header
[7]&0x40 ) /* has dts */
381 p_pes
->i_dts
= ((mtime_t
)(header
[14]&0x0e ) << 29)|
382 (mtime_t
)(header
[15] << 22)|
383 ((mtime_t
)(header
[16]&0xfe) << 14)|
384 (mtime_t
)(header
[17] << 7)|
385 (mtime_t
)(header
[18] >> 1);
392 while( i_skip
< 23 && header
[i_skip
] == 0xff )
398 /* msg_Err( p_demux, "too much MPEG-1 stuffing" ); */
401 if( ( header
[i_skip
] & 0xC0 ) == 0x40 )
406 if( header
[i_skip
]&0x20 )
408 p_pes
->i_pts
= ((mtime_t
)(header
[i_skip
]&0x0e ) << 29)|
409 (mtime_t
)(header
[i_skip
+1] << 22)|
410 ((mtime_t
)(header
[i_skip
+2]&0xfe) << 14)|
411 (mtime_t
)(header
[i_skip
+3] << 7)|
412 (mtime_t
)(header
[i_skip
+4] >> 1);
414 if( header
[i_skip
]&0x10 ) /* has dts */
416 p_pes
->i_dts
= ((mtime_t
)(header
[i_skip
+5]&0x0e ) << 29)|
417 (mtime_t
)(header
[i_skip
+6] << 22)|
418 ((mtime_t
)(header
[i_skip
+7]&0xfe) << 14)|
419 (mtime_t
)(header
[i_skip
+8] << 7)|
420 (mtime_t
)(header
[i_skip
+9] >> 1);
435 i_skip
+= i_skip_extra
;
437 if( p_pes
->i_buffer
<= i_skip
)
442 p_pes
->p_buffer
+= i_skip
;
443 p_pes
->i_buffer
-= i_skip
;
445 p_pes
->i_dts
= 100 * p_pes
->i_dts
/ 9;
446 p_pes
->i_pts
= 100 * p_pes
->i_pts
/ 9;
451 /* Program stream map handling */
452 typedef struct ps_es_t
458 uint8_t *p_descriptor
;
460 /* Language is iso639-2T */
473 static inline int ps_id_to_type( const ps_psm_t
*p_psm
, int i_id
)
476 for( i
= 0; p_psm
&& i
< p_psm
->i_es
; i
++ )
478 if( p_psm
->es
[i
]->i_id
== i_id
) return p_psm
->es
[i
]->i_type
;
483 static inline const uint8_t *ps_id_to_lang( const ps_psm_t
*p_psm
, int i_id
)
486 for( i
= 0; p_psm
&& i
< p_psm
->i_es
; i
++ )
488 if( p_psm
->es
[i
]->i_id
== i_id
) return p_psm
->es
[i
]->lang
;
493 static inline void ps_psm_init( ps_psm_t
*p_psm
)
495 p_psm
->i_version
= 0xFFFF;
500 static inline void ps_psm_destroy( ps_psm_t
*p_psm
)
502 while( p_psm
->i_es
-- )
504 free( p_psm
->es
[p_psm
->i_es
]->p_descriptor
);
505 free( p_psm
->es
[p_psm
->i_es
] );
513 static inline int ps_psm_fill( ps_psm_t
*p_psm
, block_t
*p_pkt
,
514 ps_track_t tk
[PS_TK_COUNT
], es_out_t
*out
)
516 int i_buffer
= p_pkt
->i_buffer
;
517 uint8_t *p_buffer
= p_pkt
->p_buffer
;
518 int i_length
, i_version
, i_info_length
, i_esm_length
, i_es_base
, i
;
520 if( !p_psm
|| p_buffer
[3] != 0xbc ) return VLC_EGENERIC
;
522 i_length
= (uint16_t)(p_buffer
[4] << 8) + p_buffer
[5] + 6;
523 if( i_length
> i_buffer
) return VLC_EGENERIC
;
525 //i_current_next_indicator = (p_buffer[6] && 0x01);
526 i_version
= (p_buffer
[6] && 0xf8);
528 if( p_psm
->i_version
== i_version
) return VLC_EGENERIC
;
530 ps_psm_destroy( p_psm
);
532 i_info_length
= (uint16_t)(p_buffer
[8] << 8) + p_buffer
[9];
533 if( i_info_length
+ 10 > i_length
) return VLC_EGENERIC
;
535 /* Elementary stream map */
536 i_esm_length
= (uint16_t)(p_buffer
[ 10 + i_info_length
] << 8) +
537 p_buffer
[ 11 + i_info_length
];
538 i_es_base
= 12 + i_info_length
;
540 while( i_es_base
+ 4 < i_length
)
544 es
.lang
[0] = es
.lang
[1] = es
.lang
[2] = 0;
546 es
.i_type
= p_buffer
[ i_es_base
];
547 es
.i_id
= p_buffer
[ i_es_base
+ 1 ];
548 i_info_length
= (uint16_t)(p_buffer
[ i_es_base
+ 2 ] << 8) +
549 p_buffer
[ i_es_base
+ 3 ];
551 if( i_es_base
+ 4 + i_info_length
> i_length
) break;
553 /* TODO Add support for VC-1 stream:
554 * stream_type=0xea, stream_id=0xfd AND registration
555 * descriptor 0x5 with format_identifier == 0x56432D31 (VC-1)
556 * (I need a sample that use PSM with VC-1) */
559 es
.i_descriptor
= i_info_length
;
560 if( i_info_length
> 0 )
564 es
.p_descriptor
= malloc( i_info_length
);
565 if( es
.p_descriptor
)
567 memcpy( es
.p_descriptor
, p_buffer
+ i_es_base
+ 4, i_info_length
);
569 while( i
<= es
.i_descriptor
- 2 )
571 /* Look for the ISO639 language descriptor */
572 if( es
.p_descriptor
[i
] != 0x0a )
574 i
+= es
.p_descriptor
[i
+1] + 2;
578 if( i
<= es
.i_descriptor
- 6 )
580 es
.lang
[0] = es
.p_descriptor
[i
+2];
581 es
.lang
[1] = es
.p_descriptor
[i
+3];
582 es
.lang
[2] = es
.p_descriptor
[i
+4];
589 tmp_es
= realloc( p_psm
->es
, sizeof(ps_es_t
*) * (p_psm
->i_es
+1) );
593 p_psm
->es
[p_psm
->i_es
] = malloc( sizeof(ps_es_t
) );
594 if( p_psm
->es
[p_psm
->i_es
] )
596 *p_psm
->es
[p_psm
->i_es
++] = es
;
597 i_es_base
+= 4 + i_info_length
;
604 p_psm
->i_version
= i_version
;
606 /* Check/Modify our existing tracks */
607 for( i
= 0; i
< PS_TK_COUNT
; i
++ )
611 if( !tk
[i
].b_seen
|| !tk
[i
].es
) continue;
613 if( ps_track_fill( &tk_tmp
, p_psm
, tk
[i
].i_id
) != VLC_SUCCESS
)
616 if( tk_tmp
.fmt
.i_codec
== tk
[i
].fmt
.i_codec
) continue;
618 es_out_Del( out
, tk
[i
].es
);
621 tk
[i
].es
= es_out_Add( out
, &tk
[i
].fmt
);