]> git.sesse.net Git - vlc/blobdiff - modules/demux/ts.c
* modules/demux/*: removed useless probing messages.
[vlc] / modules / demux / ts.c
index a1b0a08469a2c480941ebce4d513607802190d60..c7ab9f9858fea3a2974caf3250405b6f4f71c314 100644 (file)
@@ -2,7 +2,7 @@
  * ts.c: Transport Stream input module for VLC.
  *****************************************************************************
  * Copyright (C) 2004 VideoLAN
- * $Id: ts.c,v 1.1 2004/01/16 01:47:41 fenrir Exp $
+ * $Id$
  *
  * Authors: Laurent Aimar <fenrir@via.ecp.fr>
  *
@@ -30,6 +30,9 @@
 #include <vlc/input.h>
 
 #include "iso_lang.h"
+#include "network.h"
+
+#include "../mux/mpeg/csa.h"
 
 /* Include dvbpsi headers */
 #ifdef HAVE_DVBPSI_DR_H
@@ -49,6 +52,7 @@
 #endif
 
 /* TODO:
+ *  - XXX: do not mark options message to be translated, they are too osbcure for now ...
  *  - test it
  *  - ...
  */
 /*****************************************************************************
  * Module descriptor
  *****************************************************************************/
-static int  Open    ( vlc_object_t * );
-static void Close  ( vlc_object_t * );
+static int  Open  ( vlc_object_t * );
+static void Close ( vlc_object_t * );
+
+#define PMT_TEXT N_("Extra PMT")
+#define PMT_LONGTEXT N_( \
+  "Allows a user to specify an extra pmt (pmt_pid=pid:stream_type[,...])" )
+
+#define PID_TEXT N_("Set id of ES to PID")
+#define PID_LONGTEXT N_("set id of es to pid")
+
+#define TSOUT_TEXT N_("Fast udp streaming")
+#define TSOUT_LONGTEXT N_( \
+  "Sends TS to specific ip:port by udp (you must know what you are doing)")
+
+#define MTUOUT_TEXT N_("MTU for out mode")
+#define MTUOUT_LONGTEXT N_("MTU for out mode")
+
+#define CSA_TEXT N_("CSA ck")
+#define CSA_LONGTEXT N_("CSA ck")
+
+#define SILENT_TEXT N_("Silent mode")
+#define SILENT_LONGTEXT N_("do not complain on encrypted PES")
+
+#define CAPMT_SYSID_TEXT N_("CAPMT System ID")
+#define CAPMT_SYSID_LONGTEXT N_("only forward descriptors from this SysID to the CAM")
 
 vlc_module_begin();
     set_description( _("ISO 13818-1 MPEG Transport Stream input - new" ) );
-    add_category_hint( "TS demuxer", NULL, VLC_TRUE );
-        add_string( "ts-extra-pmt", NULL, NULL, "extra PMT", "allow user to specify an extra pmt (pmt_pid=pid:stream_type[,...])", VLC_TRUE );
+    set_shortname ( _("MPEG-TS") );
+    set_category( CAT_INPUT );
+    set_subcategory( SUBCAT_INPUT_DEMUX );
+
+    add_string( "ts-extra-pmt", NULL, NULL, PMT_TEXT, PMT_LONGTEXT, VLC_TRUE );
+    add_bool( "ts-es-id-pid", 0, NULL, PID_TEXT, PID_LONGTEXT, VLC_TRUE );
+    add_string( "ts-out", NULL, NULL, TSOUT_TEXT, TSOUT_LONGTEXT, VLC_TRUE );
+    add_integer( "ts-out-mtu", 1500, NULL, MTUOUT_TEXT,
+                 MTUOUT_LONGTEXT, VLC_TRUE );
+    add_string( "ts-csa-ck", NULL, NULL, CSA_TEXT, CSA_LONGTEXT, VLC_TRUE );
+    add_bool( "ts-silent", 0, NULL, SILENT_TEXT, SILENT_LONGTEXT, VLC_TRUE );
+    add_integer( "ts-capmt-sysid", 0, NULL, CAPMT_SYSID_TEXT,
+                 CAPMT_SYSID_LONGTEXT, VLC_TRUE );
+
     set_capability( "demux2", 10 );
     set_callbacks( Open, Close );
-    add_shortcut( "ts2" );
+    add_shortcut( "ts" );
 vlc_module_end();
 
 /*****************************************************************************
@@ -131,6 +170,7 @@ typedef struct
 
     decoder_config_descriptor_t    dec_descr;
     sl_config_descriptor_t         sl_descr;
+
 } es_mpeg4_descriptor_t;
 
 typedef struct
@@ -153,23 +193,41 @@ typedef struct
 
 typedef struct
 {
+    dvbpsi_handle   handle;
+
     int             i_version;
     int             i_number;
     int             i_pid_pcr;
-    dvbpsi_handle   handle;
-
+    int             i_pid_pmt;
     /* IOD stuff (mpeg4) */
     iod_descriptor_t *iod;
 
+} ts_prg_psi_t;
+
+typedef struct
+{
+    /* for special PAT case */
+    dvbpsi_handle   handle;
+    int             i_pat_version;
+
+    /* For PMT */
+    int             i_prg;
+    ts_prg_psi_t    **prg;
+
 } ts_psi_t;
 
 typedef struct
 {
     es_format_t  fmt;
     es_out_id_t *id;
+    int         i_pes_size;
+    int         i_pes_gathered;
     block_t     *p_pes;
+    block_t     **pp_last;
 
     es_mpeg4_descriptor_t *p_mpeg4desc;
+    int         b_gather;
+
 } ts_es_t;
 
 typedef struct
@@ -182,27 +240,56 @@ typedef struct
 
     /* PSI owner (ie PMT -> PAT, ES -> PMT */
     ts_psi_t   *p_owner;
+    int         i_owner_number;
 
     /* */
     ts_psi_t    *psi;
     ts_es_t     *es;
 
+    /* Some private streams encapsulate several ES (eg. DVB subtitles)*/
+    ts_es_t     **extra_es;
+    int         i_extra_es;
+
 } ts_pid_t;
 
 struct demux_sys_t
 {
+    /* TS packet size (188, 192, 204) */
+    int         i_packet_size;
+
+    /* how many TS packet we read at once */
+    int         i_ts_read;
+
     /* All pid */
     ts_pid_t    pid[8192];
 
     /* All PMT */
     int         i_pmt;
     ts_pid_t    **pmt;
+
+    /* */
+    vlc_bool_t  b_es_id_pid;
+    csa_t       *csa;
+    vlc_bool_t  b_silent;
+    uint16_t    i_capmt_sysid;
+
+    vlc_bool_t  b_udp_out;
+    int         fd; /* udp socket */
+    uint8_t     *buffer;
+
+    vlc_bool_t  b_dvb_control;
+    int         i_dvb_program;
+    vlc_list_t  *p_programs_list;
 };
 
 static int Demux  ( demux_t *p_demux );
 static int Control( demux_t *p_demux, int i_query, va_list args );
 
-static void PIDInit( ts_pid_t *pid, vlc_bool_t b_psi, ts_psi_t *p_owner );
+
+static void PIDInit ( ts_pid_t *pid, vlc_bool_t b_psi, ts_psi_t *p_owner );
+static void PIDClean( es_out_t *out, ts_pid_t *pid );
+static int  PIDFillFormat( ts_pid_t *pid, int i_stream_type );
+
 static void PATCallBack( demux_t *, dvbpsi_pat_t * );
 static void PMTCallBack( demux_t *p_demux, dvbpsi_pmt_t *p_pmt );
 
@@ -212,12 +299,16 @@ static inline int PIDGet( block_t *p )
 }
 
 static vlc_bool_t GatherPES( demux_t *p_demux, ts_pid_t *pid, block_t *p_bk );
-static char *LanguageNameISO639( char *p );
+
+static void PCRHandle( demux_t *p_demux, ts_pid_t *, block_t * );
 
 static iod_descriptor_t *IODNew( int , uint8_t * );
-static void IODFree( iod_descriptor_t * );
+static void              IODFree( iod_descriptor_t * );
 
-static int ESFillFormat( es_format_t *fmt, int i_stream_type );
+#define TS_PACKET_SIZE_188 188
+#define TS_PACKET_SIZE_192 192
+#define TS_PACKET_SIZE_204 204
+#define TS_PACKET_SIZE_MAX 204
 
 /*****************************************************************************
  * Open
@@ -228,26 +319,60 @@ static int Open( vlc_object_t *p_this )
     demux_sys_t *p_sys;
 
     uint8_t     *p_peek;
-    int          i_peek;
-    int          i;
+    int          i_sync, i_peek, i;
+    int          i_packet_size;
 
     ts_pid_t     *pat;
 
     vlc_value_t  val;
 
-    if( ( i_peek = stream_Peek( p_demux->s, &p_peek, 189 ) ) < 1 )
+    if( stream_Peek( p_demux->s, &p_peek, TS_PACKET_SIZE_MAX ) <
+        TS_PACKET_SIZE_MAX ) return VLC_EGENERIC;
+
+    /* Search first sync byte */
+    for( i_sync = 0; i_sync < TS_PACKET_SIZE_MAX; i_sync++ )
+    {
+        if( p_peek[i_sync] == 0x47 ) break;
+    }
+    if( i_sync >= TS_PACKET_SIZE_MAX )
+    {
+        if( strcmp( p_demux->psz_demux, "ts" ) ) return VLC_EGENERIC;
+        msg_Warn( p_demux, "this does not look like a TS stream, continuing" );
+    }
+
+    /* Check next 3 sync bytes */
+    i_peek = TS_PACKET_SIZE_MAX * 3 + i_sync + 1;
+    if( ( stream_Peek( p_demux->s, &p_peek, i_peek ) ) < i_peek )
     {
         msg_Err( p_demux, "cannot peek" );
         return VLC_EGENERIC;
     }
-    if( p_peek[0] != 0x47 || ( i_peek >= 189 && p_peek[188] != 0x47 ) )
+    if( p_peek[i_sync + TS_PACKET_SIZE_188] == 0x47 &&
+        p_peek[i_sync + 2 * TS_PACKET_SIZE_188] == 0x47 &&
+        p_peek[i_sync + 3 * TS_PACKET_SIZE_188] == 0x47 )
     {
-        if( strcmp( p_demux->psz_demux, "ts" ) )
-        {
-            msg_Warn( p_demux, "TS module discarded" );
-            return VLC_EGENERIC;
-        }
-        msg_Warn( p_demux, "this does not look like a TS stream, continuing" );
+        i_packet_size = TS_PACKET_SIZE_188;
+    }
+    else if( p_peek[i_sync + TS_PACKET_SIZE_192] == 0x47 &&
+             p_peek[i_sync + 2 * TS_PACKET_SIZE_192] == 0x47 &&
+             p_peek[i_sync + 3 * TS_PACKET_SIZE_192] == 0x47 )
+    {
+        i_packet_size = TS_PACKET_SIZE_192;
+    }
+    else if( p_peek[i_sync + TS_PACKET_SIZE_204] == 0x47 &&
+             p_peek[i_sync + 2 * TS_PACKET_SIZE_204] == 0x47 &&
+             p_peek[i_sync + 3 * TS_PACKET_SIZE_204] == 0x47 )
+    {
+        i_packet_size = TS_PACKET_SIZE_204;
+    }
+    else if( !strcmp( p_demux->psz_demux, "ts" ) )
+    {
+        i_packet_size = TS_PACKET_SIZE_188;
+    }
+    else
+    {
+        msg_Warn( p_demux, "TS module discarded (lost sync)" );
+        return VLC_EGENERIC;
     }
 
     /* Fill p_demux field */
@@ -257,6 +382,8 @@ static int Open( vlc_object_t *p_this )
     memset( p_sys, 0, sizeof( demux_sys_t ) );
 
     /* Init p_sys field */
+    p_sys->b_dvb_control = VLC_TRUE;
+    p_sys->i_dvb_program = 0;
     for( i = 0; i < 8192; i++ )
     {
         ts_pid_t *pid = &p_sys->pid[i];
@@ -265,16 +392,69 @@ static int Open( vlc_object_t *p_this )
         pid->b_seen     = VLC_FALSE;
         pid->b_valid    = VLC_FALSE;
     }
