git.sesse.net Git - vlc/blob - plugins/mpeg/input_ps.c

   1 /*****************************************************************************
   2  * input_ps.c: PS demux and packet management
   3  *****************************************************************************
   4  * Copyright (C) 1998, 1999, 2000 VideoLAN
   5  * $Id: input_ps.c,v 1.13 2001/04/05 16:37:15 asmax Exp $
   6  *
   7  * Authors: Christophe Massiot <massiot@via.ecp.fr>
   8  *          Cyril Deguet <asmax@via.ecp.fr>
   9  *
  10  * This program is free software; you can redistribute it and/or modify
  11  * it under the terms of the GNU General Public License as published by
  12  * the Free Software Foundation; either version 2 of the License, or
  13  * (at your option) any later version.
  14  *
  15  * This program is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  *
  20  * You should have received a copy of the GNU General Public License
  21  * along with this program; if not, write to the Free Software
  22  * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111, USA.
  23  *****************************************************************************/
  24
  25 #define MODULE_NAME ps
  26 #include "modules_inner.h"
  27
  28 /*****************************************************************************
  29  * Preamble
  30  *****************************************************************************/
  31 #include "defs.h"
  32
  33 #include <stdlib.h>
  34 #include <string.h>
  35 #include <errno.h>
  36
  37 #include <sys/types.h>
  38 #include <sys/stat.h>
  39 #include <unistd.h>
  40 #include <fcntl.h>
  41
  42 #include "config.h"
  43 #include "common.h"
  44 #include "threads.h"
  45 #include "mtime.h"
  46 #include "tests.h"
  47
  48 #include "intf_msg.h"
  49
  50 #include "main.h"
  51
  52 #include "stream_control.h"
  53 #include "input_ext-intf.h"
  54 #include "input_ext-dec.h"
  55
  56 #include "input.h"
  57
  58 #include "input_ps.h"
  59 #include "mpeg_system.h"
  60
  61 #include "debug.h"
  62
  63 #include "modules.h"
  64
  65 /*****************************************************************************
  66  * Local prototypes
  67  *****************************************************************************/
  68 static int  PSProbe     ( probedata_t * );
  69 static int  PSRead      ( struct input_thread_s *,
  70                           data_packet_t * p_packets[INPUT_READ_ONCE] );
  71 static void PSInit      ( struct input_thread_s * );
  72 static void PSEnd       ( struct input_thread_s * );
  73 static void PSSeek      ( struct input_thread_s *, off_t );
  74 static struct pes_packet_s *  NewPES    ( void * );
  75 static struct data_packet_s * NewPacket ( void *, size_t );
  76 static void DeletePacket( void *, struct data_packet_s * );
  77 static void DeletePES   ( void *, struct pes_packet_s * );
  78
  79 /*****************************************************************************
  80  * Functions exported as capabilities. They are declared as static so that
  81  * we don't pollute the namespace too much.
  82  *****************************************************************************/
  83 void _M( input_getfunctions )( function_list_t * p_function_list )
  84 {
  85 #define input p_function_list->functions.input
  86     p_function_list->pf_probe = PSProbe;
  87     input.pf_init             = PSInit;
  88     input.pf_open             = input_FileOpen;
  89     input.pf_close            = input_FileClose;
  90     input.pf_end              = PSEnd;
  91     input.pf_set_area         = NULL;
  92     input.pf_read             = PSRead;
  93     input.pf_demux            = input_DemuxPS;
  94     input.pf_new_packet       = NewPacket;
  95     input.pf_new_pes          = NewPES;
  96     input.pf_delete_packet    = DeletePacket;
  97     input.pf_delete_pes       = DeletePES;
  98     input.pf_rewind           = NULL;
  99     input.pf_seek             = PSSeek;
 100 #undef input
 101 }
 102
 103 /*
 104  * Data reading functions
 105  */
 106
 107 /*****************************************************************************
 108  * PSProbe: verifies that the stream is a PS stream
 109  *****************************************************************************/
 110 static int PSProbe( probedata_t *p_data )
 111 {
 112     input_thread_t * p_input = (input_thread_t *)p_data;
 113
 114     char * psz_name = p_input->p_source;
 115     int i_handle;
 116     int i_score = 10;
 117
 118     if( TestMethod( INPUT_METHOD_VAR, "ps" ) )
 119     {
 120         return( 999 );
 121     }
 122
 123     if( ( strlen(psz_name) > 5 ) && !strncasecmp( psz_name, "file:", 5 ) )
 124     {
 125         /* If the user specified "file:" then it's probably a file */
 126         i_score = 100;
 127         psz_name += 5;
 128     }
 129
 130     i_handle = open( psz_name, 0 );
 131     if( i_handle == -1 )
 132     {
 133         return( 0 );
 134     }
 135     close( i_handle );
 136
 137     return( i_score );
 138 }
 139
 140 /*****************************************************************************
 141  * PSInit: initializes PS structures
 142  *****************************************************************************/
 143 static void PSInit( input_thread_t * p_input )
 144 {
 145     thread_ps_data_t *  p_method;
 146
 147     if( (p_method =
 148          (thread_ps_data_t *)malloc( sizeof(thread_ps_data_t) )) == NULL )
 149     {
 150         intf_ErrMsg( "Out of memory" );
 151         p_input->b_error = 1;
 152         return;
 153     }
 154
 155     p_input->p_plugin_data = (void *)p_method;
 156     p_input->p_method_data = NULL;
 157
 158     /* Re-open the socket as a buffered FILE stream */
 159     if( (p_method->stream = fdopen( p_input->i_handle, "r" )) == NULL )
 160     {
 161         intf_ErrMsg( "Cannot open file (%s)", strerror(errno) );
 162         p_input->b_error = 1;
 163         return;
 164     }
 165     rewind( p_method->stream );
 166
 167     /* FIXME : detect if InitStream failed */
 168     input_InitStream( p_input, sizeof( stream_ps_data_t ) );
 169     input_AddProgram( p_input, 0, sizeof( stream_ps_data_t ) );
 170
 171     if( p_input->stream.b_seekable )
 172     {
 173         stream_ps_data_t * p_demux_data =
 174              (stream_ps_data_t *)p_input->stream.pp_programs[0]->p_demux_data;
 175
 176         /* Pre-parse the stream to gather stream_descriptor_t. */
 177         p_input->stream.pp_programs[0]->b_is_ok = 0;
 178         p_demux_data->i_PSM_version = EMPTY_PSM_VERSION;
 179
 180         while( !p_input->b_die && !p_input->b_error
 181                 && !p_demux_data->b_has_PSM )
 182         {
 183             int                 i_result, i;
 184             data_packet_t *     pp_packets[INPUT_READ_ONCE];
 185
 186             i_result = PSRead( p_input, pp_packets );
 187             if( i_result == 1 )
 188             {
 189                 /* EOF */
 190                 vlc_mutex_lock( &p_input->stream.stream_lock );
 191                 p_input->stream.pp_programs[0]->b_is_ok = 1;
 192                 vlc_mutex_unlock( &p_input->stream.stream_lock );
 193                 break;
 194             }
 195             if( i_result == -1 )
 196             {
 197                 p_input->b_error = 1;
 198                 break;
 199             }
 200
 201             for( i = 0; i < INPUT_READ_ONCE && pp_packets[i] != NULL; i++ )
 202             {
 203                 /* FIXME: use i_p_config_t */
 204                 input_ParsePS( p_input, pp_packets[i] );
 205                 DeletePacket( p_input->p_method_data, pp_packets[i] );
 206             }
 207
 208             /* File too big. */
 209             if( p_input->stream.p_selected_area->i_tell >
 210                                                     INPUT_PREPARSE_LENGTH )
 211             {
 212                 break;
 213             }
 214         }
 215         rewind( p_method->stream );
 216         vlc_mutex_lock( &p_input->stream.stream_lock );
 217         p_input->stream.p_selected_area->i_tell = 0;
 218         if( p_demux_data->b_has_PSM )
 219         {
 220             /* (The PSM decoder will care about spawning the decoders) */
 221             p_input->stream.pp_programs[0]->b_is_ok = 1;
 222         }
 223 #ifdef AUTO_SPAWN
 224         else
 225         {
 226             /* (We have to do it ourselves) */
 227             int                 i_es;
 228
 229             /* FIXME: we should do multiple passes in case an audio type
 230              * is not present */
 231             for( i_es = 0;
 232                  i_es < p_input->stream.pp_programs[0]->i_es_number;
 233                  i_es++ )
 234             {
 235 #define p_es p_input->stream.pp_programs[0]->pp_es[i_es]
 236                 switch( p_es->i_type )
 237                 {
 238                     case MPEG1_VIDEO_ES:
 239                     case MPEG2_VIDEO_ES:
 240                         input_SelectES( p_input, p_es );
 241                         break;
 242
 243                     case MPEG1_AUDIO_ES:
 244                     case MPEG2_AUDIO_ES:
 245                         if( main_GetIntVariable( INPUT_CHANNEL_VAR, 0 )
 246                                 == (p_es->i_id & 0x1F) )
 247                         switch( main_GetIntVariable( INPUT_AUDIO_VAR, 0 ) )
 248                         {
 249                         case 0:
 250                             main_PutIntVariable( INPUT_AUDIO_VAR,
 251                                                  REQUESTED_MPEG );
 252                         case REQUESTED_MPEG:
 253                             input_SelectES( p_input, p_es );
 254                         }
 255                         break;
 256
 257                     case AC3_AUDIO_ES:
 258                         if( main_GetIntVariable( INPUT_CHANNEL_VAR, 0 )
 259                                 == ((p_es->i_id & 0xF00) >> 8) )
 260                         switch( main_GetIntVariable( INPUT_AUDIO_VAR, 0 ) )
 261                         {
 262                         case 0:
 263                             main_PutIntVariable( INPUT_AUDIO_VAR,
 264                                                  REQUESTED_AC3 );
 265                         case REQUESTED_AC3:
 266                             input_SelectES( p_input, p_es );
 267                         }
 268                         break;
 269
 270                     case DVD_SPU_ES:
 271                         if( main_GetIntVariable( INPUT_SUBTITLE_VAR, -1 )
 272                                 == ((p_es->i_id & 0x1F00) >> 8) )
 273                         {
 274                             input_SelectES( p_input, p_es );
 275                         }
 276                         break;
 277
 278                     case LPCM_AUDIO_ES:
 279                         /* FIXME ! */
 280                         break;
 281                 }
 282             }
 283
 284         }
 285 #endif
 286 #ifdef STATS
 287         input_DumpStream( p_input );
 288 #endif
 289         vlc_mutex_unlock( &p_input->stream.stream_lock );
 290     }
 291     else
 292     {
 293         /* The programs will be added when we read them. */
 294         vlc_mutex_lock( &p_input->stream.stream_lock );
 295         p_input->stream.pp_programs[0]->b_is_ok = 0;
 296         vlc_mutex_unlock( &p_input->stream.stream_lock );
 297     }
 298 }
 299
 300 /*****************************************************************************
 301  * PSEnd: frees unused data
 302  *****************************************************************************/
 303 static void PSEnd( input_thread_t * p_input )
 304 {
 305     free( p_input->p_plugin_data );
 306 }
 307
 308 /*****************************************************************************
 309  * SafeRead: reads a chunk of stream and correctly detects errors
 310  *****************************************************************************/
 311 static __inline__ int SafeRead( input_thread_t * p_input, byte_t * p_buffer,
 312                                 size_t i_len )
 313 {
 314     thread_ps_data_t *  p_method;
 315     int                 i_error;
 316
 317     p_method = (thread_ps_data_t *)p_input->p_plugin_data;
 318     while( fread( p_buffer, i_len, 1, p_method->stream ) != 1 )
 319     {
 320         if( feof( p_method->stream ) )
 321         {
 322             return( 1 );
 323         }
 324
 325         if( (i_error = ferror( p_method->stream )) )
 326         {
 327             intf_ErrMsg( "Read failed (%s)", strerror(i_error) );
 328             return( -1 );
 329         }
 330     }
 331     vlc_mutex_lock( &p_input->stream.stream_lock );
 332     p_input->stream.p_selected_area->i_tell += i_len;
 333     vlc_mutex_unlock( &p_input->stream.stream_lock );
 334     return( 0 );
 335 }
 336
 337 /*****************************************************************************
 338  * PSRead: reads data packets
 339  *****************************************************************************
 340  * Returns -1 in case of error, 0 if everything went well, and 1 in case of
 341  * EOF.
 342  *****************************************************************************/
 343 static int PSRead( input_thread_t * p_input,
 344                    data_packet_t * pp_packets[INPUT_READ_ONCE] )
 345 {
 346     byte_t              p_header[6];
 347     data_packet_t *     p_data;
 348     size_t              i_packet_size;
 349     int                 i_packet, i_error;
 350     thread_ps_data_t *  p_method;
 351
 352     p_method = (thread_ps_data_t *)p_input->p_plugin_data;
 353
 354     memset( pp_packets, 0, INPUT_READ_ONCE * sizeof(data_packet_t *) );
 355     for( i_packet = 0; i_packet < INPUT_READ_ONCE; i_packet++ )
 356     {
 357         /* Read what we believe to be a packet header. */
 358         if( (i_error = SafeRead( p_input, p_header, 6 )) )
 359         {
 360             return( i_error );
 361         }
 362
 363         if( (U32_AT(p_header) & 0xFFFFFF00) != 0x100L )
 364         {
 365             /* This is not the startcode of a packet. Read the stream
 366              * until we find one. */
 367             u32         i_startcode = U32_AT(p_header);
 368             int         i_dummy;
 369
 370             if( i_startcode )
 371             {
 372                 /* It is common for MPEG-1 streams to pad with zeros
 373                  * (although it is forbidden by the recommendation), so
 374                  * don't bother everybody in this case. */
 375                 intf_WarnMsg( 1, "Garbage at input (%.8x)", i_startcode );
 376             }
 377
 378             while( (i_startcode & 0xFFFFFF00) != 0x100L )
 379             {
 380                 i_startcode <<= 8;
 381                 if( (i_dummy = getc( p_method->stream )) != EOF )
 382                 {
 383                     i_startcode |= i_dummy;
 384                 }
 385                 else
 386                 {
 387                     return( 1 );
 388                 }
 389             }
 390             /* Packet found. */
 391             *(u32 *)p_header = U32_AT(&i_startcode);
 392             if( (i_error = SafeRead( p_input, p_header + 4, 2 )) )
 393             {
 394                 return( i_error );
 395             }
 396         }
 397
 398         if( U32_AT(p_header) != 0x1BA )
 399         {
 400             /* That's the case for all packets, except pack header. */
 401             i_packet_size = U16_AT(&p_header[4]);
 402         }
 403         else
 404         {
 405             /* Pack header. */
 406             if( (p_header[4] & 0xC0) == 0x40 )
 407             {
 408                 /* MPEG-2 */
 409                 i_packet_size = 8;
 410             }
 411             else if( (p_header[4] & 0xF0) == 0x20 )
 412             {
 413                 /* MPEG-1 */
 414                 i_packet_size = 6;
 415             }
 416             else
 417             {
 418                 intf_ErrMsg( "Unable to determine stream type" );
 419                 return( -1 );
 420             }
 421         }
 422
 423         /* Fetch a packet of the appropriate size. */
 424         if( (p_data = NewPacket( p_input, i_packet_size + 6 )) == NULL )
 425         {
 426             intf_ErrMsg( "Out of memory" );
 427             return( -1 );
 428         }
 429
 430         /* Copy the header we already read. */
 431         memcpy( p_data->p_buffer, p_header, 6 );
 432
 433         /* Read the remaining of the packet. */
 434         if( i_packet_size && (i_error =
 435                 SafeRead( p_input, p_data->p_buffer + 6, i_packet_size )) )
 436         {
 437             return( i_error );
 438         }
 439
 440         /* In MPEG-2 pack headers we still have to read stuffing bytes. */
 441         if( U32_AT(p_header) == 0x1BA )
 442         {
 443             if( i_packet_size == 8 && (p_data->p_buffer[13] & 0x7) != 0 )
 444             {
 445                 /* MPEG-2 stuffing bytes */
 446                 byte_t      p_garbage[8];
 447                 if( (i_error = SafeRead( p_input, p_garbage,
 448                                          p_data->p_buffer[13] & 0x7)) )
 449                 {
 450                     return( i_error );
 451                 }
 452             }
 453         }
 454
 455         /* Give the packet to the other input stages. */
 456         pp_packets[i_packet] = p_data;
 457     }
 458
 459     return( 0 );
 460 }
 461
 462 /*****************************************************************************
 463  * PSSeek: changes the stream position indicator
 464  *****************************************************************************/
 465 static void PSSeek( input_thread_t * p_input, off_t i_position )
 466 {
 467     thread_ps_data_t *  p_method;
 468
 469     p_method = (thread_ps_data_t *)p_input->p_plugin_data;
 470
 471     /* A little bourrin but should work for a while --Meuuh */
 472     fseeko( p_method->stream, i_position, SEEK_SET );
 473
 474     p_input->stream.p_selected_area->i_tell = i_position;
 475 }
 476
 477 /*
 478  * Packet management utilities
 479  */
 480
 481
 482 /*****************************************************************************
 483  * NewPacket: allocates a data packet
 484  *****************************************************************************/
 485 static struct data_packet_s * NewPacket( void * p_garbage,
 486                                          size_t i_size )
 487 {
 488     data_packet_t * p_data;
 489
 490     /* Safety check */
 491     if( i_size > INPUT_MAX_PACKET_SIZE )
 492     {
 493         intf_ErrMsg( "Packet too big (%d)", i_size );
 494         return NULL;
 495     }
 496
 497     if( (p_data = (data_packet_t *)malloc( sizeof(data_packet_t) )) == NULL )
 498     {
 499         intf_DbgMsg( "Out of memory" );
 500         return NULL;
 501     }
 502
 503     if( (p_data->p_buffer = (byte_t *)malloc( i_size )) == NULL )
 504     {
 505         intf_DbgMsg( "Out of memory" );
 506         free( p_data );
 507         return NULL;
 508     }
 509
 510     /* Initialize data */
 511     p_data->p_next = NULL;
 512     p_data->b_discard_payload = 0;
 513
 514     p_data->p_payload_start = p_data->p_buffer;
 515     p_data->p_payload_end = p_data->p_buffer + i_size;
 516
 517     return( p_data );
 518 }
 519
 520 /*****************************************************************************
 521  * NewPES: allocates a pes packet
 522  *****************************************************************************/
 523 static pes_packet_t * NewPES( void * p_garbage )
 524 {
 525     pes_packet_t * p_pes;
 526
 527     if( (p_pes = (pes_packet_t *)malloc( sizeof(pes_packet_t) )) == NULL )
 528     {
 529         intf_DbgMsg( "Out of memory" );
 530         return NULL;
 531     }
 532
 533     p_pes->b_data_alignment = p_pes->b_discontinuity =
 534         p_pes->i_pts = p_pes->i_dts = 0;
 535     p_pes->i_pes_size = 0;
 536     p_pes->p_first = NULL;
 537
 538     return( p_pes );
 539 }
 540
 541 /*****************************************************************************
 542  * DeletePacket: deletes a data packet
 543  *****************************************************************************/
 544 static void DeletePacket( void * p_garbage,
 545                           data_packet_t * p_data )
 546 {
 547     ASSERT(p_data);
 548     ASSERT(p_data->p_buffer);
 549     free( p_data->p_buffer );
 550     free( p_data );
 551 }
 552
 553 /*****************************************************************************
 554  * DeletePES: deletes a PES packet and associated data packets
 555  *****************************************************************************/
 556 static void DeletePES( void * p_garbage, pes_packet_t * p_pes )
 557 {
 558     data_packet_t *     p_data;
 559     data_packet_t *     p_next;
 560
 561     p_data = p_pes->p_first;
 562
 563     while( p_data != NULL )
 564     {
 565         p_next = p_data->p_next;
 566         free( p_data->p_buffer );
 567         free( p_data );
 568         p_data = p_next;
 569     }
 570
 571     free( p_pes );
 572 }
 573