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

   1 /*****************************************************************************
   2  * ps.h: Program Stream demuxer helper
   3  *****************************************************************************
   4  * Copyright (C) 2004 VideoLAN (Centrale Réseaux) and its contributors
   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., 59 Temple Place - Suite 330, Boston, MA  02111, USA.
  22  *****************************************************************************/
  23
  24 #define PS_TK_COUNT (512 - 0xc0)
  25 #define PS_ID_TO_TK( id ) ((id) <= 0xff ? (id) - 0xc0 : \
  26                                           ((id)&0xff) + (256 - 0xc0))
  27
  28 typedef struct ps_psm_t ps_psm_t;
  29 static inline int ps_id_to_type( ps_psm_t *, int );
  30 static inline char *ps_id_to_lang( ps_psm_t *, int );
  31
  32 typedef struct
  33 {
  34     vlc_bool_t  b_seen;
  35     int         i_skip;
  36     int         i_id;
  37     es_out_id_t *es;
  38     es_format_t fmt;
  39
  40 } ps_track_t;
  41
  42 /* Init a set of track */
  43 static inline void ps_track_init( ps_track_t tk[PS_TK_COUNT] )
  44 {
  45     int i;
  46     for( i = 0; i < PS_TK_COUNT; i++ )
  47     {
  48         tk[i].b_seen = VLC_FALSE;
  49         tk[i].i_skip = 0;
  50         tk[i].i_id   = 0;
  51         tk[i].es     = NULL;
  52         es_format_Init( &tk[i].fmt, UNKNOWN_ES, 0 );
  53     }
  54 }
  55
  56 /* From id fill i_skip and es_format_t */
  57 static inline int ps_track_fill( ps_track_t *tk, ps_psm_t *p_psm, int i_id )
  58 {
  59     tk->i_skip = 0;
  60     tk->i_id = i_id;
  61     if( ( i_id&0xff00 ) == 0xbd00 )
  62     {
  63         if( ( i_id&0xf8 ) == 0x88 )
  64         {
  65             es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('d','t','s',' ') );
  66             tk->i_skip = 4;
  67         }
  68         else if( ( i_id&0xf0 ) == 0x80 )
  69         {
  70             es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('a','5','2',' ') );
  71             tk->i_skip = 4;
  72         }
  73         else if( ( i_id&0xe0 ) == 0x20 )
  74         {
  75             es_format_Init( &tk->fmt, SPU_ES, VLC_FOURCC('s','p','u',' ') );
  76             tk->i_skip = 1;
  77         }
  78         else if( ( i_id&0xf0 ) == 0xa0 )
  79         {
  80             es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('l','p','c','m') );
  81             tk->i_skip = 1;
  82         }
  83         else if( ( i_id&0xff ) == 0x70 )
  84         {
  85             es_format_Init( &tk->fmt, SPU_ES, VLC_FOURCC('o','g','t',' ') );
  86         }
  87         else if( ( i_id&0xfc ) == 0x00 )
  88         {
  89             es_format_Init( &tk->fmt, SPU_ES, VLC_FOURCC('c','v','d',' ') );
  90         }
  91         else
  92         {
  93             es_format_Init( &tk->fmt, UNKNOWN_ES, 0 );
  94             return VLC_EGENERIC;
  95         }
  96     }
  97     else
  98     {
  99         int i_type = ps_id_to_type( p_psm , i_id );
 100
 101         es_format_Init( &tk->fmt, UNKNOWN_ES, 0 );
 102
 103         if( (i_id&0xf0) == 0xe0 && i_type == 0x1b )
 104         {
 105             es_format_Init( &tk->fmt, VIDEO_ES, VLC_FOURCC('h','2','6','4') );
 106         }
 107         else if( (i_id&0xf0) == 0xe0 && i_type == 0x10 )
 108         {
 109             es_format_Init( &tk->fmt, VIDEO_ES, VLC_FOURCC('m','p','4','v') );
 110         }
 111         else if( (i_id&0xf0) == 0xe0 && i_type == 0x02 )
 112         {
 113             es_format_Init( &tk->fmt, VIDEO_ES, VLC_FOURCC('m','p','g','v') );
 114         }
 115         else if( ( i_id&0xe0 ) == 0xc0 && i_type == 0x0f )
 116         {
 117             es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('m','p','4','a') );
 118         }
 119         else if( ( i_id&0xe0 ) == 0xc0 && i_type == 0x03 )
 120         {
 121             es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('m','p','g','a') );
 122         }
 123
 124         if( tk->fmt.i_cat == UNKNOWN_ES && ( i_id&0xf0 ) == 0xe0 )
 125         {
 126             es_format_Init( &tk->fmt, VIDEO_ES, VLC_FOURCC('m','p','g','v') );
 127         }
 128         else if( tk->fmt.i_cat == UNKNOWN_ES && ( i_id&0xe0 ) == 0xc0 )
 129         {
 130             es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('m','p','g','a') );
 131         }
 132         else if( tk->fmt.i_cat == UNKNOWN_ES ) return VLC_EGENERIC;
 133     }
 134
 135     /* PES packets usually contain truncated frames */
 136     tk->fmt.b_packetized = VLC_FALSE;
 137
 138     if( ps_id_to_lang( p_psm , i_id ) )
 139     {
 140         tk->fmt.psz_language = malloc( 4 );
 141         memcpy( tk->fmt.psz_language, ps_id_to_lang( p_psm , i_id ), 3 );
 142         tk->fmt.psz_language[3] = 0;
 143     }
 144
 145     return VLC_SUCCESS;
 146 }
 147
 148 /* return the id of a PES (should be valid) */
 149 static inline int ps_pkt_id( block_t *p_pkt )
 150 {
 151     if( p_pkt->p_buffer[3] == 0xbd &&
 152         p_pkt->i_buffer >= 9 &&
 153         p_pkt->i_buffer >= 9 + p_pkt->p_buffer[8] )
 154     {
 155         return 0xbd00 | p_pkt->p_buffer[9+p_pkt->p_buffer[8]];
 156     }
 157     return p_pkt->p_buffer[3];
 158 }
 159
 160 /* return the size of the next packet
 161  * XXX you need to give him at least 14 bytes (and it need to start as a
 162  * valid packet) */
 163 static inline int ps_pkt_size( uint8_t *p, int i_peek )
 164 {
 165     if( p[3] == 0xb9 && i_peek >= 4 )
 166     {
 167         return 4;
 168     }
 169     else if( p[3] == 0xba )
 170     {
 171         if( (p[4] >> 6) == 0x01 && i_peek >= 14 )
 172         {
 173             return 14 + (p[13]&0x07);
 174         }
 175         else if( (p[4] >> 4) == 0x02 && i_peek >= 12 )
 176         {
 177             return 12;
 178         }
 179         return -1;
 180     }
 181     else if( i_peek >= 6 )
 182     {
 183         return 6 + ((p[4]<<8) | p[5] );
 184     }
 185     return -1;
 186 }
 187
 188 /* parse a PACK PES */
 189 static inline int ps_pkt_parse_pack( block_t *p_pkt, int64_t *pi_scr,
 190                                      int *pi_mux_rate )
 191 {
 192     uint8_t *p = p_pkt->p_buffer;
 193     if( p_pkt->i_buffer >= 14 && (p[4] >> 6) == 0x01 )
 194     {
 195         *pi_scr =((((int64_t)p[4]&0x38) << 27 )|
 196                   (((int64_t)p[4]&0x03) << 28 )|
 197                    ((int64_t)p[5] << 20 )|
 198                   (((int64_t)p[6]&0xf8) << 12 )|
 199                   (((int64_t)p[6]&0x03) << 13 )|
 200                    ((int64_t)p[7] << 5 )|
 201                    ((int64_t)p[8] >> 3 )) * 100 / 9;
 202
 203         *pi_mux_rate = ( p[10] << 14 )|( p[11] << 6 )|( p[12] >> 2);
 204     }
 205     else if( p_pkt->i_buffer >= 12 && (p[4] >> 4) == 0x02 )
 206     {
 207         *pi_scr =((((int64_t)p[4]&0x0e) << 29 )|
 208                    ((int64_t)p[5] << 22 )|
 209                   (((int64_t)p[6]&0xfe) << 14 )|
 210                    ((int64_t)p[7] <<  7 )|
 211                    ((int64_t)p[8] >> 1 )) * 100 / 9;
 212
 213         *pi_mux_rate = ( ( p[9]&0x7f )<< 15 )|( p[10] << 7 )|( p[11] >> 1);
 214     }
 215     else
 216     {
 217         return VLC_EGENERIC;
 218     }
 219     return VLC_SUCCESS;
 220 }
 221
 222 /* Parse a SYSTEM PES */
 223 static inline int ps_pkt_parse_system( block_t *p_pkt, ps_psm_t *p_psm,
 224                                        ps_track_t tk[PS_TK_COUNT] )
 225 {
 226     uint8_t *p = &p_pkt->p_buffer[6 + 3 + 1 + 1 + 1];
 227
 228     /* System header is not useable if it references private streams (0xBD)
 229      * or 'all audio streams' (0xB8) or 'all video streams' (0xB9) */
 230     while( p < &p_pkt->p_buffer[p_pkt->i_buffer] )
 231     {
 232         int i_id = p[0];
 233
 234         /* fprintf( stderr, "   SYSTEM_START_CODEEE: id=0x%x\n", p[0] ); */
 235         if( p[0] >= 0xBC || p[0] == 0xB8 || p[0] == 0xB9 ) p += 2;
 236         p++;
 237
 238         if( i_id >= 0xc0 )
 239         {
 240             int i_tk = PS_ID_TO_TK( i_id );
 241
 242             if( !tk[i_tk].b_seen )
 243             {
 244                 if( !ps_track_fill( &tk[i_tk], p_psm, i_id ) )
 245                 {
 246                     tk[i_tk].b_seen = VLC_TRUE;
 247                 }
 248             }
 249         }
 250     }
 251     return VLC_SUCCESS;
 252 }
 253
 254 /* Parse a PES (and skip i_skip_extra in the payload) */
 255 static inline int ps_pkt_parse_pes( block_t *p_pes, int i_skip_extra )
 256 {
 257     uint8_t header[30];
 258     int     i_skip  = 0;
 259
 260     memcpy( header, p_pes->p_buffer, __MIN( p_pes->i_buffer, 30 ) );
 261
 262     switch( header[3] )
 263     {
 264         case 0xBC:  /* Program stream map */
 265         case 0xBE:  /* Padding */
 266         case 0xBF:  /* Private stream 2 */
 267         case 0xB0:  /* ECM */
 268         case 0xB1:  /* EMM */
 269         case 0xFF:  /* Program stream directory */
 270         case 0xF2:  /* DSMCC stream */
 271         case 0xF8:  /* ITU-T H.222.1 type E stream */
 272             i_skip = 6;
 273             break;
 274
 275         default:
 276             if( ( header[6]&0xC0 ) == 0x80 )
 277             {
 278                 /* mpeg2 PES */
 279                 i_skip = header[8] + 9;
 280
 281                 if( header[7]&0x80 )    /* has pts */
 282                 {
 283                     p_pes->i_pts = ((mtime_t)(header[ 9]&0x0e ) << 29)|
 284                                     (mtime_t)(header[10] << 22)|
 285                                    ((mtime_t)(header[11]&0xfe) << 14)|
 286                                     (mtime_t)(header[12] << 7)|
 287                                     (mtime_t)(header[13] >> 1);
 288
 289                     if( header[7]&0x40 )    /* has dts */
 290                     {
 291                          p_pes->i_dts = ((mtime_t)(header[14]&0x0e ) << 29)|
 292                                          (mtime_t)(header[15] << 22)|
 293                                         ((mtime_t)(header[16]&0xfe) << 14)|
 294                                          (mtime_t)(header[17] << 7)|
 295                                          (mtime_t)(header[18] >> 1);
 296                     }
 297                 }
 298             }
 299             else
 300             {
 301                 i_skip = 6;
 302                 while( i_skip < 23 && header[i_skip] == 0xff )
 303                 {
 304                     i_skip++;
 305                 }
 306                 if( i_skip == 23 )
 307                 {
 308                     /* msg_Err( p_demux, "too much MPEG-1 stuffing" ); */
 309                     return VLC_EGENERIC;
 310                 }
 311                 if( ( header[i_skip] & 0xC0 ) == 0x40 )
 312                 {
 313                     i_skip += 2;
 314                 }
 315
 316                 if(  header[i_skip]&0x20 )
 317                 {
 318                      p_pes->i_pts = ((mtime_t)(header[i_skip]&0x0e ) << 29)|
 319                                      (mtime_t)(header[i_skip+1] << 22)|
 320                                     ((mtime_t)(header[i_skip+2]&0xfe) << 14)|
 321                                      (mtime_t)(header[i_skip+3] << 7)|
 322                                      (mtime_t)(header[i_skip+4] >> 1);
 323
 324                     if( header[i_skip]&0x10 )    /* has dts */
 325                     {
 326                          p_pes->i_dts = ((mtime_t)(header[i_skip+5]&0x0e ) << 29)|
 327                                          (mtime_t)(header[i_skip+6] << 22)|
 328                                         ((mtime_t)(header[i_skip+7]&0xfe) << 14)|
 329                                          (mtime_t)(header[i_skip+8] << 7)|
 330                                          (mtime_t)(header[i_skip+9] >> 1);
 331                          i_skip += 10;
 332                     }
 333                     else
 334                     {
 335                         i_skip += 5;
 336                     }
 337                 }
 338                 else
 339                 {
 340                     i_skip += 1;
 341                 }
 342             }
 343     }
 344
 345     i_skip += i_skip_extra;
 346
 347     if( p_pes->i_buffer <= i_skip )
 348     {
 349         return VLC_EGENERIC;
 350     }
 351
 352     p_pes->p_buffer += i_skip;
 353     p_pes->i_buffer -= i_skip;
 354
 355     p_pes->i_dts = 100 * p_pes->i_dts / 9;
 356     p_pes->i_pts = 100 * p_pes->i_pts / 9;
 357
 358     return VLC_SUCCESS;
 359 }
 360
 361 /* Program stream map handling */
 362 typedef struct ps_es_t
 363 {
 364     int i_type;
 365     int i_id;
 366
 367     int i_descriptor;
 368     uint8_t *p_descriptor;
 369
 370     /* Language is iso639-2T */
 371     uint8_t lang[3];
 372
 373 } ps_es_t;
 374
 375 struct ps_psm_t
 376 {
 377     int i_version;
 378
 379     int     i_es;
 380     ps_es_t **es;
 381 };
 382
 383 static inline int ps_id_to_type( ps_psm_t *p_psm, int i_id )
 384 {
 385     int i;
 386     for( i = 0; p_psm && i < p_psm->i_es; i++ )
 387     {
 388         if( p_psm->es[i]->i_id == i_id ) return p_psm->es[i]->i_type;
 389     }
 390     return 0;
 391 }
 392
 393 static inline char *ps_id_to_lang( ps_psm_t *p_psm, int i_id )
 394 {
 395     int i;
 396     for( i = 0; p_psm && i < p_psm->i_es; i++ )
 397     {
 398         if( p_psm->es[i]->i_id == i_id ) return p_psm->es[i]->lang;
 399     }
 400     return 0;
 401 }
 402
 403 static inline void ps_psm_init( ps_psm_t *p_psm )
 404 {
 405     p_psm->i_version = 0xFFFF;
 406     p_psm->i_es = 0;
 407     p_psm->es = 0;
 408 }
 409
 410 static inline void ps_psm_destroy( ps_psm_t *p_psm )
 411 {
 412     while( p_psm->i_es-- )
 413     {
 414         if( p_psm->es[p_psm->i_es]->i_descriptor )
 415             free( p_psm->es[p_psm->i_es]->p_descriptor );
 416         free( p_psm->es[p_psm->i_es] );
 417     }
 418     if( p_psm->es ) free( p_psm->es );
 419
 420     p_psm->es = 0;
 421     p_psm->i_es = 0;
 422 }
 423
 424 static inline int ps_psm_fill( ps_psm_t *p_psm, block_t *p_pkt,
 425                                ps_track_t tk[PS_TK_COUNT], es_out_t *out )
 426 {
 427     int i_buffer = p_pkt->i_buffer;
 428     uint8_t *p_buffer = p_pkt->p_buffer;
 429     int i_length, i_version, i_info_length, i_esm_length, i_es_base, i;
 430
 431     if( !p_psm || p_buffer[3] != 0xbc ) return VLC_EGENERIC;
 432
 433     i_length = (uint16_t)(p_buffer[4] << 8) + p_buffer[5] + 6;
 434     if( i_length > i_buffer ) return VLC_EGENERIC;
 435
 436     //i_current_next_indicator = (p_buffer[6] && 0x01);
 437     i_version = (p_buffer[6] && 0xf8);
 438
 439     if( p_psm->i_version == i_version ) return VLC_EGENERIC;
 440
 441     ps_psm_destroy( p_psm );
 442
 443     i_info_length = (uint16_t)(p_buffer[8] << 8) + p_buffer[9];
 444     if( i_info_length + 10 > i_length ) return VLC_EGENERIC;
 445
 446     /* Elementary stream map */
 447     i_esm_length = (uint16_t)(p_buffer[ 10 + i_info_length ] << 8) +
 448         p_buffer[ 11 + i_info_length];
 449     i_es_base = 12 + i_info_length;
 450
 451     while( i_es_base + 4 < i_length )
 452     {
 453         ps_es_t es;
 454         es.lang[0] = es.lang[1] = es.lang[2] = 0;
 455
 456         es.i_type = p_buffer[ i_es_base  ];
 457         es.i_id = p_buffer[ i_es_base + 1 ];
 458         i_info_length = (uint16_t)(p_buffer[ i_es_base + 2 ] << 8) +
 459             p_buffer[ i_es_base + 3 ];
 460
 461         if( i_es_base + 4 + i_info_length > i_length ) break;
 462
 463         es.p_descriptor = 0;
 464         es.i_descriptor = i_info_length;
 465         if( i_info_length > 0 )
 466         {
 467             int i = 0;
 468
 469             es.p_descriptor = malloc( i_info_length );
 470             memcpy( es.p_descriptor, p_buffer + i_es_base + 4, i_info_length);
 471
 472             while( i <= es.i_descriptor - 2 )
 473             {
 474                 /* Look for the ISO639 language descriptor */
 475                 if( es.p_descriptor[i] != 0x0a )
 476                 {
 477                     i += es.p_descriptor[i+1] + 2;
 478                     continue;
 479                 }
 480
 481                 if( i <= es.i_descriptor - 6 )
 482                 {
 483                     es.lang[0] = es.p_descriptor[i+2];
 484                     es.lang[1] = es.p_descriptor[i+3];
 485                     es.lang[2] = es.p_descriptor[i+4];
 486                 }
 487                 break;
 488             }
 489         }
 490
 491         p_psm->es = realloc( p_psm->es, sizeof(ps_es_t *) * (p_psm->i_es+1) );
 492         p_psm->es[p_psm->i_es] = malloc( sizeof(ps_es_t) );
 493         *p_psm->es[p_psm->i_es++] = es;
 494         i_es_base += 4 + i_info_length;
 495     }
 496
 497     /* TODO: CRC */
 498
 499     p_psm->i_version = i_version;
 500
 501     /* Check/Modify our existing tracks */
 502     for( i = 0; i < PS_TK_COUNT; i++ )
 503     {
 504         ps_track_t tk_tmp;
 505
 506         if( !tk[i].b_seen || !tk[i].es ) continue;
 507
 508         if( ps_track_fill( &tk_tmp, p_psm, tk[i].i_id ) != VLC_SUCCESS )
 509             continue;
 510
 511         if( tk_tmp.fmt.i_codec == tk[i].fmt.i_codec ) continue;
 512
 513         es_out_Del( out, tk[i].es );
 514         tk[i] = tk_tmp;
 515         tk[i].b_seen = VLC_TRUE;
 516         tk[i].es = es_out_Add( out, &tk[i].fmt );
 517     }
 518
 519     return VLC_SUCCESS;
 520 }