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>
26 /* 256-0xC0 for normal stream, 256 for 0xbd stream, 256 for 0xfd stream */
27 #define PS_TK_COUNT (768 - 0xc0)
28 #define PS_ID_TO_TK( id ) ((id) <= 0xff ? (id) - 0xc0 : \
29 ((id)&0xff) + (((id)&0xff00) == 0xbd00 ? 256-0xC0 : 512-0xc0) )
31 typedef struct ps_psm_t ps_psm_t;
32 static inline int ps_id_to_type( const ps_psm_t *, int );
33 static inline const uint8_t *ps_id_to_lang( const ps_psm_t *, int );
47 /* Init a set of track */
48 static inline void ps_track_init( ps_track_t tk[PS_TK_COUNT] )
51 for( i = 0; i < PS_TK_COUNT; i++ )
57 tk[i].i_first_pts = -1;
58 tk[i].i_last_pts = -1;
59 es_format_Init( &tk[i].fmt, UNKNOWN_ES, 0 );
63 /* From id fill i_skip and es_format_t */
64 static inline int ps_track_fill( ps_track_t *tk, ps_psm_t *p_psm, int i_id )
68 if( ( i_id&0xff00 ) == 0xbd00 )
70 if( ( i_id&0xf8 ) == 0x88 || (i_id&0xf8) == 0x98 )
72 es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('d','t','s',' ') );
75 else if( ( i_id&0xf0 ) == 0x80
76 || (i_id&0xf0) == 0xc0 ) /* AC-3, Can also be used for DD+/E-AC-3 */
78 es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('a','5','2',' ') );
81 else if( (i_id&0xf0) == 0xb0 )
83 es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('m','l','p',' ') );
84 /* FIXME / untested ... no known decoder (at least not in VLC/ffmpeg) */
86 else if( ( i_id&0xe0 ) == 0x20 )
88 es_format_Init( &tk->fmt, SPU_ES, VLC_FOURCC('s','p','u',' ') );
91 else if( ( i_id&0xf0 ) == 0xa0 )
93 es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('l','p','c','m') );
96 else if( ( i_id&0xff ) == 0x70 )
98 es_format_Init( &tk->fmt, SPU_ES, VLC_FOURCC('o','g','t',' ') );
100 else if( ( i_id&0xfc ) == 0x00 )
102 es_format_Init( &tk->fmt, SPU_ES, VLC_FOURCC('c','v','d',' ') );
104 else if( ( i_id&0xff ) == 0x10 )
106 es_format_Init( &tk->fmt, SPU_ES, VLC_FOURCC('t','e','l','x') );
110 es_format_Init( &tk->fmt, UNKNOWN_ES, 0 );
114 else if( (i_id&0xff00) == 0xfd00 )
116 uint8_t i_sub_id = i_id & 0xff;
117 if( i_sub_id >= 0x55 && i_sub_id <= 0x5f )
119 es_format_Init( &tk->fmt, VIDEO_ES, VLC_FOURCC('W','V','C','1') );
123 es_format_Init( &tk->fmt, UNKNOWN_ES, 0 );
129 int i_type = ps_id_to_type( p_psm , i_id );
131 es_format_Init( &tk->fmt, UNKNOWN_ES, 0 );
133 if( (i_id&0xf0) == 0xe0 && i_type == 0x1b )
135 es_format_Init( &tk->fmt, VIDEO_ES, VLC_FOURCC('h','2','6','4') );
137 else if( (i_id&0xf0) == 0xe0 && i_type == 0x10 )
139 es_format_Init( &tk->fmt, VIDEO_ES, VLC_FOURCC('m','p','4','v') );
141 else if( (i_id&0xf0) == 0xe0 && i_type == 0x02 )
143 es_format_Init( &tk->fmt, VIDEO_ES, VLC_FOURCC('m','p','g','v') );
145 else if( ( i_id&0xe0 ) == 0xc0 && i_type == 0x0f )
147 es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('m','p','4','a') );
149 else if( ( i_id&0xe0 ) == 0xc0 && i_type == 0x03 )
151 es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('m','p','g','a') );
154 if( tk->fmt.i_cat == UNKNOWN_ES && ( i_id&0xf0 ) == 0xe0 )
156 es_format_Init( &tk->fmt, VIDEO_ES, VLC_FOURCC('m','p','g','v') );
158 else if( tk->fmt.i_cat == UNKNOWN_ES && ( i_id&0xe0 ) == 0xc0 )
160 es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('m','p','g','a') );
162 else if( tk->fmt.i_cat == UNKNOWN_ES ) return VLC_EGENERIC;
165 /* PES packets usually contain truncated frames */
166 tk->fmt.b_packetized = false;
168 if( ps_id_to_lang( p_psm, i_id ) )
170 tk->fmt.psz_language = malloc( 4 );
171 if( tk->fmt.psz_language )
173 memcpy( tk->fmt.psz_language, ps_id_to_lang( p_psm , i_id ), 3 );
174 tk->fmt.psz_language[3] = 0;
181 /* return the id of a PES (should be valid) */
182 static inline int ps_pkt_id( block_t *p_pkt )
184 if( p_pkt->p_buffer[3] == 0xbd &&
185 p_pkt->i_buffer >= 9 &&
186 p_pkt->i_buffer >= 9 + p_pkt->p_buffer[8] )
189 return 0xbd00 | p_pkt->p_buffer[9+p_pkt->p_buffer[8]];
191 else if( p_pkt->p_buffer[3] == 0xfd &&
192 p_pkt->i_buffer >= 9 &&
193 (p_pkt->p_buffer[6]&0xC0) == 0x80 && /* mpeg2 */
194 (p_pkt->p_buffer[7]&0x01) == 0x01 ) /* extension_flag */
196 /* ISO 13818 amendment 2 and SMPTE RP 227 */
197 const uint8_t i_flags = p_pkt->p_buffer[7];
198 unsigned int i_skip = 9;
200 /* Find PES extension */
201 if( (i_flags & 0x80 ) )
203 i_skip += 5; /* pts */
204 if( (i_flags & 0x40) )
205 i_skip += 5; /* dts */
207 if( (i_flags & 0x20 ) )
209 if( (i_flags & 0x10 ) )
211 if( (i_flags & 0x08 ) )
213 if( (i_flags & 0x04 ) )
215 if( (i_flags & 0x02 ) )
218 if( i_skip < p_pkt->i_buffer && (p_pkt->p_buffer[i_skip]&0x01) )
220 const uint8_t i_flags2 = p_pkt->p_buffer[i_skip];
222 /* Find PES extension 2 */
224 if( i_flags2 & 0x80 )
226 if( (i_flags2 & 0x40) && i_skip < p_pkt->i_buffer )
227 i_skip += 1 + p_pkt->p_buffer[i_skip];
228 if( i_flags2 & 0x20 )
230 if( i_flags2 & 0x10 )
233 if( i_skip + 1 < p_pkt->i_buffer )
235 const int i_extension_field_length = p_pkt->p_buffer[i_skip]&0x7f;
236 if( i_extension_field_length >=1 )
238 int i_stream_id_extension_flag = (p_pkt->p_buffer[i_skip+1] >> 7)&0x1;
239 if( i_stream_id_extension_flag == 0 )
240 return 0xfd00 | (p_pkt->p_buffer[i_skip+1]&0x7f);
245 return p_pkt->p_buffer[3];
248 /* return the size of the next packet
249 * XXX you need to give him at least 14 bytes (and it need to start as a
251 static inline int ps_pkt_size( const uint8_t *p, int i_peek )
253 if( p[3] == 0xb9 && i_peek >= 4 )
257 else if( p[3] == 0xba )
259 if( (p[4] >> 6) == 0x01 && i_peek >= 14 )
261 return 14 + (p[13]&0x07);
263 else if( (p[4] >> 4) == 0x02 && i_peek >= 12 )
269 else if( i_peek >= 6 )
271 return 6 + ((p[4]<<8) | p[5] );
276 /* parse a PACK PES */
277 static inline int ps_pkt_parse_pack( block_t *p_pkt, int64_t *pi_scr,
280 uint8_t *p = p_pkt->p_buffer;
281 if( p_pkt->i_buffer >= 14 && (p[4] >> 6) == 0x01 )
283 *pi_scr =((((int64_t)p[4]&0x38) << 27 )|
284 (((int64_t)p[4]&0x03) << 28 )|
285 ((int64_t)p[5] << 20 )|
286 (((int64_t)p[6]&0xf8) << 12 )|
287 (((int64_t)p[6]&0x03) << 13 )|
288 ((int64_t)p[7] << 5 )|
289 ((int64_t)p[8] >> 3 )) * 100 / 9;
291 *pi_mux_rate = ( p[10] << 14 )|( p[11] << 6 )|( p[12] >> 2);
293 else if( p_pkt->i_buffer >= 12 && (p[4] >> 4) == 0x02 )
295 *pi_scr =((((int64_t)p[4]&0x0e) << 29 )|
296 ((int64_t)p[5] << 22 )|
297 (((int64_t)p[6]&0xfe) << 14 )|
298 ((int64_t)p[7] << 7 )|
299 ((int64_t)p[8] >> 1 )) * 100 / 9;
301 *pi_mux_rate = ( ( p[9]&0x7f )<< 15 )|( p[10] << 7 )|( p[11] >> 1);
310 /* Parse a SYSTEM PES */
311 static inline int ps_pkt_parse_system( block_t *p_pkt, ps_psm_t *p_psm,
312 ps_track_t tk[PS_TK_COUNT] )
314 uint8_t *p = &p_pkt->p_buffer[6 + 3 + 1 + 1 + 1];
316 /* System header is not useable if it references private streams (0xBD)
317 * or 'all audio streams' (0xB8) or 'all video streams' (0xB9) */
318 while( p < &p_pkt->p_buffer[p_pkt->i_buffer] )
322 /* fprintf( stderr, " SYSTEM_START_CODEEE: id=0x%x\n", p[0] ); */
323 if( p[0] >= 0xBC || p[0] == 0xB8 || p[0] == 0xB9 ) p += 2;
328 int i_tk = PS_ID_TO_TK( i_id );
330 if( !tk[i_tk].b_seen )
332 if( !ps_track_fill( &tk[i_tk], p_psm, i_id ) )
334 tk[i_tk].b_seen = true;
342 /* Parse a PES (and skip i_skip_extra in the payload) */
343 static inline int ps_pkt_parse_pes( block_t *p_pes, int i_skip_extra )
346 unsigned int i_skip = 0;
348 memcpy( header, p_pes->p_buffer, __MIN( p_pes->i_buffer, 30 ) );
352 case 0xBC: /* Program stream map */
353 case 0xBE: /* Padding */
354 case 0xBF: /* Private stream 2 */
357 case 0xFF: /* Program stream directory */
358 case 0xF2: /* DSMCC stream */
359 case 0xF8: /* ITU-T H.222.1 type E stream */
364 if( ( header[6]&0xC0 ) == 0x80 )
367 i_skip = header[8] + 9;
369 if( header[7]&0x80 ) /* has pts */
371 p_pes->i_pts = ((mtime_t)(header[ 9]&0x0e ) << 29)|
372 (mtime_t)(header[10] << 22)|
373 ((mtime_t)(header[11]&0xfe) << 14)|
374 (mtime_t)(header[12] << 7)|
375 (mtime_t)(header[13] >> 1);
377 if( header[7]&0x40 ) /* has dts */
379 p_pes->i_dts = ((mtime_t)(header[14]&0x0e ) << 29)|
380 (mtime_t)(header[15] << 22)|
381 ((mtime_t)(header[16]&0xfe) << 14)|
382 (mtime_t)(header[17] << 7)|
383 (mtime_t)(header[18] >> 1);
390 while( i_skip < 23 && header[i_skip] == 0xff )
396 /* msg_Err( p_demux, "too much MPEG-1 stuffing" ); */
399 if( ( header[i_skip] & 0xC0 ) == 0x40 )
404 if( header[i_skip]&0x20 )
406 p_pes->i_pts = ((mtime_t)(header[i_skip]&0x0e ) << 29)|
407 (mtime_t)(header[i_skip+1] << 22)|
408 ((mtime_t)(header[i_skip+2]&0xfe) << 14)|
409 (mtime_t)(header[i_skip+3] << 7)|
410 (mtime_t)(header[i_skip+4] >> 1);
412 if( header[i_skip]&0x10 ) /* has dts */
414 p_pes->i_dts = ((mtime_t)(header[i_skip+5]&0x0e ) << 29)|
415 (mtime_t)(header[i_skip+6] << 22)|
416 ((mtime_t)(header[i_skip+7]&0xfe) << 14)|
417 (mtime_t)(header[i_skip+8] << 7)|
418 (mtime_t)(header[i_skip+9] >> 1);
433 i_skip += i_skip_extra;
435 if( p_pes->i_buffer <= i_skip )
440 p_pes->p_buffer += i_skip;
441 p_pes->i_buffer -= i_skip;
443 p_pes->i_dts = 100 * p_pes->i_dts / 9;
444 p_pes->i_pts = 100 * p_pes->i_pts / 9;
449 /* Program stream map handling */
450 typedef struct ps_es_t
456 uint8_t *p_descriptor;
458 /* Language is iso639-2T */
471 static inline int ps_id_to_type( const ps_psm_t *p_psm, int i_id )
474 for( i = 0; p_psm && i < p_psm->i_es; i++ )
476 if( p_psm->es[i]->i_id == i_id ) return p_psm->es[i]->i_type;
481 static inline const uint8_t *ps_id_to_lang( const ps_psm_t *p_psm, int i_id )
484 for( i = 0; p_psm && i < p_psm->i_es; i++ )
486 if( p_psm->es[i]->i_id == i_id ) return p_psm->es[i]->lang;
491 static inline void ps_psm_init( ps_psm_t *p_psm )
493 p_psm->i_version = 0xFFFF;
498 static inline void ps_psm_destroy( ps_psm_t *p_psm )
500 while( p_psm->i_es-- )
502 free( p_psm->es[p_psm->i_es]->p_descriptor );
503 free( p_psm->es[p_psm->i_es] );
511 static inline int ps_psm_fill( ps_psm_t *p_psm, block_t *p_pkt,
512 ps_track_t tk[PS_TK_COUNT], es_out_t *out )
514 int i_buffer = p_pkt->i_buffer;
515 uint8_t *p_buffer = p_pkt->p_buffer;
516 int i_length, i_version, i_info_length, i_esm_length, i_es_base, i;
518 if( !p_psm || p_buffer[3] != 0xbc ) return VLC_EGENERIC;
520 i_length = (uint16_t)(p_buffer[4] << 8) + p_buffer[5] + 6;
521 if( i_length > i_buffer ) return VLC_EGENERIC;
523 //i_current_next_indicator = (p_buffer[6] && 0x01);
524 i_version = (p_buffer[6] && 0xf8);
526 if( p_psm->i_version == i_version ) return VLC_EGENERIC;
528 ps_psm_destroy( p_psm );
530 i_info_length = (uint16_t)(p_buffer[8] << 8) + p_buffer[9];
531 if( i_info_length + 10 > i_length ) return VLC_EGENERIC;
533 /* Elementary stream map */
534 i_esm_length = (uint16_t)(p_buffer[ 10 + i_info_length ] << 8) +
535 p_buffer[ 11 + i_info_length];
536 i_es_base = 12 + i_info_length;
538 while( i_es_base + 4 < i_length )
542 es.lang[0] = es.lang[1] = es.lang[2] = 0;
544 es.i_type = p_buffer[ i_es_base ];
545 es.i_id = p_buffer[ i_es_base + 1 ];
546 i_info_length = (uint16_t)(p_buffer[ i_es_base + 2 ] << 8) +
547 p_buffer[ i_es_base + 3 ];
549 if( i_es_base + 4 + i_info_length > i_length ) break;
551 /* TODO Add support for VC-1 stream:
552 * stream_type=0xea, stream_id=0xfd AND registration
553 * descriptor 0x5 with format_identifier == 0x56432D31 (VC-1)
554 * (I need a sample that use PSM with VC-1) */
557 es.i_descriptor = i_info_length;
558 if( i_info_length > 0 )
562 es.p_descriptor = malloc( i_info_length );
563 if( es.p_descriptor )
565 memcpy( es.p_descriptor, p_buffer + i_es_base + 4, i_info_length);
567 while( i <= es.i_descriptor - 2 )
569 /* Look for the ISO639 language descriptor */
570 if( es.p_descriptor[i] != 0x0a )
572 i += es.p_descriptor[i+1] + 2;
576 if( i <= es.i_descriptor - 6 )
578 es.lang[0] = es.p_descriptor[i+2];
579 es.lang[1] = es.p_descriptor[i+3];
580 es.lang[2] = es.p_descriptor[i+4];
587 tmp_es = realloc( p_psm->es, sizeof(ps_es_t *) * (p_psm->i_es+1) );
591 p_psm->es[p_psm->i_es] = malloc( sizeof(ps_es_t) );
592 if( p_psm->es[p_psm->i_es] )
594 *p_psm->es[p_psm->i_es++] = es;
595 i_es_base += 4 + i_info_length;
602 p_psm->i_version = i_version;
604 /* Check/Modify our existing tracks */
605 for( i = 0; i < PS_TK_COUNT; i++ )
609 if( !tk[i].b_seen || !tk[i].es ) continue;
611 if( ps_track_fill( &tk_tmp, p_psm, tk[i].i_id ) != VLC_SUCCESS )
614 if( tk_tmp.fmt.i_codec == tk[i].fmt.i_codec ) continue;
616 es_out_Del( out, tk[i].es );
619 tk[i].es = es_out_Add( out, &tk[i].fmt );