+    p_sys->i_packet_size = i_packet_size;
+    p_sys->b_udp_out = VLC_FALSE;
+    p_sys->i_ts_read = 50;
+    p_sys->csa = NULL;
 
     /* Init PAT handler */
     pat = &p_sys->pid[0];
     PIDInit( pat, VLC_TRUE, NULL );
-    pat->psi->handle = dvbpsi_AttachPAT( (dvbpsi_pat_callback)PATCallBack, p_demux );
+    pat->psi->handle = dvbpsi_AttachPAT( (dvbpsi_pat_callback)PATCallBack,
+                                         p_demux );
 
     /* Init PMT array */
     p_sys->i_pmt = 0;
     p_sys->pmt   = NULL;
 
+    /* Read config */
+    var_Create( p_demux, "ts-es-id-pid", VLC_VAR_BOOL | VLC_VAR_DOINHERIT );
+    var_Get( p_demux, "ts-es-id-pid", &val );
+    p_sys->b_es_id_pid = val.b_bool,
+
+    var_Create( p_demux, "ts-out", VLC_VAR_STRING | VLC_VAR_DOINHERIT );
+    var_Get( p_demux, "ts-out", &val );
+    if( val.psz_string && *val.psz_string )
+    {
+        vlc_value_t mtu;
+        char *psz = strchr( val.psz_string, ':' );
+        int   i_port = 0;
+
+        p_sys->b_udp_out = VLC_TRUE;
+
+        if( psz )
+        {
+            *psz++ = '\0';
+            i_port = atoi( psz );
+        }
+        if( i_port <= 0 ) i_port  = 1234;
+        msg_Dbg( p_demux, "resend ts to '%s:%d'", val.psz_string, i_port );
+
+        p_sys->fd = net_OpenUDP( p_demux, "", 0, val.psz_string, i_port );
+        if( p_sys->fd < 0 )
+        {
+            msg_Err( p_demux, "failed to open udp socket, send disabled" );
+            p_sys->b_udp_out = VLC_FALSE;
+        }
+        else
+        {
+            var_Create( p_demux, "ts-out-mtu",
+                        VLC_VAR_INTEGER | VLC_VAR_DOINHERIT );
+            var_Get( p_demux, "ts-out-mtu", &mtu );
+            p_sys->i_ts_read = mtu.i_int / p_sys->i_packet_size;
+            if( p_sys->i_ts_read <= 0 )
+            {
+                p_sys->i_ts_read = 1500 / p_sys->i_packet_size;
+            }
+            p_sys->buffer = malloc( p_sys->i_packet_size * p_sys->i_ts_read );
+        }
+    }
+    if( val.psz_string )
+    {
+        free( val.psz_string );
+    }
+
+
     /* We handle description of an extra PMT */
     var_Create( p_demux, "ts-extra-pmt", VLC_VAR_STRING | VLC_VAR_DOINHERIT );
     var_Get( p_demux, "ts-extra-pmt", &val );
@@ -287,11 +467,15 @@ static int Open( vlc_object_t *p_this )
         {
             ts_pid_t *pmt = &p_sys->pid[i_pid];
 
-            msg_Dbg( p_demux, "Extra pmt specified (pid=0x%x)", i_pid );
+            msg_Dbg( p_demux, "extra pmt specified (pid=%d)", i_pid );
             PIDInit( pmt, VLC_TRUE, NULL );
+            pmt->psi->i_prg = 1;
+            pmt->psi->prg = malloc( sizeof(ts_prg_psi_t) );
             /* FIXME we should also ask for a number */
-            pmt->psi->handle = dvbpsi_AttachPMT( 1, (dvbpsi_pmt_callback)PMTCallBack, p_demux );
-            pmt->psi->i_number = 0; /* special one */
+            pmt->psi->prg[0]->handle =
+                dvbpsi_AttachPMT( 1, (dvbpsi_pmt_callback)PMTCallBack,
+                                  p_demux );
+            pmt->psi->prg[0]->i_number = 0; /* special one */
 
             psz = strchr( psz, '=' ) + 1;   /* can't failed */
             while( psz && *psz )
@@ -308,20 +492,28 @@ static int Open( vlc_object_t *p_this )
                 if( *psz == ':' )
                 {
                     i_stream_type = strtol( psz + 1, &psz, 0 );
-                    if( i_pid >= 2 && i_pid < 8192 && !p_sys->pid[i_pid].b_valid )
+                    if( i_pid >= 2 && i_pid < 8192 &&
+                        !p_sys->pid[i_pid].b_valid )
                     {
                         ts_pid_t *pid = &p_sys->pid[i_pid];
 
                         PIDInit( pid, VLC_FALSE, pmt->psi);
-                        if( pmt->psi->i_pid_pcr <= 0 )
+                        if( pmt->psi->prg[0]->i_pid_pcr <= 0 )
                         {
-                            pmt->psi->i_pid_pcr = i_pid;
+                            pmt->psi->prg[0]->i_pid_pcr = i_pid;
                         }
-                        ESFillFormat( &pid->es->fmt, i_stream_type);
+                        PIDFillFormat( pid, i_stream_type);
                         if( pid->es->fmt.i_cat != UNKNOWN_ES )
                         {
-                            msg_Dbg( p_demux, "  * es pid=0x%x type=0x%x fcc=%4.4s", i_pid, i_stream_type, (char*)&pid->es->fmt.i_codec );
-                            pid->es->id = es_out_Add( p_demux->out, &pid->es->fmt );
+                            if( p_sys->b_es_id_pid )
+                            {
+                                pid->es->fmt.i_id = i_pid;
+                            }
+                            msg_Dbg( p_demux, "  * es pid=%d type=%d "
+                                     "fcc=%4.4s", i_pid, i_stream_type,
+                                     (char*)&pid->es->fmt.i_codec );
+                            pid->es->id = es_out_Add( p_demux->out,
+                                                      &pid->es->fmt );
                         }
                     }
                 }
@@ -334,6 +526,54 @@ static int Open( vlc_object_t *p_this )
         free( val.psz_string );
     }
 
+    var_Create( p_demux, "ts-csa-ck", VLC_VAR_STRING | VLC_VAR_DOINHERIT );
+    var_Get( p_demux, "ts-csa-ck", &val );
+    if( val.psz_string && *val.psz_string )
+    {
+        char *psz = val.psz_string;
+        if( psz[0] == '0' && ( psz[1] == 'x' || psz[1] == 'X' ) )
+        {
+            psz += 2;
+        }
+        if( strlen( psz ) != 16 )
+        {
+            msg_Warn( p_demux, "invalid csa ck (it must be 16 chars long)" );
+        }
+        else
+        {
+#ifndef UNDER_CE
+            uint64_t i_ck = strtoull( psz, NULL, 16 );
+#else
+            uint64_t i_ck = strtoll( psz, NULL, 16 );
+#endif
+            uint8_t ck[8];
+            int     i;
+            for( i = 0; i < 8; i++ )
+            {
+                ck[i] = ( i_ck >> ( 56 - 8*i) )&0xff;
+            }
+
+            msg_Dbg( p_demux, "using CSA scrambling with "
+                     "ck=%x:%x:%x:%x:%x:%x:%x:%x",
+                     ck[0], ck[1], ck[2], ck[3], ck[4], ck[5], ck[6], ck[7] );
+
+            p_sys->csa = csa_New();
+            csa_SetCW( p_sys->csa, ck, ck );
+        }
+    }
+    if( val.psz_string )
+    {
+        free( val.psz_string );
+    }
+
+    var_Create( p_demux, "ts-silent", VLC_VAR_BOOL | VLC_VAR_DOINHERIT );
+    var_Get( p_demux, "ts-silent", &val );
+    p_sys->b_silent = val.b_bool;
+
+    var_Create( p_demux, "ts-capmt-sysid", VLC_VAR_INTEGER | VLC_VAR_DOINHERIT );
+    var_Get( p_demux, "ts-capmt-sysid", &val );
+    p_sys->i_capmt_sysid = val.i_int;
+
     return VLC_SUCCESS;
 }
 
@@ -358,37 +598,56 @@ static void Close( vlc_object_t *p_this )
             {
                 case 0: /* PAT */
                     dvbpsi_DetachPAT( pid->psi->handle );
+                    free( pid->psi );
                     break;
                 case 1: /* CAT */
+                    free( pid->psi );
                     break;
                 default:
-                    dvbpsi_DetachPMT( pid->psi->handle );
-                    if( pid->psi->iod )
-                    {
-                        IODFree( pid->psi->iod );
-                    }
+                    PIDClean( p_demux->out, pid );
                     break;
             }
-            free( pid->psi );
         }
         else if( pid->b_valid && pid->es )
         {
-            if( pid->es->p_pes )
-            {
-                block_ChainRelease( pid->es->p_pes );
-            }
-            free( pid->es );
+            PIDClean( p_demux->out, pid );
         }
+
         if( pid->b_seen )
         {
-            msg_Dbg( p_demux, "  - pid[0x%x] seen", pid->i_pid );
+            msg_Dbg( p_demux, "  - pid[%d] seen", pid->i_pid );
         }
+
+        if( p_sys->b_dvb_control && pid->i_pid > 0 )
+        {
+            /* too much */
+            stream_Control( p_demux->s, STREAM_CONTROL_ACCESS, ACCESS_SET_PRIVATE_ID_STATE, pid->i_pid, VLC_FALSE );
+        }
+
+    }
+
+    if( p_sys->b_udp_out )
+    {
+        net_Close( p_sys->fd );
+        free( p_sys->buffer );
+    }
+    if( p_sys->csa )
+    {
+        csa_Delete( p_sys->csa );
+    }
+
+    if( p_sys->i_pmt ) free( p_sys->pmt );
+
+    if ( p_sys->p_programs_list )
+    {
+        vlc_value_t val;
+        val.p_list = p_sys->p_programs_list;
+        var_Change( p_demux, "programs", VLC_VAR_FREELIST, &val, NULL );
     }
 
     free( p_sys );
 }
 
-
 /*****************************************************************************
  * Demux:
  *****************************************************************************/
@@ -398,60 +657,70 @@ static int Demux( demux_t *p_demux )
     int          i_pkt;
 
     /* We read at most 100 TS packet or until a frame is completed */
