git.sesse.net Git - vlc/blob - modules/access/udp.c

   1 /*****************************************************************************
   2  * udp.c: raw UDP & RTP input module
   3  *****************************************************************************
   4  * Copyright (C) 2001-2005 the VideoLAN team
   5  * $Id$
   6  *
   7  * Authors: Christophe Massiot <massiot@via.ecp.fr>
   8  *          Tristan Leteurtre <tooney@via.ecp.fr>
   9  *          Laurent Aimar <fenrir@via.ecp.fr>
  10  *          Jean-Paul Saman <jpsaman #_at_# m2x dot nl>
  11  *
  12  * Reviewed: 23 October 2003, Jean-Paul Saman <jpsaman@wxs.nl>
  13  *
  14  * This program is free software; you can redistribute it and/or modify
  15  * it under the terms of the GNU General Public License as published by
  16  * the Free Software Foundation; either version 2 of the License, or
  17  * (at your option) any later version.
  18  *
  19  * This program is distributed in the hope that it will be useful,
  20  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  21  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  22  * GNU General Public License for more details.
  23  *
  24  * You should have received a copy of the GNU General Public License
  25  * along with this program; if not, write to the Free Software
  26  * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111, USA.
  27  *****************************************************************************/
  28
  29 /*****************************************************************************
  30  * Preamble
  31  *****************************************************************************/
  32 #include <stdlib.h>
  33
  34 #include <vlc/vlc.h>
  35 #include <vlc/input.h>
  36
  37 #include "network.h"
  38
  39 /*****************************************************************************
  40  * Module descriptor
  41  *****************************************************************************/
  42 #define CACHING_TEXT N_("Caching value in ms")
  43 #define CACHING_LONGTEXT N_( \
  44     "Allows you to modify the default caching value for UDP streams. This " \
  45     "value should be set in millisecond units." )
  46
  47 #define AUTO_MTU_TEXT N_("Autodetection of MTU")
  48 #define AUTO_MTU_LONGTEXT N_( \
  49     "Allows growing the MTU if truncated packets are found" )
  50
  51 #define RTP_LATE_TEXT N_("Reorder timeout in ms for late RTP packets")
  52 #define RTP_LATE_LONGTEXT N_( \
  53     "Allows you to modify the RTP packets reorder and late behaviour. " \
  54     "If enabled (value>0) then out-of-order packets will be held for the " \
  55     "specified timeout in ms. " \
  56     "The default behaviour is not to reorder." )
  57
  58 static int  Open ( vlc_object_t * );
  59 static void Close( vlc_object_t * );
  60
  61 vlc_module_begin();
  62     set_shortname( _("UDP/RTP" ) );
  63     set_description( _("UDP/RTP input") );
  64     set_category( CAT_INPUT );
  65     set_subcategory( SUBCAT_INPUT_ACCESS );
  66
  67     add_integer( "udp-caching", DEFAULT_PTS_DELAY / 1000, NULL, CACHING_TEXT,
  68                  CACHING_LONGTEXT, VLC_TRUE );
  69     add_bool( "udp-auto-mtu", 1, NULL,
  70               AUTO_MTU_TEXT, AUTO_MTU_LONGTEXT, VLC_TRUE );
  71
  72     add_integer( "rtp-late", 0, NULL, RTP_LATE_TEXT, RTP_LATE_LONGTEXT, VLC_TRUE );
  73
  74     set_capability( "access2", 0 );
  75     add_shortcut( "udp" );
  76     add_shortcut( "udpstream" );
  77     add_shortcut( "udp4" );
  78     add_shortcut( "udp6" );
  79     add_shortcut( "rtp" );
  80     add_shortcut( "rtp4" );
  81     add_shortcut( "rtp6" );
  82     set_callbacks( Open, Close );
  83 vlc_module_end();
  84
  85 /*****************************************************************************
  86  * Local prototypes
  87  *****************************************************************************/
  88 #define RTP_HEADER_LEN 12
  89 #define RTP_SEQ_NUM_SIZE 65536
  90
  91 static block_t *BlockUDP( access_t * );
  92 static block_t *BlockRTP( access_t * );
  93 static block_t *BlockChoose( access_t * );
  94 static int Control( access_t *, int, va_list );
  95
  96 struct access_sys_t
  97 {
  98     int fd;
  99
 100     int i_mtu;
 101     vlc_bool_t b_auto_mtu;
 102
 103     /* rtp only */
 104     uint16_t i_sequence_number;
 105     vlc_bool_t b_first_seqno;
 106
 107     /* reorder rtp packets when out-of-bounds
 108      * the packets hold queue is one level deep
 109      */
 110     uint32_t i_rtp_late; /* number of ms an RTP packet may be too late*/
 111     uint32_t i_last_pcr; /* last known good PCR */
 112     block_t *p_list;     /* list of packets to rearrange */
 113     block_t *p_end; /* last packet in p_list */
 114     block_t *p_next;     /* p_next ?? */
 115 };
 116
 117 /*****************************************************************************
 118  * Open: open the socket
 119  *****************************************************************************/
 120 static int Open( vlc_object_t *p_this )
 121 {
 122     access_t     *p_access = (access_t*)p_this;
 123     access_sys_t *p_sys;
 124
 125     char *psz_name = strdup( p_access->psz_path );
 126     char *psz_parser, *psz_server_addr, *psz_bind_addr = "";
 127     int  i_bind_port, i_server_port = 0;
 128
 129     /* First set ipv4/ipv6 */
 130     var_Create( p_access, "ipv4", VLC_VAR_BOOL | VLC_VAR_DOINHERIT );
 131     var_Create( p_access, "ipv6", VLC_VAR_BOOL | VLC_VAR_DOINHERIT );
 132
 133     if( *p_access->psz_access )
 134     {
 135         vlc_value_t val;
 136         /* Find out which shortcut was used */
 137         if( !strncmp( p_access->psz_access, "udp4", 6 ) ||
 138             !strncmp( p_access->psz_access, "rtp4", 6 ))
 139         {
 140             val.b_bool = VLC_TRUE;
 141             var_Set( p_access, "ipv4", val );
 142
 143             val.b_bool = VLC_FALSE;
 144             var_Set( p_access, "ipv6", val );
 145         }
 146         else if( !strncmp( p_access->psz_access, "udp6", 6 ) ||
 147                  !strncmp( p_access->psz_access, "rtp6", 6 ) )
 148         {
 149             val.b_bool = VLC_TRUE;
 150             var_Set( p_access, "ipv6", val );
 151
 152             val.b_bool = VLC_FALSE;
 153             var_Set( p_access, "ipv4", val );
 154         }
 155     }
 156
 157     i_bind_port = var_CreateGetInteger( p_access, "server-port" );
 158
 159     /* Parse psz_name syntax :
 160      * [serveraddr[:serverport]][@[bindaddr]:[bindport]] */
 161     psz_parser = strchr( psz_name, '@' );
 162     if( psz_parser != NULL )
 163     {
 164         /* Found bind address and/or bind port */
 165         *psz_parser++ = '\0';
 166         psz_bind_addr = psz_parser;
 167
 168         if( *psz_parser == '[' )
 169             /* skips bracket'd IPv6 address */
 170             psz_parser = strchr( psz_parser, ']' );
 171
 172         if( psz_parser != NULL )
 173         {
 174             psz_parser = strchr( psz_parser, ':' );
 175             if( psz_parser != NULL )
 176             {
 177                 *psz_parser++ = '\0';
 178                 i_bind_port = atoi( psz_parser );
 179             }
 180         }
 181     }
 182
 183     psz_server_addr = psz_name;
 184     if( *psz_server_addr == '[' )
 185         /* skips bracket'd IPv6 address */
 186         psz_parser = strchr( psz_name, ']' );
 187
 188     if( psz_parser != NULL )
 189     {
 190         psz_parser = strchr( psz_parser, ':' );
 191         if( psz_parser != NULL )
 192         {
 193             *psz_parser++ = '\0';
 194             i_server_port = atoi( psz_parser );
 195         }
 196     }
 197
 198     msg_Dbg( p_access, "opening server=%s:%d local=%s:%d",
 199              psz_server_addr, i_server_port, psz_bind_addr, i_bind_port );
 200
 201     /* Set up p_access */
 202     p_access->pf_read = NULL;
 203     if( !strcasecmp( p_access->psz_access, "rtp" )
 204           || !strcasecmp( p_access->psz_access, "rtp4" )
 205           || !strcasecmp( p_access->psz_access, "rtp6" ) )
 206     {
 207         p_access->pf_block = BlockRTP;
 208     }
 209     else
 210     {
 211         p_access->pf_block = BlockChoose;
 212     }
 213     p_access->pf_control = Control;
 214     p_access->pf_seek = NULL;
 215     p_access->info.i_update = 0;
 216     p_access->info.i_size = 0;
 217     p_access->info.i_pos = 0;
 218     p_access->info.b_eof = VLC_FALSE;
 219     p_access->info.i_title = 0;
 220     p_access->info.i_seekpoint = 0;
 221
 222     p_access->p_sys = p_sys = malloc( sizeof( access_sys_t ) );
 223     p_sys->fd = net_OpenUDP( p_access, psz_bind_addr, i_bind_port,
 224                                       psz_server_addr, i_server_port );
 225     if( p_sys->fd < 0 )
 226     {
 227         msg_Err( p_access, "cannot open socket" );
 228         free( psz_name );
 229         free( p_sys );
 230         return VLC_EGENERIC;
 231     }
 232     free( psz_name );
 233
 234     net_StopSend( p_sys->fd );
 235
 236     /* FIXME */
 237     p_sys->i_mtu = var_CreateGetInteger( p_access, "mtu" );
 238     if( p_sys->i_mtu <= 1 )
 239         p_sys->i_mtu  = 1500;   /* Avoid problem */
 240
 241     p_sys->b_auto_mtu = var_CreateGetBool( p_access, "udp-auto-mtu" );;
 242
 243     /* Update default_pts to a suitable value for udp access */
 244     var_Create( p_access, "udp-caching", VLC_VAR_INTEGER | VLC_VAR_DOINHERIT );
 245
 246     /* Keep track of RTP sequence number */
 247     p_sys->i_sequence_number = 0;
 248     p_sys->b_first_seqno = VLC_TRUE;
 249
 250     /* RTP reordering out-of-bound packets */
 251     p_sys->i_last_pcr = 0;
 252     p_sys->i_rtp_late = var_CreateGetInteger( p_access, "rtp-late" );
 253     p_sys->p_list = NULL;
 254     p_sys->p_end = NULL;
 255     p_sys->p_next = NULL;
 256
 257     return VLC_SUCCESS;
 258 }
 259
 260 /*****************************************************************************
 261  * Close: free unused data structures
 262  *****************************************************************************/
 263 static void Close( vlc_object_t *p_this )
 264 {
 265     access_t     *p_access = (access_t*)p_this;
 266     access_sys_t *p_sys = p_access->p_sys;
 267
 268     block_ChainRelease( p_sys->p_list );
 269     net_Close( p_sys->fd );
 270     free( p_sys );
 271 }
 272
 273 /*****************************************************************************
 274  * Control:
 275  *****************************************************************************/
 276 static int Control( access_t *p_access, int i_query, va_list args )
 277 {
 278     access_sys_t *p_sys = p_access->p_sys;
 279     vlc_bool_t   *pb_bool;
 280     int          *pi_int;
 281     int64_t      *pi_64;
 282
 283     switch( i_query )
 284     {
 285         /* */
 286         case ACCESS_CAN_SEEK:
 287         case ACCESS_CAN_FASTSEEK:
 288         case ACCESS_CAN_PAUSE:
 289         case ACCESS_CAN_CONTROL_PACE:
 290             pb_bool = (vlc_bool_t*)va_arg( args, vlc_bool_t* );
 291             *pb_bool = VLC_FALSE;
 292             break;
 293         /* */
 294         case ACCESS_GET_MTU:
 295             pi_int = (int*)va_arg( args, int * );
 296             *pi_int = p_sys->i_mtu;
 297             break;
 298
 299         case ACCESS_GET_PTS_DELAY:
 300             pi_64 = (int64_t*)va_arg( args, int64_t * );
 301             *pi_64 = var_GetInteger( p_access, "udp-caching" ) * 1000;
 302             break;
 303
 304         /* */
 305         case ACCESS_SET_PAUSE_STATE:
 306         case ACCESS_GET_TITLE_INFO:
 307         case ACCESS_SET_TITLE:
 308         case ACCESS_SET_SEEKPOINT:
 309         case ACCESS_SET_PRIVATE_ID_STATE:
 310             return VLC_EGENERIC;
 311
 312         default:
 313             msg_Warn( p_access, "unimplemented query in control" );
 314             return VLC_EGENERIC;
 315
 316     }
 317     return VLC_SUCCESS;
 318 }
 319
 320 /*****************************************************************************
 321  * BlockUDP:
 322  *****************************************************************************/
 323 static block_t *BlockUDP( access_t *p_access )
 324 {
 325     access_sys_t *p_sys = p_access->p_sys;
 326     block_t      *p_block;
 327
 328     /* Read data */
 329     p_block = block_New( p_access, p_sys->i_mtu );
 330     p_block->i_buffer = net_Read( p_access, p_sys->fd, NULL,
 331                                   p_block->p_buffer, p_sys->i_mtu,
 332                                   VLC_FALSE );
 333     if( p_block->i_buffer <= 0 )
 334     {
 335         block_Release( p_block );
 336         return NULL;
 337     }
 338
 339     if( p_block->i_buffer >= p_sys->i_mtu && p_sys->b_auto_mtu &&
 340         p_sys->i_mtu < 32767 )
 341     {
 342         /* Increase by 100% */
 343         p_sys->i_mtu *= 2;
 344         msg_Dbg( p_access, "increasing MTU to %d", p_sys->i_mtu );
 345     }
 346
 347     return p_block;
 348 }
 349
 350 /*
 351  * rtp_ChainInsert - insert a p_block in the chain and
 352  * look at the sequence numbers.
 353  */
 354 static inline void rtp_ChainInsert( access_t *p_access, block_t **pp_list, block_t **pp_end, block_t *p_block )
 355 {
 356     block_t *p_tmp = NULL;
 357     block_t *p = NULL;
 358     uint16_t i_new = 0;
 359     uint16_t i_cur = 0;
 360     uint16_t i_expected = 0;
 361     uint32_t i_pcr_new = 0;
 362
 363     if( *pp_list == NULL )
 364     {
 365         *pp_list = p_block;
 366         *pp_end  = p_block;
 367         return;
 368     }
 369     /* Appending packets at the end of the chain is the normal case */
 370     i_pcr_new = ( (p_block->p_buffer[4] << 24) +
 371                   (p_block->p_buffer[5] << 16) +
 372                   (p_block->p_buffer[6] << 8) +
 373                    p_block->p_buffer[7] );
 374     i_new = ( (p_block->p_buffer[2] << 8 ) + p_block->p_buffer[3] );
 375
 376     p = *pp_end;
 377     i_cur = ( (p->p_buffer[2] << 8 ) + p->p_buffer[3] );
 378     i_expected = ((i_cur+1) % RTP_SEQ_NUM_SIZE);
 379
 380     if( i_new == i_expected ) /* Append at the end? */
 381     {
 382         msg_Dbg( p_access, ">> append %p(%u)==%p(%u)\n", p_block, i_cur, p, i_new );
 383         p->p_next = *pp_end = p_block;
 384         return;
 385     }
 386     /* Add to the fron fo the chain? */
 387     p = *pp_list;
 388     i_new = ( (p_block->p_buffer[2] << 8 ) + p_block->p_buffer[3] );
 389     i_cur = ( (p->p_buffer[2] << 8 ) + p->p_buffer[3] );
 390     i_expected = ((i_cur+1) % RTP_SEQ_NUM_SIZE);
 391     if( i_expected > i_new )
 392     {
 393         msg_Dbg( p_access, ">> prepend %p(%u)==%p(%u)\n", p_block, i_cur, p, i_new );
 394         p_block->p_next = p;
 395         *pp_list = p_block;
 396         return;
 397     }
 398     /* The packet can't be added to the front or the end of the chain,
 399      * thus walk the chain from the start.
 400      */
 401     while( p->p_next )
 402     {
 403         i_cur = (p->p_buffer[2] << 8 ) + p->p_buffer[3];
 404         i_expected = (i_cur+1) % RTP_SEQ_NUM_SIZE;
 405
 406         msg_Dbg( p_access,  "i_cur: %u, i_new: %u", i_cur, i_new);
 407         if( i_cur == i_new )
 408         {
 409             uint32_t i_pcr_cur = ( (p->p_buffer[4] << 24) +
 410                                    (p->p_buffer[5] << 16) +
 411                                    (p->p_buffer[6] << 8) +
 412                                     p->p_buffer[7] );
 413             /* This packet might be a duplicate, so check PCR's */
 414             if( i_pcr_cur >= i_pcr_new )
 415             {
 416                 /* packet way too late drop it. */
 417                 block_Release( p_block );
 418                 return;
 419             }
 420             /* Add it to list later on
 421              * else if( i_pcr_cur < i_pcr_new ) */
 422             break;
 423         }
 424         else if( i_expected == i_new ) /* insert in chain */
 425         {
 426             p_tmp = p->p_next;
 427             msg_Dbg( p_access, ">> insert between %p(%u)==%p(%u)", p, i_cur, p_tmp, i_new );
 428             p->p_next = p_block;
 429             p_block->p_next = p_tmp;
 430             return;
 431         }
 432         if( !p->p_next ) break;
 433         p = p->p_next;
 434     }
 435 }
 436
 437 /*
 438  * rtp_ChainSend - look which packets are ready for sending.
 439  */
 440 static inline block_t *rtp_ChainSend( access_t *p_access, block_t **pp_list, uint16_t i_seq )
 441 {
 442     access_sys_t *p_sys = (access_sys_t *) p_access->p_sys;
 443     uint16_t i_cur = 0;
 444
 445     if( *pp_list )
 446     {
 447         /* Parse RTP header */
 448         int i_skip = 0;
 449         int i_extension_bit = 0;
 450         int i_extension_length = 0;
 451         int i_CSRC_count = 0;
 452         /* Data pointers */
 453         block_t *p_prev = NULL;
 454         block_t *p_send = *pp_list;
 455         block_t *p = *pp_list;
 456
 457         while( p->p_next )
 458         {
 459             i_cur = ( (p->p_buffer[2] << 8 ) + p->p_buffer[3] );
 460             msg_Dbg( p_access, "rtp_ChainSend: i_cur %u, i_seq %u", i_cur, i_seq );
 461             if( i_cur == i_seq )
 462             {
 463                 /* sent all packets that are received in order */
 464                 i_seq++;
 465
 466                 i_CSRC_count = p->p_buffer[0] & 0x0F;
 467                 i_extension_bit  = ( p->p_buffer[0] & 0x10 ) >> 4;
 468                 if ( i_extension_bit == 1)
 469                     i_extension_length = ( (p->p_buffer[14] << 8 ) +
 470                                             p->p_buffer[15] );
 471
 472                 /* Skip header + CSRC extension field n*(32 bits) + extention */
 473                 i_skip = RTP_HEADER_LEN + 4*i_CSRC_count + i_extension_length;
 474
 475                 /* Return the packet without the RTP header. */
 476                 p->i_buffer -= i_skip;
 477                 p->p_buffer += i_skip;
 478             }
 479             else if( i_cur > i_seq )
 480             {
 481                 if( p_prev )
 482                 {
 483                     *pp_list = p;
 484                     p_prev->p_next = NULL;
 485                     p_sys->i_last_pcr = ( (p_prev->p_buffer[4] << 24) +
 486                                           (p_prev->p_buffer[5] << 16) +
 487                                           (p_prev->p_buffer[6] << 8) +
 488                                            p_prev->p_buffer[7] );
 489                     p_sys->i_sequence_number = ( (p_prev->p_buffer[2] << 8 ) +
 490                                                   p_prev->p_buffer[3] );
 491                     return p_send;
 492                 }
 493                 /* FiXME: or should we return NULL here? */
 494                 return NULL;
 495             }
 496             p_prev = p;
 497             if (!p->p_next) break;
 498             p = p->p_next;
 499         }
 500         /* We have walked through the complete chain and all packets are
 501          * in sequence - so send the whole chain
 502          */
 503         i_CSRC_count = p->p_buffer[0] & 0x0F;
 504         i_extension_bit  = ( p->p_buffer[0] & 0x10 ) >> 4;
 505         if( i_extension_bit == 1)
 506             i_extension_length = ( (p->p_buffer[14] << 8 ) + p->p_buffer[15] );
 507
 508         /* Skip header + CSRC extension field n*(32 bits) + extention */
 509         i_skip = RTP_HEADER_LEN + 4*i_CSRC_count + i_extension_length;
 510
 511         /* Update the list pointers */
 512         *pp_list = NULL;
 513         p_sys->p_next = NULL;
 514         p_sys->p_end = NULL;
 515         p_sys->i_sequence_number = ( (p->p_buffer[2] << 8 ) +
 516                                       p->p_buffer[3] );
 517         p_sys->i_last_pcr = ( (p->p_buffer[4] << 24) +
 518                               (p->p_buffer[5] << 16) +
 519                               (p->p_buffer[6] << 8) +
 520                                p->p_buffer[7] );
 521         /* Return the packet without the RTP header. */
 522         p->i_buffer -= i_skip;
 523         p->p_buffer += i_skip;
 524         return p_send;
 525     }
 526     return NULL;
 527 }
 528
 529 /*****************************************************************************
 530  * BlockParseRTP/BlockRTP:
 531  *****************************************************************************/
 532 static block_t *BlockParseRTP( access_t *p_access, block_t *p_block )
 533 {
 534     access_sys_t *p_sys = (access_sys_t *) p_access->p_sys;
 535     int      i_rtp_version;
 536     int      i_CSRC_count;
 537     int      i_payload_type;
 538     int      i_skip = 0;
 539     uint16_t i_sequence_number = 0;
 540     uint16_t i_sequence_expected = 0;
 541     int      i_extension_bit = 0;
 542     int      i_extension_length = 0;
 543     uint32_t i_pcr = 0;
 544
 545     if( p_block == NULL )
 546         return NULL;
 547
 548     if( p_block->i_buffer < RTP_HEADER_LEN )
 549     {
 550         msg_Warn( p_access, "received a too short packet for RTP" );
 551         block_Release( p_block );
 552         return NULL;
 553     }
 554     /* Parse the header and make some verifications.
 555      * See RFC 3550. */
 556     i_rtp_version     = ( p_block->p_buffer[0] & 0xC0 ) >> 6;
 557     i_CSRC_count      = p_block->p_buffer[0] & 0x0F;
 558     i_payload_type    = p_block->p_buffer[1] & 0x7F;
 559     i_sequence_number = (p_block->p_buffer[2] << 8) +
 560                          p_block->p_buffer[3];
 561     i_pcr = ( (p_block->p_buffer[4] << 24) +
 562               (p_block->p_buffer[5] << 16) +
 563               (p_block->p_buffer[6] << 8) +
 564                p_block->p_buffer[7] );
 565     i_extension_bit  = ( p_block->p_buffer[0] & 0x10 ) >> 4;
 566
 567     if( i_rtp_version != 2 )
 568         msg_Dbg( p_access, "RTP version is %u, should be 2", i_rtp_version );
 569
 570     if( i_payload_type == 14 )
 571         i_skip = 4;
 572     else if( i_payload_type !=  33 && i_payload_type != 32 )
 573         msg_Dbg( p_access, "unsupported RTP payload type (%u)", i_payload_type );
 574
 575     if( i_extension_bit == 1)
 576         i_extension_length = 4 +
 577             4 * ( (p_block->p_buffer[14] << 8) + p_block->p_buffer[15] );
 578
 579     /* Skip header + CSRC extension field n*(32 bits) + extention */
 580     i_skip += RTP_HEADER_LEN + 4*i_CSRC_count + i_extension_length;
 581     if( i_skip >= p_block->i_buffer )
 582     {
 583         msg_Warn( p_access, "received a too short packet for RTP" );
 584         block_Release( p_block );
 585         return NULL;
 586     }
 587
 588     /* Detect RTP packet loss through tracking sequence numbers,
 589      * and take RTP PCR into account.
 590      * See RFC 3550.
 591      */
 592     if( p_sys->b_first_seqno )
 593     {
 594         p_sys->i_sequence_number = i_sequence_number;
 595         p_sys->i_last_pcr = i_pcr;
 596         p_sys->b_first_seqno = VLC_FALSE;
 597     }
 598 #if 0
 599     /* Emulate packet loss */
 600     if ( (i_sequence_number % 4000) == 0)
 601     {
 602         msg_Warn( p_access, "Emulating packet drop" );
 603         block_Release( p_block );
 604         return NULL;
 605     }
 606 #endif
 607     i_sequence_expected = ((p_sys->i_sequence_number + 1) % RTP_SEQ_NUM_SIZE);
 608     if( i_sequence_expected != i_sequence_number )
 609     {
 610         /* Handle out of order packets */
 611         if( p_sys->i_rtp_late > 0 )
 612         {
 613             if( i_sequence_expected < i_sequence_number )
 614             {
 615                 msg_Warn( p_access,
 616                     "RTP packet out of order (too early) expected %u, current %u",
 617                     i_sequence_expected, i_sequence_number );
 618                 if( (i_pcr - p_sys->i_last_pcr) > (p_sys->i_rtp_late*90) )
 619                 {
 620                     /* Gap too big, we have been holding this data for too long,
 621                      * send what we have.
 622                      */
 623                     msg_Warn( p_access,
 624                         "Gap too big resyncing: delta %u, held for %d ms",
 625                         (i_pcr - p_sys->i_last_pcr), p_sys->i_rtp_late );
 626                     rtp_ChainInsert( p_access, &p_sys->p_list, &p_sys->p_end, p_block );
 627                     return rtp_ChainSend( p_access, &p_sys->p_list, i_sequence_expected );
 628                 }
 629                 /* hold packets that arrive too early. */
 630                 rtp_ChainInsert( p_access, &p_sys->p_list, &p_sys->p_end, p_block );
 631                 return rtp_ChainSend( p_access, &p_sys->p_list, p_sys->i_sequence_number );
 632             }
 633             else if( /* (i_sequence_expected > i_sequence_number ) && */
 634                      (i_pcr <= p_sys->i_last_pcr) )
 635             {
 636                 msg_Warn( p_access,
 637                     "RTP packet out of order (duplicate or too late) expected %u, current %u .. trashing it",
 638                     i_sequence_expected, i_sequence_number );
 639                 block_Release( p_block );
 640                 p_sys->i_sequence_number = i_sequence_number;
 641                 p_sys->i_last_pcr = i_pcr;
 642                 return NULL;
 643             }
 644
 645             if( p_sys->p_list )
 646             {
 647                 block_t *p = NULL;
 648                 block_t **p_send = &p_sys->p_list;
 649
 650                 msg_Warn( p_access,
 651                     "RTP packet (unexpected condition) expected %u, current %u",
 652                     i_sequence_expected, i_sequence_number );
 653
 654                 /* Append block to the end of chain and send whole chain */
 655                 block_ChainLastAppend( &p_send, p_block );
 656                 p_sys->p_list = p_sys->p_end = NULL;
 657                 p_sys->i_sequence_number = i_sequence_number;
 658                 p_sys->i_last_pcr = i_pcr;
 659
 660                 /* Return the packet without the RTP header. */
 661                 p = *p_send;
 662                 while( p->p_next )
 663                 {
 664                     p->i_buffer -= i_skip;
 665                     p->p_buffer += i_skip;
 666                     p = p->p_next;
 667                 }
 668                 return *p_send;
 669             }
 670             /* This code should never be reached !! */
 671             msg_Err( p_access,
 672                 "Bug in algorithme: (unexpected condition) expected %u (pcr=%u), current %u (pcr=%u)",
 673                 i_sequence_expected, i_sequence_number, p_sys->i_last_pcr, i_pcr );
 674         }
 675         msg_Warn( p_access,
 676                   "RTP packet(s) lost, expected sequence number %d got %d",
 677                   i_sequence_expected, i_sequence_number );
 678
 679         /* Mark transport error in the first TS packet in the RTP stream. */
 680         if( (i_payload_type == 33) && (p_block->p_buffer[0] == 0x47) )
 681             p_block->p_buffer[1] |= 0x80;
 682     }
 683     else if( (p_sys->i_rtp_late > 0) && p_sys->p_list )
 684     {
 685         if( i_pcr <= p_sys->i_last_pcr )
 686         {
 687             msg_Warn( p_access,
 688                 "RTP packet out of order (duplicate) expected %u, current %u .. trashing it",
 689                 i_sequence_expected, i_sequence_number );
 690             block_Release( p_block );
 691             p_sys->i_sequence_number = i_sequence_number;
 692             p_sys->i_last_pcr = i_pcr;
 693             return NULL;
 694         }
 695         rtp_ChainInsert( p_access, &p_sys->p_list, &p_sys->p_end, p_block );
 696         return rtp_ChainSend( p_access, &p_sys->p_list, i_sequence_expected );
 697     }
 698
 699     /* This is the normal case when no packet reordering is effective */
 700     p_sys->i_sequence_number = i_sequence_number;
 701     p_sys->i_last_pcr = i_pcr;
 702
 703     /* Return the packet without the RTP header. */
 704     p_block->i_buffer -= i_skip;
 705     p_block->p_buffer += i_skip;
 706     return p_block;
 707 }
 708
 709 static block_t *BlockRTP( access_t *p_access )
 710 {
 711     block_t *p_block = BlockUDP( p_access );
 712
 713     if ( p_block != NULL )
 714         return BlockParseRTP( p_access, p_block );
 715     else
 716         return NULL;
 717 }
 718
 719 /*****************************************************************************
 720  * BlockChoose: decide between RTP and UDP
 721  *****************************************************************************/
 722 static block_t *BlockChoose( access_t *p_access )
 723 {
 724     block_t *p_block;
 725     int     i_rtp_version;
 726     int     i_CSRC_count;
 727     int     i_payload_type;
 728
 729     if( ( p_block = BlockUDP( p_access ) ) == NULL )
 730         return NULL;
 731
 732     if( p_block->p_buffer[0] == 0x47 )
 733     {
 734         msg_Dbg( p_access, "detected TS over raw UDP" );
 735         p_access->pf_block = BlockUDP;
 736         return p_block;
 737     }
 738
 739     if( p_block->i_buffer < RTP_HEADER_LEN )
 740         return p_block;
 741
 742     /* Parse the header and make some verifications.
 743      * See RFC 3550. */
 744
 745     i_rtp_version  = ( p_block->p_buffer[0] & 0xC0 ) >> 6;
 746     i_CSRC_count   = ( p_block->p_buffer[0] & 0x0F );
 747     i_payload_type = ( p_block->p_buffer[1] & 0x7F );
 748
 749     if( i_rtp_version != 2 )
 750     {
 751         msg_Dbg( p_access, "no supported RTP header detected" );
 752         p_access->pf_block = BlockUDP;
 753         return p_block;
 754     }
 755
 756     switch( i_payload_type )
 757     {
 758         case 33:
 759             msg_Dbg( p_access, "detected TS over RTP" );
 760             p_access->psz_demux = strdup( "ts" );
 761             break;
 762
 763         case 14:
 764             msg_Dbg( p_access, "detected MPEG audio over RTP" );
 765             p_access->psz_demux = strdup( "mpga" );
 766             break;
 767
 768         case 32:
 769             msg_Dbg( p_access, "detected MPEG video over RTP" );
 770             p_access->psz_demux = strdup( "mpgv" );
 771             break;
 772
 773         default:
 774             msg_Dbg( p_access, "no RTP header detected" );
 775             p_access->pf_block = BlockUDP;
 776             return p_block;
 777     }
 778
 779     p_access->pf_block = BlockRTP;
 780
 781     return BlockParseRTP( p_access, p_block );
 782 }