git.sesse.net Git - vlc/blob - modules/demux/ps.h

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