-    for( i_pkt = 0; i_pkt < 100; i_pkt++ )
+    for( i_pkt = 0; i_pkt < p_sys->i_ts_read; i_pkt++ )
     {
         vlc_bool_t  b_frame = VLC_FALSE;
         block_t     *p_pkt;
         ts_pid_t    *p_pid;
 
         /* Get a new TS packet */
-        if( ( p_pkt = stream_Block( p_demux->s, 188 ) ) == NULL )
+        if( !( p_pkt = stream_Block( p_demux->s, p_sys->i_packet_size ) ) )
         {
             msg_Dbg( p_demux, "eof ?" );
             return 0;
         }
+
+        /* Check sync byte and re-sync if needed */
         if( p_pkt->p_buffer[0] != 0x47 )
         {
             msg_Warn( p_demux, "lost synchro" );
             block_Release( p_pkt );
 
-            /* Resynch */
-            for( ;; )
+            while( !p_demux->b_die )
             {
-                uint8_t    *p_peek;
-                int         i_peek = stream_Peek( p_demux->s, &p_peek, 1880 );
-                int         i_skip = 0;
-                vlc_bool_t  b_ok = VLC_FALSE;
+                uint8_t *p_peek;
+                int i_peek, i_skip = 0;
 
-                if( i_peek < 189 )
+                i_peek = stream_Peek( p_demux->s, &p_peek,
+                                      p_sys->i_packet_size * 10 );
+                if( i_peek < p_sys->i_packet_size + 1 )
                 {
                     msg_Dbg( p_demux, "eof ?" );
                     return 0;
                 }
 
-                while( i_skip < i_peek - 188 )
+                while( i_skip < i_peek - p_sys->i_packet_size )
                 {
-                    if( p_peek[i_skip] == 0x47 && p_peek[i_skip+188] == 0x47 )
+                    if( p_peek[i_skip] == 0x47 &&
+                        p_peek[i_skip + p_sys->i_packet_size] == 0x47 )
                     {
-                        b_ok = VLC_TRUE;
                         break;
                     }
                     i_skip++;
                 }
+
+                msg_Dbg( p_demux, "skipping %d bytes of garbage", i_skip );
                 stream_Read( p_demux->s, NULL, i_skip );
-                msg_Dbg( p_demux, "%d bytes of garbage", i_skip );
-                if( b_ok )
+
+                if( i_skip < i_peek - p_sys->i_packet_size )
                 {
                     break;
                 }
             }
-            if( ( p_pkt = stream_Block( p_demux->s, 188 ) ) == NULL )
+
+            if( !( p_pkt = stream_Block( p_demux->s, p_sys->i_packet_size ) ) )
             {
                 msg_Dbg( p_demux, "eof ?" );
                 return 0;
             }
         }
 
+        if( p_sys->b_udp_out )
+        {
+            memcpy( &p_sys->buffer[i_pkt * p_sys->i_packet_size],
+                    p_pkt->p_buffer, p_sys->i_packet_size );
+        }
+
         /* Parse the TS packet */
         p_pid = &p_sys->pid[PIDGet( p_pkt )];
 
@@ -459,20 +728,39 @@ static int Demux( demux_t *p_demux )
         {
             if( p_pid->psi )
             {
-                dvbpsi_PushPacket( p_pid->psi->handle, p_pkt->p_buffer );
+                if( p_pid->i_pid == 0 )
+                {
+                    dvbpsi_PushPacket( p_pid->psi->handle, p_pkt->p_buffer );
+                }
+                else
+                {
+                    int i_prg;
+                    for( i_prg = 0; i_prg < p_pid->psi->i_prg; i_prg++ )
+                    {
+                        dvbpsi_PushPacket( p_pid->psi->prg[i_prg]->handle,
+                                           p_pkt->p_buffer );
+                    }
+                }
                 block_Release( p_pkt );
             }
-            else
+            else if( !p_sys->b_udp_out )
             {
                 b_frame = GatherPES( p_demux, p_pid, p_pkt );
             }
+            else
+            {
+                PCRHandle( p_demux, p_pid, p_pkt );
+                block_Release( p_pkt );
+            }
         }
         else
         {
             if( !p_pid->b_seen )
             {
-                msg_Dbg( p_demux, "pid[0x%x] unknown", p_pid->i_pid );
+                msg_Dbg( p_demux, "pid[%d] unknown", p_pid->i_pid );
             }
+            /* We have to handle PCR if present */
+            PCRHandle( p_demux, p_pid, p_pkt );
             block_Release( p_pkt );
         }
         p_pid->b_seen = VLC_TRUE;
@@ -483,6 +771,13 @@ static int Demux( demux_t *p_demux )
         }
     }
 
+    if( p_sys->b_udp_out )
+    {
+        /* Send the complete block */
+        net_Write( p_demux, p_sys->fd, NULL, p_sys->buffer,
+                   p_sys->i_ts_read * p_sys->i_packet_size );
+    }
+
     return 1;
 }
 
