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