PS: pass an extra block_t parameter to ps_track_fill
[vlc.git] / modules / demux / ps.h
1 /*****************************************************************************
2  * ps.h: Program Stream demuxer helper
3  *****************************************************************************
4  * Copyright (C) 2004-2009 VLC authors and VideoLAN
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 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.
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 Lesser General Public License for more details.
18  *
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  *****************************************************************************/
23
24 #include <assert.h>
25 #include <vlc_demux.h>
26 #include <vlc_memory.h>
27
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)
30 #if 0
31 #define PS_ID_TO_TK( id ) ((id) <= 0xff ? (id) - 0xc0 : \
32             ((id)&0xff) + (((id)&0xff00) == 0xbd00 ? 256-0xC0 : 512-0xc0) )
33 #else
34 static inline int ps_id_to_tk( unsigned i_id )
35 {
36     if( i_id <= 0xff )
37         return i_id - 0xc0;
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);
42     else
43         return 768-0xc0 + (i_id & 0x07);
44 }
45 #define PS_ID_TO_TK( id ) ps_id_to_tk( id )
46 #endif
47
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 );
51
52 typedef struct
53 {
54     bool  b_seen;
55     int         i_skip;
56     int         i_id;
57     es_out_id_t *es;
58     es_format_t fmt;
59     mtime_t     i_first_pts;
60     mtime_t     i_last_pts;
61
62 } ps_track_t;
63
64 /* Init a set of track */
65 static inline void ps_track_init( ps_track_t tk[PS_TK_COUNT] )
66 {
67     int i;
68     for( i = 0; i < PS_TK_COUNT; i++ )
69     {
70         tk[i].b_seen = false;
71         tk[i].i_skip = 0;
72         tk[i].i_id   = 0;
73         tk[i].es     = NULL;
74         tk[i].i_first_pts = -1;
75         tk[i].i_last_pts = -1;
76         es_format_Init( &tk[i].fmt, UNKNOWN_ES, 0 );
77     }
78 }
79
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 )
82 {
83     tk->i_skip = 0;
84     tk->i_id = i_id;
85     if( ( i_id&0xff00 ) == 0xbd00 ) /* 0xBD00 -> 0xBDFF, Private Stream 1 */
86     {
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 */
89         {
90             es_format_Init( &tk->fmt, AUDIO_ES, VLC_CODEC_DTS );
91             tk->i_skip = 4;
92         }
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 */
95         {
96             es_format_Init( &tk->fmt, AUDIO_ES, VLC_CODEC_A52 );
97             tk->i_skip = 4;
98         }
99         else if( ( i_id&0xfc ) == 0x00 ) /* 0x00 -> 0x03 */
100         {
101             es_format_Init( &tk->fmt, SPU_ES, VLC_CODEC_CVD );
102         }
103         else if( ( i_id&0xff ) == 0x10 ) /* 0x10 */
104         {
105             es_format_Init( &tk->fmt, SPU_ES, VLC_CODEC_TELETEXT );
106         }
107         else if( ( i_id&0xe0 ) == 0x20 ) /* 0x20 -> 0x3f */
108         {
109             es_format_Init( &tk->fmt, SPU_ES, VLC_CODEC_SPU );
110             tk->i_skip = 1;
111         }
112         else if( ( i_id&0xff ) == 0x70 ) /* 0x70 */
113         {
114             es_format_Init( &tk->fmt, SPU_ES, VLC_CODEC_OGT );
115         }
116         else if( ( i_id&0xf0 ) == 0xa0 ) /* 0xa0 -> 0xaf */
117         {
118             es_format_Init( &tk->fmt, AUDIO_ES, VLC_CODEC_DVD_LPCM );
119             tk->i_skip = 1;
120         }
121         else if( ( i_id&0xf0 ) == 0xb0 ) /* 0xb0 -> 0xbf */
122         {
123             es_format_Init( &tk->fmt, AUDIO_ES, VLC_CODEC_TRUEHD );
124             tk->i_skip = 5;
125         }
126         else
127         {
128             es_format_Init( &tk->fmt, UNKNOWN_ES, 0 );
129             return VLC_EGENERIC;
130         }
131     }
132     else if( (i_id&0xff00) == 0xfd00 ) /* 0xFD00 -> 0xFDFF */
133     {
134         uint8_t i_sub_id = i_id & 0xff;
135         if( ( i_sub_id >= 0x55 && i_sub_id <= 0x5f ) || /* Can be primary VC-1 in evob */
136             ( i_sub_id >= 0x75 && i_sub_id <= 0x7f ) )  /* Secondary VC-1 */
137         {
138             es_format_Init( &tk->fmt, VIDEO_ES, VLC_CODEC_VC1 );
139         }
140         else
141         {
142             es_format_Init( &tk->fmt, UNKNOWN_ES, 0 );
143             return VLC_EGENERIC;
144         }
145     }
146     else if( (i_id&0xff00) == 0xa000 ) /* 0xA000 -> 0xA0FF */
147     {
148         uint8_t i_sub_id = i_id & 0x07;
149         if( i_sub_id == 0 )
150         {
151             es_format_Init( &tk->fmt, AUDIO_ES, VLC_CODEC_DVDA_LPCM );
152             tk->i_skip = 1;
153         }
154         else if( i_sub_id == 1 )
155         {
156             es_format_Init( &tk->fmt, AUDIO_ES, VLC_CODEC_MLP );
157             tk->i_skip = -1; /* It's a hack for variable skip value */
158         }
159         else
160         {
161             es_format_Init( &tk->fmt, UNKNOWN_ES, 0 );
162             return VLC_EGENERIC;
163         }
164     }
165     else
166     {
167         int i_type = ps_id_to_type( p_psm , i_id );
168
169         es_format_Init( &tk->fmt, UNKNOWN_ES, 0 );
170
171         if( (i_id&0xf0) == 0xe0 ) /* 0xe0 -> 0xef */
172         {
173             if( i_type == 0x1b )
174             {
175                 es_format_Init( &tk->fmt, VIDEO_ES, VLC_CODEC_H264 );
176             }
177             else if( i_type == 0x10 )
178             {
179                 es_format_Init( &tk->fmt, VIDEO_ES, VLC_CODEC_MP4V );
180             }
181             else if( i_type == 0x01 ||
182                      i_type == 0x02 )
183             {
184                 es_format_Init( &tk->fmt, VIDEO_ES, VLC_CODEC_MPGV );
185             }
186             else if( i_id == 0xe2 || /* Primary H.264 in evob */
187                      i_id == 0xe3 )  /* Seconday H.264 in evob */
188             {
189                 es_format_Init( &tk->fmt, VIDEO_ES, VLC_CODEC_H264 );
190             }
191             else if( tk->fmt.i_cat == UNKNOWN_ES )
192             {
193                 es_format_Init( &tk->fmt, VIDEO_ES, VLC_CODEC_MPGV );
194             }
195         }
196         else if( ( i_id&0xe0 ) == 0xc0 ) /* 0xc0 -> 0xdf */
197         {
198             if( i_type == 0x03 ||
199                 i_type == 0x04 )
200             {
201                 es_format_Init( &tk->fmt, AUDIO_ES, VLC_CODEC_MPGA );
202             }
203             else if( i_type == 0x0f )
204             {
205                 es_format_Init( &tk->fmt, AUDIO_ES, VLC_CODEC_MP4A );
206             }
207             else if( i_type == 0x11 )
208             {
209                 es_format_Init( &tk->fmt, AUDIO_ES, VLC_CODEC_MP4A );
210             }
211             else if( tk->fmt.i_cat == UNKNOWN_ES )
212             {
213                 es_format_Init( &tk->fmt, AUDIO_ES, VLC_CODEC_MPGA );
214             }
215         }
216         else if( tk->fmt.i_cat == UNKNOWN_ES ) return VLC_EGENERIC;
217     }
218
219     /* PES packets usually contain truncated frames */
220     tk->fmt.b_packetized = false;
221
222     if( ps_id_to_lang( p_psm, i_id ) )
223     {
224         tk->fmt.psz_language = malloc( 4 );
225         if( tk->fmt.psz_language )
226         {
227             memcpy( tk->fmt.psz_language, ps_id_to_lang( p_psm , i_id ), 3 );
228             tk->fmt.psz_language[3] = 0;
229         }
230     }
231
232     return VLC_SUCCESS;
233 }
234
235 /* return the id of a PES (should be valid) */
236 static inline int ps_pkt_id( block_t *p_pkt )
237 {
238     if( p_pkt->p_buffer[3] == 0xbd &&
239         p_pkt->i_buffer >= 9 &&
240         p_pkt->i_buffer >= 9 + (size_t)p_pkt->p_buffer[8] )
241     {
242         const unsigned i_start = 9 + p_pkt->p_buffer[8];
243         const uint8_t i_sub_id = p_pkt->p_buffer[i_start];
244
245         if( (i_sub_id & 0xfe) == 0xa0 &&
246             p_pkt->i_buffer >= i_start + 7 &&
247             ( p_pkt->p_buffer[i_start + 5] >=  0xc0 ||
248               p_pkt->p_buffer[i_start + 6] != 0x80 ) )
249         {
250             /* AOB LPCM/MLP extension
251              * XXX for MLP I think that the !=0x80 test is not good and
252              * will fail for some valid files */
253             return 0xa000 | (i_sub_id & 0x01);
254         }
255
256         /* VOB extension */
257         return 0xbd00 | i_sub_id;
258     }
259     else if( p_pkt->p_buffer[3] == 0xfd &&
260              p_pkt->i_buffer >= 9 &&
261              (p_pkt->p_buffer[6]&0xC0) == 0x80 &&   /* mpeg2 */
262              (p_pkt->p_buffer[7]&0x01) == 0x01 )    /* extension_flag */
263     {
264         /* ISO 13818 amendment 2 and SMPTE RP 227 */
265         const uint8_t i_flags = p_pkt->p_buffer[7];
266         unsigned int i_skip = 9;
267
268         /* Find PES extension */
269         if( (i_flags & 0x80 ) )
270         {
271             i_skip += 5;        /* pts */
272             if( (i_flags & 0x40) )
273                 i_skip += 5;    /* dts */
274         }
275         if( (i_flags & 0x20 ) )
276             i_skip += 6;
277         if( (i_flags & 0x10 ) )
278             i_skip += 3;
279         if( (i_flags & 0x08 ) )
280             i_skip += 1;
281         if( (i_flags & 0x04 ) )
282             i_skip += 1;
283         if( (i_flags & 0x02 ) )
284             i_skip += 2;
285
286         if( i_skip < p_pkt->i_buffer && (p_pkt->p_buffer[i_skip]&0x01) )
287         {
288             const uint8_t i_flags2 = p_pkt->p_buffer[i_skip];
289
290             /* Find PES extension 2 */
291             i_skip += 1;
292             if( i_flags2 & 0x80 )
293                 i_skip += 16;
294             if( (i_flags2 & 0x40) && i_skip < p_pkt->i_buffer )
295                 i_skip += 1 + p_pkt->p_buffer[i_skip];
296             if( i_flags2 & 0x20 )
297                 i_skip += 2;
298             if( i_flags2 & 0x10 )
299                 i_skip += 2;
300
301             if( i_skip + 1 < p_pkt->i_buffer )
302             {
303                 const int i_extension_field_length = p_pkt->p_buffer[i_skip]&0x7f;
304                 if( i_extension_field_length >=1 )
305                 {
306                     int i_stream_id_extension_flag = (p_pkt->p_buffer[i_skip+1] >> 7)&0x1;
307                     if( i_stream_id_extension_flag == 0 )
308                         return 0xfd00 | (p_pkt->p_buffer[i_skip+1]&0x7f);
309                 }
310             }
311         }
312     }
313     return p_pkt->p_buffer[3];
314 }
315
316 /* return the size of the next packet */
317 static inline int ps_pkt_size( const uint8_t *p, int i_peek )
318 {
319     if( unlikely(i_peek < 4) )
320     {
321         return -1;
322     }
323     else if( p[3] == 0xb9 )
324     {
325         return 4;
326     }
327     else if( p[3] == 0xba )
328     {
329         if( i_peek >= 14 && (p[4] >> 6) == 0x01 )
330         {
331             return 14 + (p[13]&0x07);
332         }
333         else if( i_peek >= 12 && (p[4] >> 4) == 0x02 )
334         {
335             return 12;
336         }
337         return -1;
338     }
339     else if( i_peek >= 6 )
340     {
341         return 6 + ((p[4]<<8) | p[5] );
342     }
343     return -1;
344 }
345
346 /* parse a PACK PES */
347 static inline int ps_pkt_parse_pack( block_t *p_pkt, int64_t *pi_scr,
348                                      int *pi_mux_rate )
349 {
350     uint8_t *p = p_pkt->p_buffer;
351     if( p_pkt->i_buffer >= 14 && (p[4] >> 6) == 0x01 )
352     {
353         *pi_scr =((((int64_t)p[4]&0x38) << 27 )|
354                   (((int64_t)p[4]&0x03) << 28 )|
355                    ((int64_t)p[5] << 20 )|
356                   (((int64_t)p[6]&0xf8) << 12 )|
357                   (((int64_t)p[6]&0x03) << 13 )|
358                    ((int64_t)p[7] << 5 )|
359                    ((int64_t)p[8] >> 3 )) * 100 / 9;
360
361         *pi_mux_rate = ( p[10] << 14 )|( p[11] << 6 )|( p[12] >> 2);
362     }
363     else if( p_pkt->i_buffer >= 12 && (p[4] >> 4) == 0x02 )
364     {
365         *pi_scr =((((int64_t)p[4]&0x0e) << 29 )|
366                    ((int64_t)p[5] << 22 )|
367                   (((int64_t)p[6]&0xfe) << 14 )|
368                    ((int64_t)p[7] <<  7 )|
369                    ((int64_t)p[8] >> 1 )) * 100 / 9;
370
371         *pi_mux_rate = ( ( p[9]&0x7f )<< 15 )|( p[10] << 7 )|( p[11] >> 1);
372     }
373     else
374     {
375         return VLC_EGENERIC;
376     }
377     return VLC_SUCCESS;
378 }
379
380 /* Parse a SYSTEM PES */
381 static inline int ps_pkt_parse_system( block_t *p_pkt, ps_psm_t *p_psm,
382                                        ps_track_t tk[PS_TK_COUNT] )
383 {
384     uint8_t *p = &p_pkt->p_buffer[6 + 3 + 1 + 1 + 1];
385
386     /* System header is not useable if it references private streams (0xBD)
387      * or 'all audio streams' (0xB8) or 'all video streams' (0xB9) */
388     while( p < &p_pkt->p_buffer[p_pkt->i_buffer] )
389     {
390         int i_id = p[0];
391
392         /* fprintf( stderr, "   SYSTEM_START_CODEEE: id=0x%x\n", p[0] ); */
393         if( p[0] >= 0xBC || p[0] == 0xB8 || p[0] == 0xB9 ) p += 2;
394         p++;
395
396         if( i_id >= 0xc0 )
397         {
398             int i_tk = PS_ID_TO_TK( i_id );
399
400             if( !tk[i_tk].b_seen )
401             {
402                 if( !ps_track_fill( &tk[i_tk], p_psm, i_id, p_pkt ) )
403                 {
404                     tk[i_tk].b_seen = true;
405                 }
406             }
407         }
408     }
409     return VLC_SUCCESS;
410 }
411
412 /* Parse a PES (and skip i_skip_extra in the payload) */
413 static inline int ps_pkt_parse_pes( block_t *p_pes, int i_skip_extra )
414 {
415     uint8_t header[34];
416     unsigned int i_skip  = 0;
417     int64_t i_pts = -1;
418     int64_t i_dts = -1;
419
420     memcpy( header, p_pes->p_buffer, __MIN( p_pes->i_buffer, 34 ) );
421
422     switch( header[3] )
423     {
424         case 0xBC:  /* Program stream map */
425         case 0xBE:  /* Padding */
426         case 0xBF:  /* Private stream 2 */
427         case 0xB0:  /* ECM */
428         case 0xB1:  /* EMM */
429         case 0xFF:  /* Program stream directory */
430         case 0xF2:  /* DSMCC stream */
431         case 0xF8:  /* ITU-T H.222.1 type E stream */
432             i_skip = 6;
433             break;
434
435         default:
436             if( ( header[6]&0xC0 ) == 0x80 )
437             {
438                 /* mpeg2 PES */
439                 i_skip = header[8] + 9;
440
441                 if( header[7]&0x80 )    /* has pts */
442                 {
443                     i_pts = ((mtime_t)(header[ 9]&0x0e ) << 29)|
444                              (mtime_t)(header[10] << 22)|
445                             ((mtime_t)(header[11]&0xfe) << 14)|
446                              (mtime_t)(header[12] << 7)|
447                              (mtime_t)(header[13] >> 1);
448
449                     if( header[7]&0x40 )    /* has dts */
450                     {
451                          i_dts = ((mtime_t)(header[14]&0x0e ) << 29)|
452                                   (mtime_t)(header[15] << 22)|
453                                  ((mtime_t)(header[16]&0xfe) << 14)|
454                                   (mtime_t)(header[17] << 7)|
455                                   (mtime_t)(header[18] >> 1);
456                     }
457                 }
458             }
459             else
460             {
461                 i_skip = 6;
462                 while( i_skip < 23 && header[i_skip] == 0xff )
463                 {
464                     i_skip++;
465                 }
466                 if( i_skip == 23 )
467                 {
468                     /* msg_Err( p_demux, "too much MPEG-1 stuffing" ); */
469                     return VLC_EGENERIC;
470                 }
471                 if( ( header[i_skip] & 0xC0 ) == 0x40 )
472                 {
473                     i_skip += 2;
474                 }
475
476                 if(  header[i_skip]&0x20 )
477                 {
478                      i_pts = ((mtime_t)(header[i_skip]&0x0e ) << 29)|
479                               (mtime_t)(header[i_skip+1] << 22)|
480                              ((mtime_t)(header[i_skip+2]&0xfe) << 14)|
481                               (mtime_t)(header[i_skip+3] << 7)|
482                               (mtime_t)(header[i_skip+4] >> 1);
483
484                     if( header[i_skip]&0x10 )    /* has dts */
485                     {
486                          i_dts = ((mtime_t)(header[i_skip+5]&0x0e ) << 29)|
487                                   (mtime_t)(header[i_skip+6] << 22)|
488                                  ((mtime_t)(header[i_skip+7]&0xfe) << 14)|
489                                   (mtime_t)(header[i_skip+8] << 7)|
490                                   (mtime_t)(header[i_skip+9] >> 1);
491                          i_skip += 10;
492                     }
493                     else
494                     {
495                         i_skip += 5;
496                     }
497                 }
498                 else
499                 {
500                     i_skip += 1;
501                 }
502             }
503     }
504
505     if( i_skip_extra >= 0 )
506         i_skip += i_skip_extra;
507     else if( p_pes->i_buffer > i_skip + 3 &&
508              ( ps_pkt_id( p_pes ) == 0xa001 || ps_pkt_id( p_pes ) == 0xbda1 ) )
509         i_skip += 4 + p_pes->p_buffer[i_skip+3];
510
511     if( p_pes->i_buffer <= i_skip )
512     {
513         return VLC_EGENERIC;
514     }
515
516     p_pes->p_buffer += i_skip;
517     p_pes->i_buffer -= i_skip;
518
519     if( i_dts >= 0 )
520         p_pes->i_dts = VLC_TS_0 + 100 * i_dts / 9;
521     if( i_pts >= 0 )
522         p_pes->i_pts = VLC_TS_0 + 100 * i_pts / 9;
523
524     return VLC_SUCCESS;
525 }
526
527 /* Program stream map handling */
528 typedef struct ps_es_t
529 {
530     int i_type;
531     int i_id;
532
533     int i_descriptor;
534     uint8_t *p_descriptor;
535
536     /* Language is iso639-2T */
537     uint8_t lang[3];
538
539 } ps_es_t;
540
541 struct ps_psm_t
542 {
543     int i_version;
544
545     int     i_es;
546     ps_es_t **es;
547 };
548
549 static inline int ps_id_to_type( const ps_psm_t *p_psm, int i_id )
550 {
551     int i;
552     for( i = 0; p_psm && i < p_psm->i_es; i++ )
553     {
554         if( p_psm->es[i]->i_id == i_id ) return p_psm->es[i]->i_type;
555     }
556     return 0;
557 }
558
559 static inline const uint8_t *ps_id_to_lang( const ps_psm_t *p_psm, int i_id )
560 {
561     int i;
562     for( i = 0; p_psm && i < p_psm->i_es; i++ )
563     {
564         if( p_psm->es[i]->i_id == i_id ) return p_psm->es[i]->lang;
565     }
566     return 0;
567 }
568
569 static inline void ps_psm_init( ps_psm_t *p_psm )
570 {
571     p_psm->i_version = 0xFFFF;
572     p_psm->i_es = 0;
573     p_psm->es = 0;
574 }
575
576 static inline void ps_psm_destroy( ps_psm_t *p_psm )
577 {
578     while( p_psm->i_es-- )
579     {
580         free( p_psm->es[p_psm->i_es]->p_descriptor );
581         free( p_psm->es[p_psm->i_es] );
582     }
583     free( p_psm->es );
584
585     p_psm->es = 0;
586     p_psm->i_es = 0;
587 }
588
589 static inline int ps_psm_fill( ps_psm_t *p_psm, block_t *p_pkt,
590                                ps_track_t tk[PS_TK_COUNT], es_out_t *out )
591 {
592     int i_buffer = p_pkt->i_buffer;
593     uint8_t *p_buffer = p_pkt->p_buffer;
594     int i_length, i_version, i_info_length, i_es_base;
595
596     if( !p_psm || p_buffer[3] != 0xbc ) return VLC_EGENERIC;
597
598     i_length = (uint16_t)(p_buffer[4] << 8) + p_buffer[5] + 6;
599     if( i_length > i_buffer ) return VLC_EGENERIC;
600
601     //i_current_next_indicator = (p_buffer[6] & 0x01);
602     i_version = (p_buffer[6] & 0xf8);
603
604     if( p_psm->i_version == i_version ) return VLC_EGENERIC;
605
606     ps_psm_destroy( p_psm );
607
608     i_info_length = (uint16_t)(p_buffer[8] << 8) + p_buffer[9];
609     if( i_info_length + 10 > i_length ) return VLC_EGENERIC;
610
611     /* Elementary stream map */
612     /* int i_esm_length = (uint16_t)(p_buffer[ 10 + i_info_length ] << 8) +
613         p_buffer[ 11 + i_info_length]; */
614     i_es_base = 12 + i_info_length;
615
616     while( i_es_base + 4 < i_length )
617     {
618         ps_es_t **tmp_es;
619         ps_es_t es;
620         es.lang[0] = es.lang[1] = es.lang[2] = 0;
621
622         es.i_type = p_buffer[ i_es_base  ];
623         es.i_id = p_buffer[ i_es_base + 1 ];
624         i_info_length = (uint16_t)(p_buffer[ i_es_base + 2 ] << 8) +
625             p_buffer[ i_es_base + 3 ];
626
627         if( i_es_base + 4 + i_info_length > i_length ) break;
628
629         /* TODO Add support for VC-1 stream:
630          *      stream_type=0xea, stream_id=0xfd AND registration
631          *      descriptor 0x5 with format_identifier == 0x56432D31 (VC-1)
632          *      (I need a sample that use PSM with VC-1) */
633
634         es.p_descriptor = 0;
635         es.i_descriptor = i_info_length;
636         if( i_info_length > 0 )
637         {
638             int i = 0;
639
640             es.p_descriptor = malloc( i_info_length );
641             if( es.p_descriptor )
642             {
643                 memcpy( es.p_descriptor, p_buffer + i_es_base + 4, i_info_length);
644
645                 while( i <= es.i_descriptor - 2 )
646                 {
647                     /* Look for the ISO639 language descriptor */
648                     if( es.p_descriptor[i] != 0x0a )
649                     {
650                         i += es.p_descriptor[i+1] + 2;
651                         continue;
652                     }
653
654                     if( i <= es.i_descriptor - 6 )
655                     {
656                         es.lang[0] = es.p_descriptor[i+2];
657                         es.lang[1] = es.p_descriptor[i+3];
658                         es.lang[2] = es.p_descriptor[i+4];
659                     }
660                     break;
661                 }
662             }
663         }
664
665         tmp_es = realloc_or_free( p_psm->es, sizeof(ps_es_t *) * (p_psm->i_es+1) );
666         if( tmp_es )
667         {
668             p_psm->es = tmp_es;
669             p_psm->es[p_psm->i_es] = malloc( sizeof(ps_es_t) );
670             if( p_psm->es[p_psm->i_es] )
671             {
672                 *p_psm->es[p_psm->i_es++] = es;
673                 i_es_base += 4 + i_info_length;
674             }
675         }
676     }
677
678     /* TODO: CRC */
679
680     p_psm->i_version = i_version;
681
682     /* Check/Modify our existing tracks */
683     for( int i = 0; i < PS_TK_COUNT; i++ )
684     {
685         ps_track_t tk_tmp;
686
687         if( !tk[i].b_seen || !tk[i].es ) continue;
688
689         if( ps_track_fill( &tk_tmp, p_psm, tk[i].i_id, p_pkt ) != VLC_SUCCESS )
690             continue;
691
692         if( tk_tmp.fmt.i_codec == tk[i].fmt.i_codec )
693         {
694             es_format_Clean( &tk_tmp.fmt );
695             continue;
696         }
697
698         es_out_Del( out, tk[i].es );
699         es_format_Clean( &tk[i].fmt );
700
701         tk[i] = tk_tmp;
702         tk[i].b_seen = true;
703         tk[i].es = es_out_Add( out, &tk[i].fmt );
704     }
705
706     return VLC_SUCCESS;
707 }