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

   1 /*****************************************************************************
   2  * ps.h: Program Stream demuxer helper
   3  *****************************************************************************
   4  * Copyright (C) 2004 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
  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 : ((id)&0xff) + (256 - 0xc0))
  26
  27 typedef struct
  28 {
  29     vlc_bool_t  b_seen;
  30     int         i_skip;
  31     es_out_id_t *es;
  32     es_format_t fmt;
  33 } ps_track_t;
  34
  35 /* Init a set of track */
  36 static inline void ps_track_init( ps_track_t tk[PS_TK_COUNT] )
  37 {
  38     int i;
  39     for( i = 0; i < PS_TK_COUNT; i++ )
  40     {
  41         tk[i].b_seen = VLC_FALSE;
  42         tk[i].i_skip = 0;
  43         tk[i].es     = NULL;
  44         es_format_Init( &tk[i].fmt, UNKNOWN_ES, 0 );
  45     }
  46 }
  47
  48 /* From id fill i_skip and es_format_t */
  49 static inline int ps_track_fill( ps_track_t *tk, int i_id )
  50 {
  51     tk->i_skip = 0;
  52     if( ( i_id&0xff00 ) == 0xbd00 )
  53     {
  54         if( ( i_id&0xf8 ) == 0x88 )
  55         {
  56             es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('d','t','s',' ') );
  57             tk->i_skip = 4;
  58         }
  59         else if( ( i_id&0xf0 ) == 0x80 )
  60         {
  61             es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('a','5','2',' ') );
  62             tk->i_skip = 4;
  63         }
  64         else if( ( i_id&0xe0 ) == 0x20 )
  65         {
  66             es_format_Init( &tk->fmt, SPU_ES, VLC_FOURCC('s','p','u',' ') );
  67             tk->i_skip = 1;
  68         }
  69         else if( ( i_id&0xf0 ) == 0xa0 )
  70         {
  71             es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('l','p','c','m') );
  72             tk->i_skip = 1;
  73         }
  74         else if( ( i_id&0xff ) == 0x70 )
  75         {
  76             es_format_Init( &tk->fmt, SPU_ES, VLC_FOURCC('o','g','t',' ') );
  77         }
  78         else if( ( i_id&0xfc ) == 0x00 )
  79         {
  80             es_format_Init( &tk->fmt, SPU_ES, VLC_FOURCC('c','v','d',' ') );
  81         }
  82         else
  83         {
  84             es_format_Init( &tk->fmt, UNKNOWN_ES, 0 );
  85             return VLC_EGENERIC;
  86         }
  87     }
  88     else
  89     {
  90         if( ( i_id&0xf0 ) == 0xe0 )
  91         {
  92             es_format_Init( &tk->fmt, VIDEO_ES, VLC_FOURCC('m','p','g','v') );
  93         }
  94         else if( ( i_id&0xe0 ) == 0xc0 )
  95         {
  96             es_format_Init( &tk->fmt, AUDIO_ES, VLC_FOURCC('m','p','g','a') );
  97         }
  98         else
  99         {
 100             es_format_Init( &tk->fmt, UNKNOWN_ES, 0 );
 101             return VLC_EGENERIC;
 102         }
 103     }
 104
 105     /* PES packets usually contain truncated frames */
 106     tk->fmt.b_packetized = VLC_FALSE;
 107
 108     return VLC_SUCCESS;
 109 }
 110
 111 /* return the id of a PES (should be valid) */
 112 static inline int ps_pkt_id( block_t *p_pkt )
 113 {
 114     if( p_pkt->p_buffer[3] == 0xbd &&
 115         p_pkt->i_buffer >= 9 &&
 116         p_pkt->i_buffer >= 9 + p_pkt->p_buffer[8] )
 117     {
 118         return 0xbd00 | p_pkt->p_buffer[9+p_pkt->p_buffer[8]];
 119     }
 120     return p_pkt->p_buffer[3];
 121 }
 122
 123 /* return the size of the next packet
 124  * XXX you need to give him at least 14 bytes (and it need to start as a
 125  * valid packet) */
 126 static inline int ps_pkt_size( uint8_t *p, int i_peek )
 127 {
 128     if( p[3] == 0xb9 && i_peek >= 4 )
 129     {
 130         return 4;
 131     }
 132     else if( p[3] == 0xba )
 133     {
 134         if( (p[4] >> 6) == 0x01 && i_peek >= 14 )
 135         {
 136             return 14 + (p[13]&0x07);
 137         }
 138         else if( (p[4] >> 4) == 0x02 && i_peek >= 12 )
 139         {
 140             return 12;
 141         }
 142         return -1;
 143     }
 144     else if( i_peek >= 6 )
 145     {
 146         return 6 + ((p[4]<<8) | p[5] );
 147     }
 148     return -1;
 149 }
 150
 151 /* parse a PACK PES */
 152 static inline int ps_pkt_parse_pack( block_t *p_pkt, int64_t *pi_scr,
 153                                      int *pi_mux_rate )
 154 {
 155     uint8_t *p = p_pkt->p_buffer;
 156     if( p_pkt->i_buffer >= 14 && (p[4] >> 6) == 0x01 )
 157     {
 158         *pi_scr =((((int64_t)p[4]&0x38) << 27 )|
 159                   (((int64_t)p[4]&0x03) << 28 )|
 160                    ((int64_t)p[5] << 20 )|
 161                   (((int64_t)p[6]&0xf8) << 12 )|
 162                   (((int64_t)p[6]&0x03) << 13 )|
 163                    ((int64_t)p[7] << 5 )|
 164                    ((int64_t)p[8] >> 3 )) * 100 / 9;
 165
 166         *pi_mux_rate = ( p[10] << 14 )|( p[11] << 6 )|( p[12] >> 2);
 167     }
 168     else if( p_pkt->i_buffer >= 12 && (p[4] >> 4) == 0x02 )
 169     {
 170         *pi_scr =((((int64_t)p[4]&0x0e) << 29 )|
 171                    ((int64_t)p[5] << 22 )|
 172                   (((int64_t)p[6]&0xfe) << 14 )|
 173                    ((int64_t)p[7] <<  7 )|
 174                    ((int64_t)p[8] >> 1 )) * 100 / 9;
 175
 176         *pi_mux_rate = ( ( p[9]&0x7f )<< 15 )|( p[10] << 7 )|( p[11] >> 1);
 177     }
 178     else
 179     {
 180         return VLC_EGENERIC;
 181     }
 182     return VLC_SUCCESS;
 183 }
 184
 185 /* Parse a SYSTEM PES */
 186 static inline int ps_pkt_parse_system( block_t *p_pkt,
 187                                        ps_track_t tk[PS_TK_COUNT] )
 188 {
 189     uint8_t *p = &p_pkt->p_buffer[6 + 3 + 1 + 1 + 1];
 190
 191     /* System header is not useable if it references private streams (0xBD)
 192      * or 'all audio streams' (0xB8) or 'all video streams' (0xB9) */
 193     while( p < &p_pkt->p_buffer[p_pkt->i_buffer] )
 194     {
 195         int i_id = p[0];
 196
 197         /* fprintf( stderr, "   SYSTEM_START_CODEEE: id=0x%x\n", p[0] ); */
 198         if( p[0] >= 0xBC || p[0] == 0xB8 || p[0] == 0xB9 ) p += 2;
 199         p++;
 200
 201         if( i_id >= 0xc0 )
 202         {
 203             int i_tk = PS_ID_TO_TK( i_id );
 204
 205             if( !tk[i_tk].b_seen )
 206             {
 207                 if( !ps_track_fill( &tk[i_tk], i_id ) )
 208                 {
 209                     tk[i_tk].b_seen = VLC_TRUE;
 210                 }
 211             }
 212         }
 213     }
 214     return VLC_SUCCESS;
 215 }
 216
 217 /* Parse a PES (and skip i_skip_extra in the payload) */
 218 static inline int ps_pkt_parse_pes( block_t *p_pes, int i_skip_extra )
 219 {
 220     uint8_t header[30];
 221     int     i_skip  = 0;
 222
 223     memcpy( header, p_pes->p_buffer, __MIN( p_pes->i_buffer, 30 ) );
 224
 225     switch( header[3] )
 226     {
 227         case 0xBC:  /* Program stream map */
 228         case 0xBE:  /* Padding */
 229         case 0xBF:  /* Private stream 2 */
 230         case 0xB0:  /* ECM */
 231         case 0xB1:  /* EMM */
 232         case 0xFF:  /* Program stream directory */
 233         case 0xF2:  /* DSMCC stream */
 234         case 0xF8:  /* ITU-T H.222.1 type E stream */
 235             i_skip = 6;
 236             break;
 237
 238         default:
 239             if( ( header[6]&0xC0 ) == 0x80 )
 240             {
 241                 /* mpeg2 PES */
 242                 i_skip = header[8] + 9;
 243
 244                 if( header[7]&0x80 )    /* has pts */
 245                 {
 246                     p_pes->i_pts = ((mtime_t)(header[ 9]&0x0e ) << 29)|
 247                                     (mtime_t)(header[10] << 22)|
 248                                    ((mtime_t)(header[11]&0xfe) << 14)|
 249                                     (mtime_t)(header[12] << 7)|
 250                                     (mtime_t)(header[13] >> 1);
 251
 252                     if( header[7]&0x40 )    /* has dts */
 253                     {
 254                          p_pes->i_dts = ((mtime_t)(header[14]&0x0e ) << 29)|
 255                                          (mtime_t)(header[15] << 22)|
 256                                         ((mtime_t)(header[16]&0xfe) << 14)|
 257                                          (mtime_t)(header[17] << 7)|
 258                                          (mtime_t)(header[18] >> 1);
 259                     }
 260                 }
 261             }
 262             else
 263             {
 264                 i_skip = 6;
 265                 while( i_skip < 23 && header[i_skip] == 0xff )
 266                 {
 267                     i_skip++;
 268                 }
 269                 if( i_skip == 23 )
 270                 {
 271                     /* msg_Err( p_demux, "too much MPEG-1 stuffing" ); */
 272                     return VLC_EGENERIC;
 273                 }
 274                 if( ( header[i_skip] & 0xC0 ) == 0x40 )
 275                 {
 276                     i_skip += 2;
 277                 }
 278
 279                 if(  header[i_skip]&0x20 )
 280                 {
 281                      p_pes->i_pts = ((mtime_t)(header[i_skip]&0x0e ) << 29)|
 282                                      (mtime_t)(header[i_skip+1] << 22)|
 283                                     ((mtime_t)(header[i_skip+2]&0xfe) << 14)|
 284                                      (mtime_t)(header[i_skip+3] << 7)|
 285                                      (mtime_t)(header[i_skip+4] >> 1);
 286
 287                     if( header[i_skip]&0x10 )    /* has dts */
 288                     {
 289                          p_pes->i_dts = ((mtime_t)(header[i_skip+5]&0x0e ) << 29)|
 290                                          (mtime_t)(header[i_skip+6] << 22)|
 291                                         ((mtime_t)(header[i_skip+7]&0xfe) << 14)|
 292                                          (mtime_t)(header[i_skip+8] << 7)|
 293                                          (mtime_t)(header[i_skip+9] >> 1);
 294                          i_skip += 10;
 295                     }
 296                     else
 297                     {
 298                         i_skip += 5;
 299                     }
 300                 }
 301                 else
 302                 {
 303                     i_skip += 1;
 304                 }
 305             }
 306     }
 307
 308     i_skip += i_skip_extra;
 309
 310     if( p_pes->i_buffer <= i_skip )
 311     {
 312         return VLC_EGENERIC;
 313     }
 314
 315     p_pes->p_buffer += i_skip;
 316     p_pes->i_buffer -= i_skip;
 317
 318     p_pes->i_dts = 100 * p_pes->i_dts / 9;
 319     p_pes->i_pts = 100 * p_pes->i_pts / 9;
 320
 321     return VLC_SUCCESS;
 322 }