]> git.sesse.net Git - vlc/blob - modules/demux/ps.h
Add vlclua_dir_list_free to free list created by vlclua_dir_list and use it.
[vlc] / modules / demux / ps.h
1 /*****************************************************************************
2  * ps.h: Program Stream demuxer helper
3  *****************************************************************************
4  * Copyright (C) 2004 the VideoLAN team
5  * $Id$
6  *
7  * Authors: Laurent Aimar <fenrir@via.ecp.fr>
8  *
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.
13  *
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.
18  *
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  *****************************************************************************/
23
24 #include <vlc_demux.h>
25
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) )
30
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 );
34
35 typedef struct
36 {
37     bool  b_seen;
38     int         i_skip;
39     int         i_id;
40     es_out_id_t *es;
41     es_format_t fmt;
42     mtime_t     i_first_pts;
43     mtime_t     i_last_pts;
44
45 } ps_track_t;
46
47 /* Init a set of track */
48 static inline void ps_track_init( ps_track_t tk[PS_TK_COUNT] )
49 {
50     int i;
51     for( i = 0; i < PS_TK_COUNT; i++ )
52     {
53         tk[i].b_seen = false;
54         tk[i].i_skip = 0;
55         tk[i].i_id   = 0;
56         tk[i].es     = NULL;
57         tk[i].i_first_pts = -1;
58         tk[i].i_last_pts = -1;
59         es_format_Init( &tk[i].fmt, UNKNOWN_ES, 0 );
60     }
61 }
62
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 )
65 {
66     tk->i_skip = 0;
67     tk->i_id = i_id;
68     if( ( i_id&0xff00 ) == 0xbd00 )
69     {
70         if( ( i_id&0xf8 ) == 0x88 || (i_id&0xf8) == 0x98 )
71         {
72             es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('d','t','s',' ') );
73             tk->i_skip = 4;
74         }
75         else if( ( i_id&0xf0 ) == 0x80
76                ||  (i_id&0xf0) == 0xc0 ) /* AC-3, Can also be used for DD+/E-AC-3 */
77         {
78             es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('a','5','2',' ') );
79             tk->i_skip = 4;
80         }
81         else if( (i_id&0xf0) == 0xb0 )
82         {
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) */
85         }
86         else if( ( i_id&0xe0 ) == 0x20 )
87         {
88             es_format_Init( &tk->fmt, SPU_ES, VLC_FOURCC('s','p','u',' ') );
89             tk->i_skip = 1;
90         }
91         else if( ( i_id&0xf0 ) == 0xa0 )
92         {
93             es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('l','p','c','m') );
94             tk->i_skip = 1;
95         }
96         else if( ( i_id&0xff ) == 0x70 )
97         {
98             es_format_Init( &tk->fmt, SPU_ES, VLC_FOURCC('o','g','t',' ') );
99         }
100         else if( ( i_id&0xfc ) == 0x00 )
101         {
102             es_format_Init( &tk->fmt, SPU_ES, VLC_FOURCC('c','v','d',' ') );
103         }
104         else if( ( i_id&0xff ) == 0x10 )
105         {
106             es_format_Init( &tk->fmt, SPU_ES, VLC_FOURCC('t','e','l','x') );
107         }
108         else
109         {
110             es_format_Init( &tk->fmt, UNKNOWN_ES, 0 );
111             return VLC_EGENERIC;
112         }
113     }
114     else if( (i_id&0xff00) == 0xfd00 )
115     {
116         uint8_t i_sub_id = i_id & 0xff;
117         if( i_sub_id >= 0x55 && i_sub_id <= 0x5f )
118         {
119             es_format_Init( &tk->fmt, VIDEO_ES, VLC_FOURCC('W','V','C','1') );
120         }
121         else
122         {
123             es_format_Init( &tk->fmt, UNKNOWN_ES, 0 );
124             return VLC_EGENERIC;
125         }
126     }
127     else
128     {
129         int i_type = ps_id_to_type( p_psm , i_id );
130
131         es_format_Init( &tk->fmt, UNKNOWN_ES, 0 );
132
133         if( (i_id&0xf0) == 0xe0 && i_type == 0x1b )
134         {
135             es_format_Init( &tk->fmt, VIDEO_ES, VLC_FOURCC('h','2','6','4') );
136         }
137         else if( (i_id&0xf0) == 0xe0 && i_type == 0x10 )
138         {
139             es_format_Init( &tk->fmt, VIDEO_ES, VLC_FOURCC('m','p','4','v') );
140         }
141         else if( (i_id&0xf0) == 0xe0 && i_type == 0x02 )
142         {
143             es_format_Init( &tk->fmt, VIDEO_ES, VLC_FOURCC('m','p','g','v') );
144         }
145         else if( ( i_id&0xe0 ) == 0xc0 && i_type == 0x0f )
146         {
147             es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('m','p','4','a') );
148         }
149         else if( ( i_id&0xe0 ) == 0xc0 && i_type == 0x03 )
150         {
151             es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('m','p','g','a') );
152         }
153
154         if( tk->fmt.i_cat == UNKNOWN_ES && ( i_id&0xf0 ) == 0xe0 )
155         {
156             es_format_Init( &tk->fmt, VIDEO_ES, VLC_FOURCC('m','p','g','v') );
157         }
158         else if( tk->fmt.i_cat == UNKNOWN_ES && ( i_id&0xe0 ) == 0xc0 )
159         {
160             es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('m','p','g','a') );
161         }
162         else if( tk->fmt.i_cat == UNKNOWN_ES ) return VLC_EGENERIC;
163     }
164
165     /* PES packets usually contain truncated frames */
166     tk->fmt.b_packetized = false;
167
168     if( ps_id_to_lang( p_psm, i_id ) )
169     {
170         tk->fmt.psz_language = malloc( 4 );
171         if( tk->fmt.psz_language )
172         {
173             memcpy( tk->fmt.psz_language, ps_id_to_lang( p_psm , i_id ), 3 );
174             tk->fmt.psz_language[3] = 0;
175         }
176     }
177
178     return VLC_SUCCESS;
179 }
180
181 /* return the id of a PES (should be valid) */
182 static inline int ps_pkt_id( block_t *p_pkt )
183 {
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] )
187     {
188         /* VOB extension */
189         return 0xbd00 | p_pkt->p_buffer[9+p_pkt->p_buffer[8]];
190     }
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 */
195     {
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;
199
200         /* Find PES extension */
201         if( (i_flags & 0x80 ) )
202         {
203             i_skip += 5;        /* pts */
204             if( (i_flags & 0x40) )
205                 i_skip += 5;    /* dts */
206         }
207         if( (i_flags & 0x20 ) )
208             i_skip += 6;
209         if( (i_flags & 0x10 ) )
210             i_skip += 3;
211         if( (i_flags & 0x08 ) )
212             i_skip += 1;
213         if( (i_flags & 0x04 ) )
214             i_skip += 1;
215         if( (i_flags & 0x02 ) )
216             i_skip += 2;
217
218         if( i_skip < p_pkt->i_buffer && (p_pkt->p_buffer[i_skip]&0x01) )
219         {
220             const uint8_t i_flags2 = p_pkt->p_buffer[i_skip];
221
222             /* Find PES extension 2 */
223             i_skip += 1;
224             if( i_flags2 & 0x80 )
225                 i_skip += 16;
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 )
229                 i_skip += 2;
230             if( i_flags2 & 0x10 )
231                 i_skip += 2;
232
233             if( i_skip + 1 < p_pkt->i_buffer )
234             {
235                 const int i_extension_field_length = p_pkt->p_buffer[i_skip]&0x7f;
236                 if( i_extension_field_length >=1 )
237                 {
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);
241                 }
242             }
243         }
244     }
245     return p_pkt->p_buffer[3];
246 }
247
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
250  * valid packet) */
251 static inline int ps_pkt_size( const uint8_t *p, int i_peek )
252 {
253     if( p[3] == 0xb9 && i_peek >= 4 )
254     {
255         return 4;
256     }
257     else if( p[3] == 0xba )
258     {
259         if( (p[4] >> 6) == 0x01 && i_peek >= 14 )
260         {
261             return 14 + (p[13]&0x07);
262         }
263         else if( (p[4] >> 4) == 0x02 && i_peek >= 12 )
264         {
265             return 12;
266         }
267         return -1;
268     }
269     else if( i_peek >= 6 )
270     {
271         return 6 + ((p[4]<<8) | p[5] );
272     }
273     return -1;
274 }
275
276 /* parse a PACK PES */
277 static inline int ps_pkt_parse_pack( block_t *p_pkt, int64_t *pi_scr,
278                                      int *pi_mux_rate )
279 {
280     uint8_t *p = p_pkt->p_buffer;
281     if( p_pkt->i_buffer >= 14 && (p[4] >> 6) == 0x01 )
282     {
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;
290
291         *pi_mux_rate = ( p[10] << 14 )|( p[11] << 6 )|( p[12] >> 2);
292     }
293     else if( p_pkt->i_buffer >= 12 && (p[4] >> 4) == 0x02 )
294     {
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;
300
301         *pi_mux_rate = ( ( p[9]&0x7f )<< 15 )|( p[10] << 7 )|( p[11] >> 1);
302     }
303     else
304     {
305         return VLC_EGENERIC;
306     }
307     return VLC_SUCCESS;
308 }
309
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] )
313 {
314     uint8_t *p = &p_pkt->p_buffer[6 + 3 + 1 + 1 + 1];
315
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] )
319     {
320         int i_id = p[0];
321
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;
324         p++;
325
326         if( i_id >= 0xc0 )
327         {
328             int i_tk = PS_ID_TO_TK( i_id );
329
330             if( !tk[i_tk].b_seen )
331             {
332                 if( !ps_track_fill( &tk[i_tk], p_psm, i_id ) )
333                 {
334                     tk[i_tk].b_seen = true;
335                 }
336             }
337         }
338     }
339     return VLC_SUCCESS;
340 }
341
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 )
344 {
345     uint8_t header[30];
346     unsigned int i_skip  = 0;
347
348     memcpy( header, p_pes->p_buffer, __MIN( p_pes->i_buffer, 30 ) );
349
350     switch( header[3] )
351     {
352         case 0xBC:  /* Program stream map */
353         case 0xBE:  /* Padding */
354         case 0xBF:  /* Private stream 2 */
355         case 0xB0:  /* ECM */
356         case 0xB1:  /* EMM */
357         case 0xFF:  /* Program stream directory */
358         case 0xF2:  /* DSMCC stream */
359         case 0xF8:  /* ITU-T H.222.1 type E stream */
360             i_skip = 6;
361             break;
362
363         default:
364             if( ( header[6]&0xC0 ) == 0x80 )
365             {
366                 /* mpeg2 PES */
367                 i_skip = header[8] + 9;
368
369                 if( header[7]&0x80 )    /* has pts */
370                 {
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);
376
377                     if( header[7]&0x40 )    /* has dts */
378                     {
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);
384                     }
385                 }
386             }
387             else
388             {
389                 i_skip = 6;
390                 while( i_skip < 23 && header[i_skip] == 0xff )
391                 {
392                     i_skip++;
393                 }
394                 if( i_skip == 23 )
395                 {
396                     /* msg_Err( p_demux, "too much MPEG-1 stuffing" ); */
397                     return VLC_EGENERIC;
398                 }
399                 if( ( header[i_skip] & 0xC0 ) == 0x40 )
400                 {
401                     i_skip += 2;
402                 }
403
404                 if(  header[i_skip]&0x20 )
405                 {
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);
411
412                     if( header[i_skip]&0x10 )    /* has dts */
413                     {
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);
419                          i_skip += 10;
420                     }
421                     else
422                     {
423                         i_skip += 5;
424                     }
425                 }
426                 else
427                 {
428                     i_skip += 1;
429                 }
430             }
431     }
432
433     i_skip += i_skip_extra;
434
435     if( p_pes->i_buffer <= i_skip )
436     {
437         return VLC_EGENERIC;
438     }
439
440     p_pes->p_buffer += i_skip;
441     p_pes->i_buffer -= i_skip;
442
443     p_pes->i_dts = 100 * p_pes->i_dts / 9;
444     p_pes->i_pts = 100 * p_pes->i_pts / 9;
445
446     return VLC_SUCCESS;
447 }
448
449 /* Program stream map handling */
450 typedef struct ps_es_t
451 {
452     int i_type;
453     int i_id;
454
455     int i_descriptor;
456     uint8_t *p_descriptor;
457
458     /* Language is iso639-2T */
459     uint8_t lang[3];
460
461 } ps_es_t;
462
463 struct ps_psm_t
464 {
465     int i_version;
466
467     int     i_es;
468     ps_es_t **es;
469 };
470
471 static inline int ps_id_to_type( const ps_psm_t *p_psm, int i_id )
472 {
473     int i;
474     for( i = 0; p_psm && i < p_psm->i_es; i++ )
475     {
476         if( p_psm->es[i]->i_id == i_id ) return p_psm->es[i]->i_type;
477     }
478     return 0;
479 }
480
481 static inline const uint8_t *ps_id_to_lang( const ps_psm_t *p_psm, int i_id )
482 {
483     int i;
484     for( i = 0; p_psm && i < p_psm->i_es; i++ )
485     {
486         if( p_psm->es[i]->i_id == i_id ) return p_psm->es[i]->lang;
487     }
488     return 0;
489 }
490
491 static inline void ps_psm_init( ps_psm_t *p_psm )
492 {
493     p_psm->i_version = 0xFFFF;
494     p_psm->i_es = 0;
495     p_psm->es = 0;
496 }
497
498 static inline void ps_psm_destroy( ps_psm_t *p_psm )
499 {
500     while( p_psm->i_es-- )
501     {
502         free( p_psm->es[p_psm->i_es]->p_descriptor );
503         free( p_psm->es[p_psm->i_es] );
504     }
505     free( p_psm->es );
506
507     p_psm->es = 0;
508     p_psm->i_es = 0;
509 }
510
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 )
513 {
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;
517
518     if( !p_psm || p_buffer[3] != 0xbc ) return VLC_EGENERIC;
519
520     i_length = (uint16_t)(p_buffer[4] << 8) + p_buffer[5] + 6;
521     if( i_length > i_buffer ) return VLC_EGENERIC;
522
523     //i_current_next_indicator = (p_buffer[6] && 0x01);
524     i_version = (p_buffer[6] && 0xf8);
525
526     if( p_psm->i_version == i_version ) return VLC_EGENERIC;
527
528     ps_psm_destroy( p_psm );
529
530     i_info_length = (uint16_t)(p_buffer[8] << 8) + p_buffer[9];
531     if( i_info_length + 10 > i_length ) return VLC_EGENERIC;
532
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;
537
538     while( i_es_base + 4 < i_length )
539     {
540         ps_es_t **tmp_es;
541         ps_es_t es;
542         es.lang[0] = es.lang[1] = es.lang[2] = 0;
543
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 ];
548
549         if( i_es_base + 4 + i_info_length > i_length ) break;
550
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) */
555
556         es.p_descriptor = 0;
557         es.i_descriptor = i_info_length;
558         if( i_info_length > 0 )
559         {
560             int i = 0;
561
562             es.p_descriptor = malloc( i_info_length );
563             if( es.p_descriptor )
564             {
565                 memcpy( es.p_descriptor, p_buffer + i_es_base + 4, i_info_length);
566
567                 while( i <= es.i_descriptor - 2 )
568                 {
569                     /* Look for the ISO639 language descriptor */
570                     if( es.p_descriptor[i] != 0x0a )
571                     {
572                         i += es.p_descriptor[i+1] + 2;
573                         continue;
574                     }
575
576                     if( i <= es.i_descriptor - 6 )
577                     {
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];
581                     }
582                     break;
583                 }
584             }
585         }
586
587         tmp_es = realloc( p_psm->es, sizeof(ps_es_t *) * (p_psm->i_es+1) );
588         if( tmp_es )
589         {
590             p_psm->es = tmp_es;
591             p_psm->es[p_psm->i_es] = malloc( sizeof(ps_es_t) );
592             if( p_psm->es[p_psm->i_es] )
593             {
594                 *p_psm->es[p_psm->i_es++] = es;
595                 i_es_base += 4 + i_info_length;
596             }
597         }
598     }
599
600     /* TODO: CRC */
601
602     p_psm->i_version = i_version;
603
604     /* Check/Modify our existing tracks */
605     for( i = 0; i < PS_TK_COUNT; i++ )
606     {
607         ps_track_t tk_tmp;
608
609         if( !tk[i].b_seen || !tk[i].es ) continue;
610
611         if( ps_track_fill( &tk_tmp, p_psm, tk[i].i_id ) != VLC_SUCCESS )
612             continue;
613
614         if( tk_tmp.fmt.i_codec == tk[i].fmt.i_codec ) continue;
615
616         es_out_Del( out, tk[i].es );
617         tk[i] = tk_tmp;
618         tk[i].b_seen = true;
619         tk[i].es = es_out_Add( out, &tk[i].fmt );
620     }
621
622     return VLC_SUCCESS;
623 }