@@ -493,7 +788,8 @@ static int Control( demux_t *p_demux, int i_query, va_list args )
 {
     demux_sys_t *p_sys = p_demux->p_sys;
     double f, *pf;
-    int64_t i64, *pi64;
+    int64_t i64;
+    int i_int;
 
     switch( i_query )
     {
@@ -531,24 +827,145 @@ static int Control( demux_t *p_demux, int i_query, va_list args )
             *pi64 = p_sys->i_time;
             return VLC_SUCCESS;
 
-#if 0
         case DEMUX_GET_LENGTH:
             pi64 = (int64_t*)va_arg( args, int64_t * );
             if( p_sys->i_mux_rate > 0 )
             {
-                *pi64 = (int64_t)1000000 * ( stream_Size( p_demux->s ) / 50 ) / p_sys->i_mux_rate;
+                *pi64 = I64C(1000000) * ( stream_Size( p_demux->s ) / 50 ) /
+                        p_sys->i_mux_rate;
                 return VLC_SUCCESS;
             }
             *pi64 = 0;
             return VLC_EGENERIC;
-
-        case DEMUX_SET_TIME:
 #endif
-        case DEMUX_GET_FPS:
-            pf = (double*)va_arg( args, double * );
-            *pf = (double)1000000.0 / (double)p_sys->i_pcr_inc;
+        case DEMUX_SET_GROUP:
+        {
+            uint16_t i_vpid = 0, i_apid1 = 0, i_apid2 = 0, i_apid3 = 0;
+            ts_prg_psi_t *p_prg = NULL;
+            vlc_list_t *p_list;
+
+            i_int = (int)va_arg( args, int );
+            p_list = (vlc_list_t *)va_arg( args, vlc_list_t * );
+            msg_Dbg( p_demux, "DEMUX_SET_GROUP %d %p", i_int, p_list );
+
+            if( p_sys->b_dvb_control && i_int > 0 && i_int != p_sys->i_dvb_program )
+            {
+                int i_pmt_pid = -1;
+                int i;
+
+                /* Search pmt to be unselected */
+                for( i = 0; i < p_sys->i_pmt; i++ )
+                {
+                    ts_pid_t *pmt = p_sys->pmt[i];
+                    int i_prg;
+
+                    for( i_prg = 0; i_prg < pmt->psi->i_prg; i_prg++ )
+                    {
+                        if( pmt->psi->prg[i_prg]->i_number == p_sys->i_dvb_program )
+                        {
+                            i_pmt_pid = p_sys->pmt[i]->i_pid;
+                            break;
+                        }
+                    }
+                    if( i_pmt_pid > 0 ) break;
+                }
+
+                if( i_pmt_pid > 0 )
+                {
+                    stream_Control( p_demux->s, STREAM_CONTROL_ACCESS,
+                                    ACCESS_SET_PRIVATE_ID_STATE, i_pmt_pid,
+                                    VLC_FALSE );
+                    /* All ES */
+                    for( i = 2; i < 8192; i++ )
+                    {
+                        ts_pid_t *pid = &p_sys->pid[i];
+                        int i_prg;
+
+                        if( !pid->b_valid || pid->psi ) continue;
+
+                        for( i_prg = 0; i_prg < pid->p_owner->i_prg; i_prg++ )
+                        {
+                            if( pid->p_owner->prg[i_prg]->i_pid_pmt == i_pmt_pid && pid->es->id )
+                            {
+                                /* We only remove es that aren't defined by extra pmt */
+                                stream_Control( p_demux->s,
+                                                STREAM_CONTROL_ACCESS,
+                                                ACCESS_SET_PRIVATE_ID_STATE,
+                                                i, VLC_FALSE );
+                                break;
+                            }
+                        }
+                    }
+                }
+
+                /* select new program */
+                p_sys->i_dvb_program = i_int;
+                i_pmt_pid = -1;
+                for( i = 0; i < p_sys->i_pmt; i++ )
+                {
+                    ts_pid_t *pmt = p_sys->pmt[i];
+                    int i_prg;
+
+                    for( i_prg = 0; i_prg < pmt->psi->i_prg; i_prg++ )
+                    {
+                        if( pmt->psi->prg[i_prg]->i_number == i_int )
+                        {
+                            i_pmt_pid = p_sys->pmt[i]->i_pid;
+                            p_prg = p_sys->pmt[i]->psi->prg[i_prg];
+                            break;
+                        }
+                    }
+                    if( i_pmt_pid > 0 ) break;
+                }
+                if( i_pmt_pid > 0 )
+                {
+                    stream_Control( p_demux->s, STREAM_CONTROL_ACCESS,
+                                    ACCESS_SET_PRIVATE_ID_STATE, i_pmt_pid,
+                                    VLC_TRUE );
+                    stream_Control( p_demux->s, STREAM_CONTROL_ACCESS,
+                                    ACCESS_SET_PRIVATE_ID_STATE, p_prg->i_pid_pcr,
+                                    VLC_TRUE );
+
+                    for( i = 2; i < 8192; i++ )
+                    {
+                        ts_pid_t *pid = &p_sys->pid[i];
+                        int i_prg;
+
+                        if( !pid->b_valid || pid->psi ) continue;
+
+                        for( i_prg = 0; i_prg < pid->p_owner->i_prg; i_prg++ )
+                        {
+                            if( pid->p_owner->prg[i_prg]->i_pid_pmt == i_pmt_pid && pid->es->id )
+                            {
+                                if ( pid->es->fmt.i_cat == VIDEO_ES && !i_vpid )
+                                    i_vpid = i;
+                                if ( pid->es->fmt.i_cat == AUDIO_ES && !i_apid1 )
+                                    i_apid1 = i;
+                                else if ( pid->es->fmt.i_cat == AUDIO_ES && !i_apid2 )
+                                    i_apid2 = i;
+                                else if ( pid->es->fmt.i_cat == AUDIO_ES && !i_apid3 )
+                                    i_apid3 = i;
+
+                                stream_Control( p_demux->s,
+                                                STREAM_CONTROL_ACCESS,
+                                                ACCESS_SET_PRIVATE_ID_STATE,
+                                                i, VLC_TRUE );
+                                break;
+                            }
+                        }
+                    }
+                }
+            }
+            else
+            {
+                p_sys->i_dvb_program = -1;
+                p_sys->p_programs_list = p_list;
+            }
             return VLC_SUCCESS;
-#endif
+        }
+
+        case DEMUX_GET_FPS:
+        case DEMUX_SET_TIME:
         default:
             return VLC_EGENERIC;
     }
@@ -556,20 +973,41 @@ static int Control( demux_t *p_demux, int i_query, va_list args )
 
 static void PIDInit( ts_pid_t *pid, vlc_bool_t b_psi, ts_psi_t *p_owner )
 {
+    vlc_bool_t b_old_valid = pid->b_valid;
+
     pid->b_valid    = VLC_TRUE;
     pid->i_cc       = 0xff;
     pid->p_owner    = p_owner;
+    pid->i_owner_number = 0;
+
+    pid->extra_es   = NULL;
+    pid->i_extra_es = 0;
 
     if( b_psi )
     {
-        pid->psi = malloc( sizeof( ts_psi_t ) );
         pid->es  = NULL;
 
-        pid->psi->i_version  = -1;
-        pid->psi->i_number   = -1;
-        pid->psi->i_pid_pcr  = -1;
-        pid->psi->handle     = NULL;
-        pid->psi->iod        = NULL;
+        if( !b_old_valid )
+        {
+            pid->psi = malloc( sizeof( ts_psi_t ) );
+            pid->psi->i_prg = 0;
+            pid->psi->prg   = NULL;
+            pid->psi->handle= NULL;
+        }
+        pid->psi->i_pat_version  = -1;
+        if( p_owner )
+        {
+            ts_prg_psi_t *prg = malloc( sizeof( ts_prg_psi_t ) );
+            /* PMT */
+            prg->i_version  = -1;
+            prg->i_number   = -1;
+            prg->i_pid_pcr  = -1;
+            prg->i_pid_pmt  = -1;
+            prg->iod        = NULL;
+            prg->handle     = NULL;
+
+            TAB_APPEND( pid->psi->i_prg, pid->psi->prg, prg );
+        }
     }
     else
     {
@@ -579,40 +1017,98 @@ static void PIDInit( ts_pid_t *pid, vlc_bool_t b_psi, ts_psi_t *p_owner )
         es_format_Init( &pid->es->fmt, UNKNOWN_ES, 0 );
         pid->es->id      = NULL;
         pid->es->p_pes   = NULL;
+        pid->es->i_pes_size= 0;
+        pid->es->i_pes_gathered= 0;
+        pid->es->pp_last = &pid->es->p_pes;
         pid->es->p_mpeg4desc = NULL;
+        pid->es->b_gather = VLC_FALSE;
     }
 }
 
+static void PIDClean( es_out_t *out, ts_pid_t *pid )
+{
+    if( pid->psi )
+    {
+        int i;
+
+        if( pid->psi->handle ) dvbpsi_DetachPMT( pid->psi->handle );
+        for( i = 0; i < pid->psi->i_prg; i++ )
+        {
+            if( pid->psi->prg[i]->iod )
+                IODFree( pid->psi->prg[i]->iod );
+            if( pid->psi->prg[i]->handle )
+                dvbpsi_DetachPMT( pid->psi->prg[i]->handle );
+            free( pid->psi->prg[i] );
+        }
+        if( pid->psi->prg ) free( pid->psi->prg );
+        free( pid->psi );
+    }
+    else
+    {
+        int i;
+
+        if( pid->es->id )
+            es_out_Del( out, pid->es->id );
+
+        if( pid->es->p_pes )
+            block_ChainRelease( pid->es->p_pes );
+
+        es_format_Clean( &pid->es->fmt );
+
+        free( pid->es );
+
+        for( i = 0; i < pid->i_extra_es; i++ )
+        {
+            if( pid->extra_es[i]->id )
+                es_out_Del( out, pid->extra_es[i]->id );
+
+            if( pid->extra_es[i]->p_pes )
+                block_ChainRelease( pid->extra_es[i]->p_pes );
+
+            es_format_Clean( &pid->extra_es[i]->fmt );
+
+            free( pid->extra_es[i] );
+        }
+        if( pid->i_extra_es ) free( pid->extra_es );
+    }
+
+    pid->b_valid = VLC_FALSE;
+}
+
 /****************************************************************************
  * gathering stuff
  ****************************************************************************/
-static void ParsePES ( demux_t *p_demux, ts_pid_t *pid )
+static void ParsePES( demux_t *p_demux, ts_pid_t *pid )
 {
     block_t *p_pes = pid->es->p_pes;
     uint8_t header[30];
-    int     i_pes_size;
+    int     i_pes_size = 0;
     int     i_skip = 0;
     mtime_t i_dts = -1;
     mtime_t i_pts = -1;
+    mtime_t i_length = 0;
     int i_max;
 
     /* remove the pes from pid */
     pid->es->p_pes = NULL;
+    pid->es->i_pes_size= 0;
+    pid->es->i_pes_gathered= 0;
+    pid->es->pp_last = &pid->es->p_pes;
 
     /* FIXME find real max size */
     i_max = block_ChainExtract( p_pes, header, 30 );
 
+
     if( header[0] != 0 || header[1] != 0 || header[2] != 1 )
     {
-        msg_Err( p_demux, "invalid header [0x%x:%x:%x:%x]", header[0], header[1],header[2],header[3] );
+        if( !p_demux->p_sys->b_silent )
+            msg_Warn( p_demux, "invalid header [0x%x:%x:%x:%x] (pid: %d)",
+                      header[0], header[1],header[2],header[3], pid->i_pid );
         block_ChainRelease( p_pes );
         return;
     }
 
-    i_pes_size = (header[4] << 8)|header[5];
-
     /* TODO check size */
-
     switch( header[3] )
     {
         case 0xBC:  /* Program stream map */
@@ -637,7 +1133,7 @@ static void ParsePES ( demux_t *p_demux, ts_pid_t *pid )
                              (mtime_t)(header[10] << 22)|
                             ((mtime_t)(header[11]&0xfe) << 14)|
                              (mtime_t)(header[12] << 7)|
-                             (mtime_t)(header[12] >> 1);
+                             (mtime_t)(header[13] >> 1);
 
                     if( header[7]&0x40 )    /* has dts */
                     {
@@ -669,19 +1165,19 @@ static void ParsePES ( demux_t *p_demux, ts_pid_t *pid )
 
                 if(  header[i_skip]&0x20 )
                 {
-                     p_pes->i_pts = ((mtime_t)(header[i_skip]&0x0e ) << 29)|
-                                     (mtime_t)(header[i_skip+1] << 22)|
-                                    ((mtime_t)(header[i_skip+2]&0xfe) << 14)|
-                                     (mtime_t)(header[i_skip+3] << 7)|
-                                     (mtime_t)(header[i_skip+4] >> 1);
+                     i_pts = ((mtime_t)(header[i_skip]&0x0e ) << 29)|
+                              (mtime_t)(header[i_skip+1] << 22)|
+                             ((mtime_t)(header[i_skip+2]&0xfe) << 14)|
+                              (mtime_t)(header[i_skip+3] << 7)|
+                              (mtime_t)(header[i_skip+4] >> 1);
 
                     if( header[i_skip]&0x10 )    /* has dts */
                     {
-                         p_pes->i_dts = ((mtime_t)(header[i_skip+5]&0x0e ) << 29)|
-                                         (mtime_t)(header[i_skip+6] << 22)|
-                                        ((mtime_t)(header[i_skip+7]&0xfe) << 14)|
-                                         (mtime_t)(header[i_skip+8] << 7)|
-                                         (mtime_t)(header[i_skip+9] >> 1);
+                         i_dts = ((mtime_t)(header[i_skip+5]&0x0e ) << 29)|
+                                  (mtime_t)(header[i_skip+6] << 22)|
+                                 ((mtime_t)(header[i_skip+7]&0xfe) << 14)|
+                                  (mtime_t)(header[i_skip+8] << 7)|
+                                  (mtime_t)(header[i_skip+9] >> 1);
                          i_skip += 10;
                     }
                     else
@@ -708,6 +1204,30 @@ static void ParsePES ( demux_t *p_demux, ts_pid_t *pid )
     {
         i_skip += 1;
     }
+    else if( pid->es->fmt.i_codec == VLC_FOURCC( 's', 'u', 'b', 't' ) &&
+             pid->es->p_mpeg4desc )
+    {
+        decoder_config_descriptor_t *dcd = &pid->es->p_mpeg4desc->dec_descr;
+
+        if( dcd->i_decoder_specific_info_len > 2 &&
+            dcd->p_decoder_specific_info[0] == 0x10 &&
+            ( dcd->p_decoder_specific_info[1]&0x10 ) )
+        {
+            /* display length */
+            if( p_pes->i_buffer + 2 <= i_skip )
+            {
+                i_length = GetWBE( &p_pes->p_buffer[i_skip] );
+            }
+
+            i_skip += 2;
+        }
+        if( p_pes->i_buffer + 2 <= i_skip )
+        {
+            i_pes_size = GetWBE( &p_pes->p_buffer[i_skip] );
+        }
+        /* */
+        i_skip += 2;
+    }
 
     /* skip header */
     while( p_pes && i_skip > 0 )
@@ -727,8 +1247,16 @@ static void ParsePES ( demux_t *p_demux, ts_pid_t *pid )
             break;
         }
     }
+
+    /* ISO/IEC 13818-1 2.7.5: if no pts and no dts, then dts == pts */
+    if( i_pts >= 0 && i_dts < 0 )
+        i_dts = i_pts;
+
     if( p_pes )
     {
+        block_t *p_block;
+        int i;
+
         if( i_dts >= 0 )
         {
             p_pes->i_dts = i_dts * 100 / 9;
@@ -737,56 +1265,130 @@ static void ParsePES ( demux_t *p_demux, ts_pid_t *pid )
         {
             p_pes->i_pts = i_pts * 100 / 9;
         }
-        es_out_Send( p_demux->out, pid->es->id, p_pes );
-    }
-    else
-    {
-        msg_Warn( p_demux, "empty pes" );
+        p_pes->i_length = i_length * 100 / 9;
+
+        p_block = block_ChainGather( p_pes );
+        if( pid->es->fmt.i_codec == VLC_FOURCC( 's', 'u', 'b', 't' ) )
+        {
+            if( i_pes_size > 0 && p_block->i_buffer > i_pes_size )
+            {
+                p_block->i_buffer = i_pes_size;
+            }
+            /* Append a \0 */
+            p_block = block_Realloc( p_block, 0, p_block->i_buffer + 1 );
+            p_block->p_buffer[p_block->i_buffer -1] = '\0';
+        }
+
+        for( i = 0; i < pid->i_extra_es; i++ )
+        {
+            es_out_Send( p_demux->out, pid->extra_es[i]->id,
+                         block_Duplicate( p_block ) );
+        }
+
+        es_out_Send( p_demux->out, pid->es->id, p_block );
+    }
+    else
+    {
+        msg_Warn( p_demux, "empty pes" );
+    }
+}
+
+static void PCRHandle( demux_t *p_demux, ts_pid_t *pid, block_t *p_bk )
+{
+    demux_sys_t   *p_sys = p_demux->p_sys;
+    const uint8_t *p = p_bk->p_buffer;
+
+    if( ( p[3]&0x20 ) && /* adaptation */
+        ( p[5]&0x10 ) &&
+        ( p[4] >= 7 ) )
+    {
+        int i;
+        mtime_t i_pcr;  /* 33 bits */
+
+        i_pcr = ( (mtime_t)p[6] << 25 ) |
+                ( (mtime_t)p[7] << 17 ) |
+                ( (mtime_t)p[8] << 9 ) |
+                ( (mtime_t)p[9] << 1 ) |
+                ( (mtime_t)p[10] >> 7 );
+
+        /* Search program and set the PCR */
+        for( i = 0; i < p_sys->i_pmt; i++ )
+        {
+            int i_prg;
+            for( i_prg = 0; i_prg < p_sys->pmt[i]->psi->i_prg; i_prg++ )
+            {
+                if( pid->i_pid == p_sys->pmt[i]->psi->prg[i_prg]->i_pid_pcr )
+                {
+                    es_out_Control( p_demux->out, ES_OUT_SET_GROUP_PCR,
+                                    (int)p_sys->pmt[i]->psi->prg[i_prg]->i_number,
+                                    (int64_t)(i_pcr * 100 / 9) );
+                }
+            }
+        }
     }
-};
+}
 
 static vlc_bool_t GatherPES( demux_t *p_demux, ts_pid_t *pid, block_t *p_bk )
 {
-    uint8_t     *p = p_bk->p_buffer;
+    const uint8_t    *p = p_bk->p_buffer;
+    const vlc_bool_t b_unit_start = p[1]&0x40;
+    const vlc_bool_t b_adaptation = p[3]&0x20;
+    const vlc_bool_t b_payload    = p[3]&0x10;
+    const int        i_cc         = p[3]&0x0f;   /* continuity counter */
 
-    vlc_bool_t  b_unit_start= p[1]&0x40;
-    vlc_bool_t  b_adaptation= p[3]&0x20;
-    vlc_bool_t  b_payload   = p[3]&0x10;
-    int         i_cc = p[3]&0x0f;   /* continuity counter */
     /* transport_scrambling_control is ignored */
 
     int         i_skip = 0;
-    vlc_bool_t  i_ret   = VLC_FALSE;
-
+    vlc_bool_t  i_ret  = VLC_FALSE;
     int         i_diff;
 
-    //msg_Dbg( p_demux, "pid=0x%x unit_start=%d adaptation=%d payload=%d cc=0x%x", i_pid, b_unit_start, b_adaptation, b_payload, i_continuity_counter);
+#if 0
+    msg_Dbg( p_demux, "pid=%d unit_start=%d adaptation=%d payload=%d "
+             "cc=0x%x", pid->i_pid, b_unit_start, b_adaptation,
+             b_payload, i_cc );
+#endif
+
+    /* For now, ignore additional error correction
+     * TODO: handle Reed-Solomon 204,188 error correction */
+    p_bk->i_buffer = TS_PACKET_SIZE_188;
+
     if( p[1]&0x80 )
     {
-        msg_Dbg( p_demux, "transport_error_indicator set (pid=0x%x)", pid->i_pid );
+        msg_Dbg( p_demux, "transport_error_indicator set (pid=%d)",
+                 pid->i_pid );
+    }
+
+    if( p_demux->p_sys->csa )
+    {
+        csa_Decrypt( p_demux->p_sys->csa, p_bk->p_buffer );
     }
 
     if( !b_adaptation )
     {
+        /* We don't have any adaptation_field, so payload starts
+         * immediately after the 4 byte TS header */
         i_skip = 4;
     }
     else
     {
-        /* p[4] is adaptation length */
+        /* p[4] is adaptation_field_length minus one */
         i_skip = 5 + p[4];
         if( p[4] > 0 )
         {
             if( p[5]&0x80 )
             {
-                msg_Warn( p_demux, "discontinuity_indicator (pid=0x%x) ignored", pid->i_pid );
+                msg_Warn( p_demux, "discontinuity_indicator (pid=%d) "
+                          "ignored", pid->i_pid );
             }
         }
     }
-    /* test continuity counter */
+
+    /* Test continuity counter */
     /* continuous when (one of this):
         * diff == 1
         * diff == 0 and payload == 0
-        * diff == 0 and duplicate packet (playload != 0) <- do we should test the content ?
+        * diff == 0 and duplicate packet (playload != 0) <- should we
+        *   test the content ?
      */
 
     i_diff = ( i_cc - pid->i_cc )&0x0f;
@@ -798,7 +1400,8 @@ static vlc_bool_t GatherPES( demux_t *p_demux, ts_pid_t *pid, block_t *p_bk )
     {
         if( pid->i_cc == 0xff )
         {
-            msg_Warn( p_demux, "first packet for pid=0x%x c=0x%x", pid->i_pid, i_cc );
+            msg_Warn( p_demux, "first packet for pid=%d cc=0x%x",
+                      pid->i_pid, i_cc );
             pid->i_cc = i_cc;
         }
         else if( i_diff != 0 )
@@ -809,60 +1412,68 @@ static vlc_bool_t GatherPES( demux_t *p_demux, ts_pid_t *pid, block_t *p_bk )
 
             pid->i_cc = i_cc;
 
-            if( pid->es->p_pes )
+            if( pid->es->p_pes && pid->es->fmt.i_cat != VIDEO_ES )
             {
-                block_ChainRelease( pid->es->p_pes );
-                pid->es->p_pes = NULL;
+                /* Small video artifacts are usually better then
+                 * dropping full frames */
+                pid->es->p_pes->i_flags |= BLOCK_FLAG_CORRUPTED;
             }
         }
     }
 
-    if( b_adaptation &&
-        (p[5] & 0x10) && p[4]>=7 && pid->p_owner && pid->p_owner->i_pid_pcr == pid->i_pid )
-    {
-        mtime_t i_pcr;  /* 33 bits */
-
-        i_pcr = ( (mtime_t)p[6] << 25 ) |
-                ( (mtime_t)p[7] << 17 ) |
-                ( (mtime_t)p[8] << 9 ) |
-                ( (mtime_t)p[9] << 1 ) |
-                ( (mtime_t)p[10] >> 7 );
-
-        es_out_Control( p_demux->out, ES_OUT_SET_GROUP_PCR, (int)pid->p_owner->i_number, (int64_t)(i_pcr * 100 / 9) );
-    }
-
+    PCRHandle( p_demux, pid, p_bk );
 
-    if( i_skip >= 188 || pid->es->id == NULL )
+    if( i_skip >= 188 || pid->es->id == NULL || p_demux->p_sys->b_udp_out )
     {
         block_Release( p_bk );
+        return i_ret;
     }
-    else
+
+    /* We have to gather it */
+    p_bk->p_buffer += i_skip;
+    p_bk->i_buffer -= i_skip;
+
+    if( b_unit_start )
     {
-        /* we have to gather it */
-        p_bk->p_buffer += i_skip;
-        p_bk->i_buffer -= i_skip;
+        if( pid->es->p_pes )
+        {
+            ParsePES( p_demux, pid );
+            i_ret = VLC_TRUE;
+        }
 
-        if( b_unit_start )
+        block_ChainLastAppend( &pid->es->pp_last, p_bk );
+        if( p_bk->i_buffer > 6 )
         {
-            if( pid->es->p_pes )
+            pid->es->i_pes_size = GetWBE( &p_bk->p_buffer[4] );
+            if( pid->es->i_pes_size > 0 )
             {
-                ParsePES( p_demux, pid );
-                i_ret = VLC_TRUE;
+                pid->es->i_pes_size += 6;
             }
-
-            pid->es->p_pes = p_bk;
+        }
+        pid->es->i_pes_gathered += p_bk->i_buffer;
+        if( pid->es->i_pes_size > 0 &&
+            pid->es->i_pes_gathered >= pid->es->i_pes_size )
+        {
+            ParsePES( p_demux, pid );
+            i_ret = VLC_TRUE;
+        }
+    }
+    else
+    {
+        if( pid->es->p_pes == NULL )
+        {
+            /* msg_Dbg( p_demux, "broken packet" ); */
+            block_Release( p_bk );
         }
         else
         {
-            if( pid->es->p_pes == NULL )
-            {
-                /* msg_Dbg( p_demux, "broken packet" ); */
-                block_Release( p_bk );
-            }
-            else
+            block_ChainLastAppend( &pid->es->pp_last, p_bk );
+            pid->es->i_pes_gathered += p_bk->i_buffer;
+            if( pid->es->i_pes_size > 0 &&
+                pid->es->i_pes_gathered >= pid->es->i_pes_size )
             {
-                /* TODO check if when have gather enough packet to form a PES (ie read PES size)*/
-                block_ChainAppend( &pid->es->p_pes, p_bk );
+                ParsePES( p_demux, pid );
+                i_ret = VLC_TRUE;
             }
         }
     }
@@ -870,32 +1481,10 @@ static vlc_bool_t GatherPES( demux_t *p_demux, ts_pid_t *pid, block_t *p_bk )
     return i_ret;
 }
 
-static char *LanguageNameISO639( char *psz_code )
+static int PIDFillFormat( ts_pid_t *pid, int i_stream_type )
 {
-    const iso639_lang_t *pl;
+    es_format_t *fmt = &pid->es->fmt;
 
-    pl = GetLang_2B( psz_code );
-    if( !strcmp( pl->psz_iso639_1, "??" ) )
-    {
-        pl = GetLang_2T( psz_code );
-    }
-
-    if( !strcmp( pl->psz_iso639_1, "??" ) )
-    {
-       return strdup( psz_code );
-    }
-    else
-    {
-        if( *pl->psz_native_name )
-        {
-            return strdup( pl->psz_native_name );
-        }
-        return strdup( pl->psz_eng_name );
-    }
-}
-
-static int ESFillFormat( es_format_t *fmt, int i_stream_type )
-{
     switch( i_stream_type )
     {
         case 0x01:  /* MPEG-1 video */
@@ -913,6 +1502,7 @@ static int ESFillFormat( es_format_t *fmt, int i_stream_type )
             break;
         case 0x10:  /* MPEG4 (video) */
             es_format_Init( fmt, VIDEO_ES, VLC_FOURCC( 'm', 'p', '4', 'v' ) );
+            pid->es->b_gather = VLC_TRUE;
             break;
         case 0x1B:  /* H264 <- check transport syntax/needed descriptor */
             es_format_Init( fmt, VIDEO_ES, VLC_FOURCC( 'h', '2', '6', '4' ) );
@@ -947,18 +1537,26 @@ static int ESFillFormat( es_format_t *fmt, int i_stream_type )
             es_format_Init( fmt, AUDIO_ES, VLC_FOURCC( 's', 'd', 'd', 'b' ) );
             break;
 
-        case 0x06:  /* PES_PRIVATE  (fixed later) */
         case 0xa0:  /* MSCODEC vlc (video) (fixed later) */
+            es_format_Init( fmt, UNKNOWN_ES, 0 );
+            pid->es->b_gather = VLC_TRUE;
+            break;
+
+        case 0x06:  /* PES_PRIVATE  (fixed later) */
+        case 0x12:  /* MPEG-4 generic (sub/scene/...) (fixed later) */
         default:
             es_format_Init( fmt, UNKNOWN_ES, 0 );
             break;
     }
 
+    /* PES packets usually contain truncated frames */
+    fmt->b_packetized = VLC_FALSE;
+
     return fmt->i_cat == UNKNOWN_ES ? VLC_EGENERIC : VLC_SUCCESS ;
 }
 
 /*****************************************************************************
- * MP4 specific functions
+ * MP4 specific functions (IOD parser)
  *****************************************************************************/
 static int  IODDescriptorLength( int *pi_data, uint8_t **pp_data )
 {
@@ -979,38 +1577,32 @@ static int IODGetByte( int *pi_data, uint8_t **pp_data )
 {
     if( *pi_data > 0 )
     {
-        int i_b = **pp_data;
+        const int i_b = **pp_data;
         (*pp_data)++;
         (*pi_data)--;
         return( i_b );
     }
-    else
-    {
-        return( 0 );
-    }
+    return( 0 );
 }
-
-static int MP4_GetWord( int *pi_data, uint8_t **pp_data )
+static int IODGetWord( int *pi_data, uint8_t **pp_data )
 {
-    int i1, i2;
-    i1 = IODGetByte( pi_data, pp_data );
-    i2 = IODGetByte( pi_data, pp_data );
+    const int i1 = IODGetByte( pi_data, pp_data );
+    const int i2 = IODGetByte( pi_data, pp_data );
     return( ( i1 << 8 ) | i2 );
 }
 static int IODGet3Bytes( int *pi_data, uint8_t **pp_data )
 {
-    int i1, i2, i3;
-    i1 = IODGetByte( pi_data, pp_data );
-    i2 = IODGetByte( pi_data, pp_data );
-    i3 = IODGetByte( pi_data, pp_data );
+    const int i1 = IODGetByte( pi_data, pp_data );
+    const int i2 = IODGetByte( pi_data, pp_data );
+    const int i3 = IODGetByte( pi_data, pp_data );
+
     return( ( i1 << 16 ) | ( i2 << 8) | i3 );
 }
 
-static uint32_t IODGetWord( int *pi_data, uint8_t **pp_data )
+static uint32_t IODGetDWord( int *pi_data, uint8_t **pp_data )
 {
-    uint32_t i1, i2;
-    i1 = MP4_GetWord( pi_data, pp_data );
-    i2 = MP4_GetWord( pi_data, pp_data );
+    const uint32_t i1 = IODGetWord( pi_data, pp_data );
+    const uint32_t i2 = IODGetWord( pi_data, pp_data );
     return( ( i1 << 16 ) | i2 );
 }
 
@@ -1128,7 +1720,7 @@ static iod_descriptor_t *IODNew( int i_data, uint8_t *p_data )
                     fprintf( stderr, "\n* - ES_Descriptor length:%d", i_length );
                     es_descr.b_ok = 1;
 
-                    es_descr.i_es_id = MP4_GetWord( &i_data, &p_data );
+                    es_descr.i_es_id = IODGetWord( &i_data, &p_data );
                     i_flags = IODGetByte( &i_data, &p_data );
                     es_descr.b_streamDependenceFlag = ( i_flags >> 7 )&0x01;
                     b_url = ( i_flags >> 6 )&0x01;
@@ -1140,7 +1732,7 @@ static iod_descriptor_t *IODNew( int i_data, uint8_t *p_data )
 
                     if( es_descr.b_streamDependenceFlag )
                     {
-                        es_descr.i_dependOn_es_id = MP4_GetWord( &i_data, &p_data );
+                        es_descr.i_dependOn_es_id = IODGetWord( &i_data, &p_data );
                         fprintf( stderr, "\n*   * dependOn_es_id:%d", es_descr.i_dependOn_es_id );
                     }
 
@@ -1156,7 +1748,7 @@ static iod_descriptor_t *IODNew( int i_data, uint8_t *p_data )
 
                     if( es_descr.b_OCRStreamFlag )
                     {
-                        es_descr.i_OCR_es_id = MP4_GetWord( &i_data, &p_data );
+                        es_descr.i_OCR_es_id = IODGetWord( &i_data, &p_data );
                         fprintf( stderr, "\n*   * OCR_es_id:%d", es_descr.i_OCR_es_id );
                     }
 
@@ -1175,8 +1767,8 @@ static iod_descriptor_t *IODNew( int i_data, uint8_t *p_data )
                     dec_descr.i_streamType = i_flags >> 2;
                     dec_descr.b_upStream = ( i_flags >> 1 )&0x01;
                     dec_descr.i_bufferSizeDB = IODGet3Bytes( &i_data, &p_data );
-                    dec_descr.i_maxBitrate = IODGetWord( &i_data, &p_data );
-                    dec_descr.i_avgBitrate = IODGetWord( &i_data, &p_data );
+                    dec_descr.i_maxBitrate = IODGetDWord( &i_data, &p_data );
+                    dec_descr.i_avgBitrate = IODGetDWord( &i_data, &p_data );
                     fprintf( stderr, "\n*     * objectTypeIndication:0x%x", dec_descr.i_objectTypeIndication  );
                     fprintf( stderr, "\n*     * streamType:0x%x", dec_descr.i_streamType );
                     fprintf( stderr, "\n*     * upStream:%d", dec_descr.b_upStream );
@@ -1322,6 +1914,27 @@ static void IODFree( iod_descriptor_t *p_iod )
  ** libdvbpsi callbacks
  ****************************************************************************
  ****************************************************************************/
+static vlc_bool_t DVBProgramIsSelected( demux_t *p_demux, uint16_t i_pgrm )
+{
+    demux_sys_t          *p_sys = p_demux->p_sys;
+
+    if ( !p_sys->b_dvb_control ) return VLC_FALSE;
+    if ( p_sys->i_dvb_program == -1 && p_sys->p_programs_list == NULL )
+        return VLC_TRUE;
+    if ( p_sys->i_dvb_program == i_pgrm ) return VLC_TRUE;
+
+    if ( p_sys->p_programs_list != NULL )
+    {
+        int i;
+        for ( i = 0; i < p_sys->p_programs_list->i_count; i++ )
+        {
+            if ( i_pgrm == p_sys->p_programs_list->p_values[i].i_int )
+                return VLC_TRUE;
+        }
+    }
+    return VLC_FALSE;
+}
+
 static void PMTCallBack( demux_t *p_demux, dvbpsi_pmt_t *p_pmt )
 {
     demux_sys_t          *p_sys = p_demux->p_sys;
@@ -1329,17 +1942,30 @@ static void PMTCallBack( demux_t *p_demux, dvbpsi_pmt_t *p_pmt )
     dvbpsi_pmt_es_t      *p_es;
 
     ts_pid_t             *pmt = NULL;
-    int                  i;
+    ts_prg_psi_t         *prg = NULL;
+
+    ts_pid_t             **pp_clean = NULL;
+    int                  i_clean = 0, i;
 
     msg_Dbg( p_demux, "PMTCallBack called" );
+
     /* First find this PMT declared in PAT */
     for( i = 0; i < p_sys->i_pmt; i++ )
     {
-        if( p_sys->pmt[i]->psi->i_number == p_pmt->i_program_number )
+        int i_prg;
+        for( i_prg = 0; i_prg < p_sys->pmt[i]->psi->i_prg; i_prg++ )
         {
-            pmt = p_sys->pmt[i];
+            if( p_sys->pmt[i]->psi->prg[i_prg]->i_number ==
+                p_pmt->i_program_number )
+            {
+                pmt = p_sys->pmt[i];
+                prg = p_sys->pmt[i]->psi->prg[i_prg];
+                break;
+            }
         }
+        if( pmt ) break;
     }
+
     if( pmt == NULL )
     {
         msg_Warn( p_demux, "unreferenced program (broken stream)" );
@@ -1347,7 +1973,8 @@ static void PMTCallBack( demux_t *p_demux, dvbpsi_pmt_t *p_pmt )
         return;
     }
 
-    if( pmt->psi->i_version != -1 && ( !p_pmt->b_current_next || pmt->psi->i_version == p_pmt->i_version ) )
+    if( prg->i_version != -1 &&
+        ( !p_pmt->b_current_next || prg->i_version == p_pmt->i_version ) )
     {
         dvbpsi_DeletePMT( p_pmt );
         return;
@@ -1358,28 +1985,36 @@ static void PMTCallBack( demux_t *p_demux, dvbpsi_pmt_t *p_pmt )
     {
         ts_pid_t *pid = &p_sys->pid[i];
 
-        if( pid->b_valid && pid->p_owner == pmt->psi && pid->psi == NULL )
+        if( pid->b_valid && pid->p_owner == pmt->psi &&
+            pid->i_owner_number == prg->i_number && pid->psi == NULL )
         {
-            pid->b_valid = VLC_FALSE;
-            if( pid->es->id )
-            {
-                es_out_Del( p_demux->out, pid->es->id );
-            }
-            if( pid->es->p_pes )
-            {
-                block_ChainRelease( pid->es->p_pes );
-            }
+            TAB_APPEND( i_clean, pp_clean, pid );
         }
     }
-    if( pmt->psi->iod )
+    if( prg->iod )
     {
-        IODFree( pmt->psi->iod );
-        pmt->psi->iod = NULL;
+        IODFree( prg->iod );
+        prg->iod = NULL;
     }
 
-    msg_Dbg( p_demux, "New PMT program number=%d version=%d pid_pcr=0x%x", p_pmt->i_program_number, p_pmt->i_version, p_pmt->i_pcr_pid );
-    pmt->psi->i_pid_pcr = p_pmt->i_pcr_pid;
-    pmt->psi->i_version = p_pmt->i_version;
+    msg_Dbg( p_demux, "new PMT program number=%d version=%d pid_pcr=%d",
+             p_pmt->i_program_number, p_pmt->i_version, p_pmt->i_pcr_pid );
+    prg->i_pid_pcr = p_pmt->i_pcr_pid;
+    prg->i_version = p_pmt->i_version;
+
+    if( DVBProgramIsSelected( p_demux, prg->i_number ) )
+    {
+        /* Set demux filter */
+        stream_Control( p_demux->s, STREAM_CONTROL_ACCESS,
+                        ACCESS_SET_PRIVATE_ID_STATE, prg->i_pid_pcr,
+                        VLC_TRUE );
+    }
+    else if ( p_sys->b_dvb_control )
+    {
+        msg_Warn( p_demux, "skipping program (not selected)" );
+        dvbpsi_DeletePMT(p_pmt);
+        return;
+    }
 
     /* Parse descriptor */
     for( p_dr = p_pmt->p_first_descriptor; p_dr != NULL; p_dr = p_dr->p_next )
@@ -1387,26 +2022,51 @@ static void PMTCallBack( demux_t *p_demux, dvbpsi_pmt_t *p_pmt )
         if( p_dr->i_tag == 0x1d )
         {
             /* We have found an IOD descriptor */
-            msg_Warn( p_demux, "found IOD descriptor" );
+            msg_Dbg( p_demux, " * descriptor : IOD (0x1d)" );
 
-            pmt->psi->iod = IODNew( p_dr->i_length, p_dr->p_data );
+            prg->iod = IODNew( p_dr->i_length, p_dr->p_data );
+        }
+        else if( p_dr->i_tag == 0x9 )
+        {
+            uint16_t i_sysid = ((uint16_t)p_dr->p_data[0] << 8)
+                                | p_dr->p_data[1];
+            msg_Dbg( p_demux, " * descriptor : CA (0x9) SysID 0x%x", i_sysid );
+        }
+        else
+        {
+            msg_Dbg( p_demux, " * descriptor : unknown (0x%x)", p_dr->i_tag );
         }
     }
 
     for( p_es = p_pmt->p_first_es; p_es != NULL; p_es = p_es->p_next )
     {
-        ts_pid_t *pid = &p_sys->pid[p_es->i_pid];
+        ts_pid_t tmp_pid, *old_pid = 0, *pid = &tmp_pid;
 
-        if( pid->b_valid )
+        /* Find out if the PID was already declared */
+        for( i = 0; i < i_clean; i++ )
         {
-            msg_Warn( p_demux, "pmt error: pid=0x%x already defined", p_es->i_pid );
+            if( pp_clean[i] == &p_sys->pid[p_es->i_pid] )
+            {
+                old_pid = pp_clean[i];
+                break;
+            }
+        }
+
+        if( !old_pid && p_sys->pid[p_es->i_pid].b_valid )
+        {
+            msg_Warn( p_demux, "pmt error: pid=%d already defined",
+                      p_es->i_pid );
             continue;
         }
 
         PIDInit( pid, VLC_FALSE, pmt->psi );
-        ESFillFormat( &pid->es->fmt, p_es->i_type );
+        PIDFillFormat( pid, p_es->i_type );
+        pid->i_owner_number = prg->i_number;
+        pid->i_pid          = p_es->i_pid;
+        pid->b_seen         = p_sys->pid[p_es->i_pid].b_seen;
 
-        if( p_es->i_type == 0x10 || p_es->i_type == 0x11 )
+        if( p_es->i_type == 0x10 || p_es->i_type == 0x11 ||
+            p_es->i_type == 0x12 )
         {
             /* MPEG-4 stream: search SL_DESCRIPTOR */
             dvbpsi_descriptor_t *p_dr = p_es->p_first_descriptor;;
@@ -1415,7 +2075,6 @@ static void PMTCallBack( demux_t *p_demux, dvbpsi_pmt_t *p_pmt )
 
             if( p_dr && p_dr->i_length == 2 )
             {
-                int i;
                 int i_es_id = ( p_dr->p_data[0] << 8 ) | p_dr->p_data[1];
 
                 msg_Warn( p_demux, "found SL_descriptor es_id=%d", i_es_id );
@@ -1424,7 +2083,7 @@ static void PMTCallBack( demux_t *p_demux, dvbpsi_pmt_t *p_pmt )
 
                 for( i = 0; i < 255; i++ )
                 {
-                    iod_descriptor_t *iod = pmt->psi->iod;
+                    iod_descriptor_t *iod = prg->iod;
 
                     if( iod->es_descr[i].b_ok &&
                         iod->es_descr[i].i_es_id == i_es_id )
@@ -1437,33 +2096,39 @@ static void PMTCallBack( demux_t *p_demux, dvbpsi_pmt_t *p_pmt )
 
             if( pid->es->p_mpeg4desc != NULL )
             {
-                decoder_config_descriptor_t *dcd = &pid->es->p_mpeg4desc->dec_descr;
+                decoder_config_descriptor_t *dcd =
+                    &pid->es->p_mpeg4desc->dec_descr;
 
                 if( dcd->i_streamType == 0x04 )    /* VisualStream */
                 {
                     pid->es->fmt.i_cat = VIDEO_ES;
                     switch( dcd->i_objectTypeIndication )
                     {
-                        case 0x20:
-                            pid->es->fmt.i_codec = VLC_FOURCC('m','p','4','v');    // mpeg4
-                            break;
-                        case 0x60:
-                        case 0x61:
-                        case 0x62:
-                        case 0x63:
-                        case 0x64:
-                        case 0x65:
-                            pid->es->fmt.i_codec = VLC_FOURCC( 'm','p','g','v' );  // mpeg2
-                            break;
-                        case 0x6a:
-                            pid->es->fmt.i_codec = VLC_FOURCC( 'm','p','g','v' );  // mpeg1
-                            break;
-                        case 0x6c:
-                            pid->es->fmt.i_codec = VLC_FOURCC( 'j','p','e','g' );  // mpeg1
-                            break;
+                    case 0x0B: /* mpeg4 sub */
+                        pid->es->fmt.i_cat = SPU_ES;
+                        pid->es->fmt.i_codec = VLC_FOURCC('s','u','b','t');
+                        break;
 
-                        default:
-                            pid->es->fmt.i_cat = UNKNOWN_ES;
+                    case 0x20: /* mpeg4 */
+                        pid->es->fmt.i_codec = VLC_FOURCC('m','p','4','v');
+                        break;
+                    case 0x60:
+                    case 0x61:
+                    case 0x62:
+                    case 0x63:
+                    case 0x64:
+                    case 0x65: /* mpeg2 */
+                        pid->es->fmt.i_codec = VLC_FOURCC( 'm','p','g','v' );
+                        break;
+                    case 0x6a: /* mpeg1 */
+                        pid->es->fmt.i_codec = VLC_FOURCC( 'm','p','g','v' );
+                        break;
+                    case 0x6c: /* mpeg1 */
+                        pid->es->fmt.i_codec = VLC_FOURCC( 'j','p','e','g' );
+                        break;
+                    default:
+                        pid->es->fmt.i_cat = UNKNOWN_ES;
+                        break;
                     }
                 }
                 else if( dcd->i_streamType == 0x05 )    /* AudioStream */
@@ -1471,22 +2136,23 @@ static void PMTCallBack( demux_t *p_demux, dvbpsi_pmt_t *p_pmt )
                     pid->es->fmt.i_cat = AUDIO_ES;
                     switch( dcd->i_objectTypeIndication )
                     {
-                        case 0x40:
-                            pid->es->fmt.i_codec = VLC_FOURCC('m','p','4','a');    // mpeg4
-                            break;
-                        case 0x66:
-                        case 0x67:
-                        case 0x68:
-                            pid->es->fmt.i_codec = VLC_FOURCC('m','p','4','a');// mpeg2 aac
-                            break;
-                        case 0x69:
-                            pid->es->fmt.i_codec = VLC_FOURCC('m','p','g','a');    // mpeg2
-                            break;
-                        case 0x6b:
-                            pid->es->fmt.i_codec = VLC_FOURCC('m','p','g','a');    // mpeg1
-                            break;
-                        default:
-                            pid->es->fmt.i_cat = UNKNOWN_ES;
+                    case 0x40: /* mpeg4 */
+                        pid->es->fmt.i_codec = VLC_FOURCC('m','p','4','a');
+                        break;
+                    case 0x66:
+                    case 0x67:
+                    case 0x68: /* mpeg2 aac */
+                        pid->es->fmt.i_codec = VLC_FOURCC('m','p','4','a');
+                        break;
+                    case 0x69: /* mpeg2 */
+                        pid->es->fmt.i_codec = VLC_FOURCC('m','p','g','a');
+                        break;
+                    case 0x6b: /* mpeg1 */
+                        pid->es->fmt.i_codec = VLC_FOURCC('m','p','g','a');
+                        break;
+                    default:
+                        pid->es->fmt.i_cat = UNKNOWN_ES;
+                        break;
                     }
                 }
                 else
@@ -1511,48 +2177,196 @@ static void PMTCallBack( demux_t *p_demux, dvbpsi_pmt_t *p_pmt )
         {
             dvbpsi_descriptor_t *p_dr;
 
-            for( p_dr = p_es->p_first_descriptor; p_dr != NULL; p_dr = p_dr->p_next )
+            for( p_dr = p_es->p_first_descriptor; p_dr != NULL;
+                 p_dr = p_dr->p_next )
             {
-                if( p_dr->i_tag == 0x6a )
+                msg_Dbg( p_demux, "  * es pid=%d type=%d dr->i_tag=0x%x",
+                         p_es->i_pid, p_es->i_type, p_dr->i_tag );
+
+                if( p_dr->i_tag == 0x05 )
+                {
+                    /* Registration Descriptor */
+                    if( p_dr->i_length != 4 )
+                    {
+                        msg_Warn( p_demux, "invalid Registration Descriptor" );
+                    }
+                    else
+                    {
+                        if( !memcmp( p_dr->p_data, "AC-3", 4 ) )
+                        {
+                            /* ATSC with stream_type 0x81 (but this descriptor
+                             * is then not mandatory */
+                            pid->es->fmt.i_cat = AUDIO_ES;
+                            pid->es->fmt.i_codec = VLC_FOURCC('a','5','2',' ');
+                        }
+                        else if( !memcmp( p_dr->p_data, "DTS1", 4 ) ||
+                                 !memcmp( p_dr->p_data, "DTS2", 4 ) ||
+                                 !memcmp( p_dr->p_data, "DTS3", 4 ) )
+                        {
+                           /*registration descriptor(ETSI TS 101 154 Annex F)*/
+                            pid->es->fmt.i_cat = AUDIO_ES;
+                            pid->es->fmt.i_codec = VLC_FOURCC('d','t','s',' ');
+                        }
+                        else if( !memcmp( p_dr->p_data, "BSSD", 4 ) )
+                        {
+                            pid->es->fmt.i_cat = AUDIO_ES;
+                            pid->es->fmt.i_codec = VLC_FOURCC('l','p','c','m');
+                        }
+                        else
+                        {
+                            msg_Warn( p_demux,
+                                      "unknown Registration Descriptor (%4.4s)",
+                                      p_dr->p_data );
+                        }
+                    }
+
+                }
+                else if( p_dr->i_tag == 0x6a )
                 {
+                    /* DVB with stream_type 0x06 */
                     pid->es->fmt.i_cat = AUDIO_ES;
                     pid->es->fmt.i_codec = VLC_FOURCC( 'a', '5', '2', ' ' );
                 }
+                else if( p_dr->i_tag == 0x73 )
+                {
+                    /* DTS audio descriptor (ETSI TS 101 154 Annex F) */
+                    msg_Dbg( p_demux, "   * DTS audio descriptor not decoded" );
+                    pid->es->fmt.i_cat = AUDIO_ES;
+                    pid->es->fmt.i_codec = VLC_FOURCC( 'd', 't', 's', ' ' );
+                }
+                else if( p_dr->i_tag == 0x45 )
+                {
+                    msg_Dbg( p_demux, "   * VBI Data descriptor" );
+                    pid->es->fmt.i_cat = SPU_ES;
+                    pid->es->fmt.i_codec = VLC_FOURCC( 'v', 'b', 'i', 'd' );
+                    pid->es->fmt.psz_description = strdup( "VBI Data" );
+                    pid->es->fmt.i_extra = p_dr->i_length;
+                    pid->es->fmt.p_extra = malloc( p_dr->i_length );
+                    memcpy( pid->es->fmt.p_extra, p_dr->p_data,
+                            p_dr->i_length );
+                }
+                else if( p_dr->i_tag == 0x46 )
+                {
+                    msg_Dbg( p_demux, "  * VBI Teletext descriptor" );
+                    pid->es->fmt.i_cat = SPU_ES;
+                    pid->es->fmt.i_codec = VLC_FOURCC( 'v', 'b', 'i', 't' );
+                    pid->es->fmt.psz_description = strdup( "VBI Teletext" );
+                    pid->es->fmt.i_extra = p_dr->i_length;
+                    pid->es->fmt.p_extra = malloc( p_dr->i_length );
+                    memcpy( pid->es->fmt.p_extra, p_dr->p_data,
+                            p_dr->i_length );
+                }
+                else if( p_dr->i_tag == 0x56 )
+                {
+                    msg_Dbg( p_demux, "   * EBU Teletext descriptor" );
+                    pid->es->fmt.i_cat = SPU_ES;
+                    pid->es->fmt.i_codec = VLC_FOURCC( 't', 'e', 'l', 'x' );
+                    pid->es->fmt.psz_description = strdup( "Teletext" );
+                    pid->es->fmt.i_extra = p_dr->i_length;
+                    pid->es->fmt.p_extra = malloc( p_dr->i_length );
+                    memcpy( pid->es->fmt.p_extra, p_dr->p_data,
+                            p_dr->i_length );
+                }
 #ifdef _DVBPSI_DR_59_H_
                 else if( p_dr->i_tag == 0x59 )
                 {
-                    /* DVB subtitle */
-                    /* TODO */
+                    uint16_t n;
+                    dvbpsi_subtitling_dr_t *sub;
+
+                    /* DVB subtitles */
+                    pid->es->fmt.i_cat = SPU_ES;
+                    pid->es->fmt.i_codec = VLC_FOURCC( 'd', 'v', 'b', 's' );
+                    pid->es->fmt.i_group = p_pmt->i_program_number;
+
+                    sub = dvbpsi_DecodeSubtitlingDr( p_dr );
+                    if( !sub ) continue;
+
+                    /* Each subtitle ES contains n languages,
+                     * We are going to create n ES for the n tracks */
+                    if( sub->i_subtitles_number > 0 )
+                    {
+                        pid->es->fmt.psz_language = malloc( 4 );
+                        memcpy( pid->es->fmt.psz_language,
+                                sub->p_subtitle[0].i_iso6392_language_code, 3);
+                        pid->es->fmt.psz_language[3] = 0;
+
+                        pid->es->fmt.subs.dvb.i_id =
+                            sub->p_subtitle[0].i_composition_page_id;
+                        /* Hack, FIXME */
+                        pid->es->fmt.subs.dvb.i_id |=
+                          ((int)sub->p_subtitle[0].i_ancillary_page_id << 16);
+                    }
+                    else pid->es->fmt.i_cat = UNKNOWN_ES;
+
+                    for( n = 1; n < sub->i_subtitles_number; n++ )
+                    {
+                        ts_es_t *p_es = malloc( sizeof( ts_es_t ) );
+                        p_es->fmt = pid->es->fmt;
+                        p_es->id = NULL;
+                        p_es->p_pes = NULL;
+                        p_es->i_pes_size = 0;
+                        p_es->i_pes_gathered = 0;
+                        p_es->pp_last = &p_es->p_pes;
+                        p_es->p_mpeg4desc = NULL;
+
+                        p_es->fmt.psz_language = malloc( 4 );
+                        memcpy( p_es->fmt.psz_language,
+                                sub->p_subtitle[n].i_iso6392_language_code, 3);
+                        p_es->fmt.psz_language[3] = 0;
+
+                        p_es->fmt.subs.dvb.i_id =
+                            sub->p_subtitle[n].i_composition_page_id;
+                        /* Hack, FIXME */
+                        p_es->fmt.subs.dvb.i_id |=
+                          ((int)sub->p_subtitle[n].i_ancillary_page_id << 16);
+
+                        TAB_APPEND( pid->i_extra_es, pid->extra_es, p_es );
+                    }
                 }
-#endif
+#endif /* _DVBPSI_DR_59_H_ */
             }
         }
         else if( p_es->i_type == 0xa0 )
         {
-            /* MSCODEC send by vlc */
-            dvbpsi_descriptor_t *p_dr = p_es->p_first_descriptor;;
+            /* MSCODEC sent by vlc */
+            dvbpsi_descriptor_t *p_dr = p_es->p_first_descriptor;
 
             while( p_dr && ( p_dr->i_tag != 0xa0 ) ) p_dr = p_dr->p_next;
 
             if( p_dr && p_dr->i_length >= 8 )
             {
-                pid->es->fmt.i_codec = VLC_FOURCC( p_dr->p_data[0], p_dr->p_data[1],
-                                                   p_dr->p_data[2], p_dr->p_data[3] );
-                pid->es->fmt.i_extra = (p_dr->p_data[8] << 8) | p_dr->p_data[9];
+                pid->es->fmt.i_cat = VIDEO_ES;
+                pid->es->fmt.i_codec =
+                    VLC_FOURCC( p_dr->p_data[0], p_dr->p_data[1],
+                                p_dr->p_data[2], p_dr->p_data[3] );
+                pid->es->fmt.video.i_width =
+                    ( p_dr->p_data[4] << 8 ) | p_dr->p_data[5];
+                pid->es->fmt.video.i_height =
+                    ( p_dr->p_data[6] << 8 ) | p_dr->p_data[7];
+                pid->es->fmt.i_extra = 
+                    (p_dr->p_data[8] << 8) | p_dr->p_data[9];
 
                 if( pid->es->fmt.i_extra > 0 )
                 {
                     pid->es->fmt.p_extra = malloc( pid->es->fmt.i_extra );
-                    memcpy( pid->es->fmt.p_extra, &p_dr->p_data[10], pid->es->fmt.i_extra );
+                    memcpy( pid->es->fmt.p_extra, &p_dr->p_data[10],
+                            pid->es->fmt.i_extra );
                 }
             }
             else
             {
-                msg_Warn( p_demux, "private MSCODEC (vlc) without bih private descriptor" );
+                msg_Warn( p_demux, "private MSCODEC (vlc) without bih private "
+                          "descriptor" );
             }
+            /* For such stream we will gather them ourself and don't launch a
+             * packetizer.
+             * Yes it's ugly but it's the only way to have DIV3 working */
+            pid->es->fmt.b_packetized = VLC_TRUE;
         }
 
-        if( pid->es->fmt.i_cat == AUDIO_ES || pid->es->fmt.i_cat == SPU_ES )
+        if( pid->es->fmt.i_cat == AUDIO_ES ||
+            ( pid->es->fmt.i_cat == SPU_ES &&
+              pid->es->fmt.i_codec != VLC_FOURCC('d','v','b','s') ) )
         {
             /* get language descriptor */
             dvbpsi_descriptor_t *p_dr = p_es->p_first_descriptor;
@@ -1561,23 +2375,121 @@ static void PMTCallBack( demux_t *p_demux, dvbpsi_pmt_t *p_pmt )
             if( p_dr )
             {
                 dvbpsi_iso639_dr_t *p_decoded = dvbpsi_DecodeISO639Dr( p_dr );
-                pid->es->fmt.psz_language =
-                    LanguageNameISO639( (char*)&p_decoded->i_iso_639_code );
+
+                if( p_decoded )
+                {
+                    pid->es->fmt.psz_language = malloc( 4 );
+                    memcpy( pid->es->fmt.psz_language,
+                            p_decoded->i_iso_639_code, 3 );
+                    pid->es->fmt.psz_language[3] = 0;
+                }
             }
         }
 
         pid->es->fmt.i_group = p_pmt->i_program_number;
         if( pid->es->fmt.i_cat == UNKNOWN_ES )
         {
-            msg_Dbg( p_demux, "  * es pid=0x%x type=0x%x *unknown*", p_es->i_pid, p_es->i_type );
+            msg_Dbg( p_demux, "  * es pid=%d type=%d *unknown*",
+                     p_es->i_pid, p_es->i_type );
         }
-        else
+        else if( !p_sys->b_udp_out )
+        {
+            msg_Dbg( p_demux, "  * es pid=%d type=%d fcc=%4.4s",
+                     p_es->i_pid, p_es->i_type, (char*)&pid->es->fmt.i_codec );
+
+            if( p_sys->b_es_id_pid ) pid->es->fmt.i_id = p_es->i_pid;
+
+            /* Check if we can avoid restarting the ES */
+            if( old_pid &&
+                pid->es->fmt.i_codec == old_pid->es->fmt.i_codec &&
+                pid->es->fmt.i_extra == old_pid->es->fmt.i_extra &&
+                pid->es->fmt.i_extra == 0 &&
+                pid->i_extra_es == old_pid->i_extra_es &&
+                ( ( !pid->es->fmt.psz_language &&
+                    !old_pid->es->fmt.psz_language ) ||
+                  ( pid->es->fmt.psz_language &&
+                    old_pid->es->fmt.psz_language &&
+                    !strcmp( pid->es->fmt.psz_language,
+                             old_pid->es->fmt.psz_language ) ) ) )
+            {
+                pid->es->id = old_pid->es->id;
+                old_pid->es->id = NULL;
+                for( i = 0; i < pid->i_extra_es; i++ )
+                {
+                    pid->extra_es[i]->id = old_pid->extra_es[i]->id;
+                    old_pid->extra_es[i]->id = NULL;
+                }
+            }
+            else
+            {
+                if( old_pid )
+                {
+                    PIDClean( p_demux->out, old_pid );
+                    TAB_REMOVE( i_clean, pp_clean, old_pid );
+                    old_pid = 0;
+                }
+
+                pid->es->id = es_out_Add( p_demux->out, &pid->es->fmt );
+                for( i = 0; i < pid->i_extra_es; i++ )
+                {
+                    pid->extra_es[i]->id =
+                        es_out_Add( p_demux->out, &pid->extra_es[i]->fmt );
+                }
+            }
+        }
+
+        /* Add ES to the list */
+        if( old_pid )
+        {
+            PIDClean( p_demux->out, old_pid );
+            TAB_REMOVE( i_clean, pp_clean, old_pid );
+        }
+        p_sys->pid[p_es->i_pid] = *pid;
+
+        for( p_dr = p_es->p_first_descriptor; p_dr != NULL;
+             p_dr = p_dr->p_next )
+        {
+            if( p_dr->i_tag == 0x9 )
+            {
+                uint16_t i_sysid = ((uint16_t)p_dr->p_data[0] << 8)
+                                    | p_dr->p_data[1];
+                msg_Dbg( p_demux, "   * descriptor : CA (0x9) SysID 0x%x",
+                         i_sysid );
+            }
+        }
+
+        if( DVBProgramIsSelected( p_demux, prg->i_number ) )
+        {
+            /* Set demux filter */
+            stream_Control( p_demux->s, STREAM_CONTROL_ACCESS,
+                            ACCESS_SET_PRIVATE_ID_STATE, p_es->i_pid,
+                            VLC_TRUE );
+        }
+    }
+
+    if( DVBProgramIsSelected( p_demux, prg->i_number ) )
+    {
+        /* Set CAM descrambling */
+        stream_Control( p_demux->s, STREAM_CONTROL_ACCESS,
+                        ACCESS_SET_PRIVATE_ID_CA, p_pmt );
+    }
+    else
+    {
+        dvbpsi_DeletePMT( p_pmt );
+    }
+
+    for ( i = 0; i < i_clean; i++ )
+    {
+        if( DVBProgramIsSelected( p_demux, prg->i_number ) )
         {
-            msg_Dbg( p_demux, "  * es pid=0x%x type=0x%x fcc=%4.4s", p_es->i_pid, p_es->i_type, (char*)&pid->es->fmt.i_codec );
-            pid->es->id = es_out_Add( p_demux->out, &pid->es->fmt );
+            stream_Control( p_demux->s, STREAM_CONTROL_ACCESS,
+                            ACCESS_SET_PRIVATE_ID_STATE, pp_clean[i]->i_pid,
+                            VLC_FALSE );
         }
+
+        PIDClean( p_demux->out, pp_clean[i] );
     }
-    dvbpsi_DeletePMT(p_pmt);
+    if( i_clean ) free( pp_clean );
 }
 
 static void PATCallBack( demux_t *p_demux, dvbpsi_pat_t *p_pat )
@@ -1585,65 +2497,169 @@ static void PATCallBack( demux_t *p_demux, dvbpsi_pat_t *p_pat )
     demux_sys_t          *p_sys = p_demux->p_sys;
     dvbpsi_pat_program_t *p_program;
     ts_pid_t             *pat = &p_sys->pid[0];
-    int                  i;
+    int                  i, j;
 
     msg_Dbg( p_demux, "PATCallBack called" );
 
-    if( pat->psi->i_version != -1 && ( !p_pat->b_current_next || p_pat->i_version == pat->psi->i_version ) )
+    if( pat->psi->i_pat_version != -1 &&
+        ( !p_pat->b_current_next ||
+          p_pat->i_version == pat->psi->i_pat_version ) )
     {
         dvbpsi_DeletePAT( p_pat );
         return;
     }
 
-    msg_Dbg( p_demux, "New PAT ts_id=0x%x version=%d current_next=%d", p_pat->i_ts_id, p_pat->i_version, p_pat->b_current_next );
+    msg_Dbg( p_demux, "new PAT ts_id=%d version=%d current_next=%d",
+             p_pat->i_ts_id, p_pat->i_version, p_pat->b_current_next );
 
     /* Clean old */
-    for( i = 2; i < 8192; i++ )
+    if( p_sys->i_pmt > 0 )
     {
-        ts_pid_t *pid = &p_sys->pid[i];
+        int      i_pmt_rm = 0;
+        ts_pid_t **pmt_rm = NULL;
 
-        if( pid->b_valid )
+        /* Search pmt to be deleted */
+        for( i = 0; i < p_sys->i_pmt; i++ )
         {
-            if( pid->psi )
+            ts_pid_t *pmt = p_sys->pmt[i];
+            vlc_bool_t b_keep = VLC_FALSE;
+
+            for( p_program = p_pat->p_first_program; p_program != NULL;
+                 p_program = p_program->p_next )
             {
-                if( pid->p_owner == pat->psi )
+                if( p_program->i_pid == pmt->i_pid )
                 {
-                    dvbpsi_DetachPMT( pid->psi->handle );
-                    if( pid->psi->iod )
+                    int i_prg;
+                    for( i_prg = 0; i_prg < pmt->psi->i_prg; i_prg++ )
                     {
-                        IODFree( pid->psi->iod );
-                        pid->psi->iod = NULL;
+                        if( p_program->i_number ==
+                            pmt->psi->prg[i_prg]->i_number )
+                        {
+                            b_keep = VLC_TRUE;
+                            break;
+                        }
                     }
-                    pid->b_valid = VLC_FALSE;
-                    TAB_REMOVE( p_sys->i_pmt, p_sys->pmt, pid );
+                    if( b_keep ) break;
                 }
             }
-            else if( pid->p_owner && pid->p_owner->i_number != 0 && pid->es->id )
+
+            if( !b_keep )
+            {
+                TAB_APPEND( i_pmt_rm, pmt_rm, pmt );
+            }
+        }
+
+        /* Delete all ES attached to thoses PMT */
+        for( i = 2; i < 8192; i++ )
+        {
+            ts_pid_t *pid = &p_sys->pid[i];
+
+            if( !pid->b_valid || pid->psi ) continue;
+
+            for( j = 0; j < i_pmt_rm; j++ )
             {
-                /* We only remove es that aren't defined by extra pmt */
-                es_out_Del( p_demux->out, pid->es->id );
+                int i_prg;
+                for( i_prg = 0; i_prg < pid->p_owner->i_prg; i_prg++ )
+                {
+                    /* We only remove es that aren't defined by extra pmt */
+                    if( pid->p_owner->prg[i_prg]->i_pid_pmt !=
+                        pmt_rm[j]->i_pid ) continue;
+
+                    if( p_sys->b_dvb_control && pid->es->id )
+                    {
+                        if( stream_Control( p_demux->s, STREAM_CONTROL_ACCESS,
+                                            ACCESS_SET_PRIVATE_ID_STATE, i,
+                                            VLC_FALSE ) )
+                            p_sys->b_dvb_control = VLC_FALSE;
+                    }
+
+                    PIDClean( p_demux->out, pid );
+                    break;
+                }
+
+                if( !pid->b_valid ) break;
+            }
+        }
 
-                pid->b_valid = VLC_FALSE;
+        /* Delete PMT pid */
+        for( i = 0; i < i_pmt_rm; i++ )
+        {
+            if( p_sys->b_dvb_control )
+            {
+                if( stream_Control( p_demux->s, STREAM_CONTROL_ACCESS,
+                                    ACCESS_SET_PRIVATE_ID_STATE,
+                                    pmt_rm[i]->i_pid, VLC_FALSE ) )
+                    p_sys->b_dvb_control = VLC_FALSE;
             }
+
+            PIDClean( p_demux->out, &p_sys->pid[pmt_rm[i]->i_pid] );
+            TAB_REMOVE( p_sys->i_pmt, p_sys->pmt, pmt_rm[i] );
         }
+
+        if( pmt_rm ) free( pmt_rm );
     }
 
     /* now create programs */
-    for( p_program = p_pat->p_first_program; p_program != NULL; p_program = p_program->p_next )
+    for( p_program = p_pat->p_first_program; p_program != NULL;
+         p_program = p_program->p_next )
     {
-        msg_Dbg( p_demux, "  * number=%d pid=0x%x", p_program->i_number, p_program->i_pid );
+        msg_Dbg( p_demux, "  * number=%d pid=%d", p_program->i_number,
+                 p_program->i_pid );
         if( p_program->i_number != 0 )
         {
             ts_pid_t *pmt = &p_sys->pid[p_program->i_pid];
+            vlc_bool_t b_add = VLC_TRUE;
+
+            if( pmt->b_valid )
+            {
+                int i_prg;
+                for( i_prg = 0; i_prg < pmt->psi->i_prg; i_prg++ )
+                {
+                    if( pmt->psi->prg[i_prg]->i_number == p_program->i_number )
+                    {
+                        b_add = VLC_FALSE;
+                        break;
+                    }
+                }
+            }
+            else
+            {
+                TAB_APPEND( p_sys->i_pmt, p_sys->pmt, pmt );
+            }
 
-            PIDInit( pmt, VLC_TRUE, pat->psi );
-            pmt->psi->handle = dvbpsi_AttachPMT( p_program->i_number, (dvbpsi_pmt_callback)PMTCallBack, p_demux );
-            pmt->psi->i_number = p_program->i_number;
+            if( b_add )
+            {
+                PIDInit( pmt, VLC_TRUE, pat->psi );
+                pmt->psi->prg[pmt->psi->i_prg-1]->handle =
+                    dvbpsi_AttachPMT( p_program->i_number,
+                                      (dvbpsi_pmt_callback)PMTCallBack,
+                                      p_demux );
+                pmt->psi->prg[pmt->psi->i_prg-1]->i_number =
+                    p_program->i_number;
+                pmt->psi->prg[pmt->psi->i_prg-1]->i_pid_pmt =
+                    p_program->i_pid;
+
+                /* Now select PID at access level */
+                if( p_sys->b_dvb_control )
+                {
+                    if( DVBProgramIsSelected( p_demux, p_program->i_number ) )
+                    {
+                        if( p_sys->i_dvb_program == 0 )
+                            p_sys->i_dvb_program = p_program->i_number;
 
-            TAB_APPEND( p_sys->i_pmt, p_sys->pmt, pmt );
+                        if( stream_Control( p_demux->s, STREAM_CONTROL_ACCESS, ACCESS_SET_PRIVATE_ID_STATE, p_program->i_pid, VLC_TRUE ) )
+                            p_sys->b_dvb_control = VLC_FALSE;
+                    }
+                    else
+                    {
+                        if( stream_Control( p_demux->s, STREAM_CONTROL_ACCESS, ACCESS_SET_PRIVATE_ID_STATE, p_program->i_pid, VLC_FALSE ) )
+                            p_sys->b_dvb_control = VLC_FALSE;
+                    }
+                }
+            }
         }
     }
-    pat->psi->i_version = p_pat->i_version;
+    pat->psi->i_pat_version = p_pat->i_version;
 
     dvbpsi_DeletePAT( p_pat );
 }