]> git.sesse.net Git - vlc/blobdiff - modules/demux/ts.c
* Fix the psz_description of telx and vbi streams
[vlc] / modules / demux / ts.c
index 2c8df5c63531d7b9aace32ebd99480a25975ce24..5bf0935fd3abb8d9664f5021b15ae6d5b0b15c21 100644 (file)
@@ -2,7 +2,7 @@
  * ts.c: Transport Stream input module for VLC.
  *****************************************************************************
  * Copyright (C) 2004 VideoLAN
- * $Id: ts.c,v 1.5 2004/01/19 18:16:32 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
 /*****************************************************************************
  * 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")
 
 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 );
-        add_bool( "ts-es-id-pid", 0, NULL, "set id of es to pid", "set id of es to pid", VLC_TRUE );
+
+    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 );
+
     set_capability( "demux2", 10 );
     set_callbacks( Open, Close );
-    add_shortcut( "ts2" );
+    add_shortcut( "ts" );
 vlc_module_end();
 
 /*****************************************************************************
@@ -133,6 +162,7 @@ typedef struct
 
     decoder_config_descriptor_t    dec_descr;
     sl_config_descriptor_t         sl_descr;
+
 } es_mpeg4_descriptor_t;
 
 typedef struct
@@ -155,23 +185,45 @@ 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;
 
+    /* Conditional Access PMT (EN 50 221) */
+    uint8_t         *p_capmt;
+    int             i_capmt_size;
+
+} 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
@@ -184,15 +236,26 @@ 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];
 
@@ -202,6 +265,16 @@ struct demux_sys_t
 
     /* */
     vlc_bool_t  b_es_id_pid;
+    csa_t       *csa;
+    vlc_bool_t  b_silent;
+
+    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 );
@@ -221,11 +294,18 @@ 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 DVBCAPMTSend( demux_t *p_demux );
+
+#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
@@ -236,19 +316,26 @@ 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 )
     {
         msg_Err( p_demux, "cannot peek" );
         return VLC_EGENERIC;
     }
-    if( p_peek[0] != 0x47 || ( i_peek >= 189 && p_peek[188] != 0x47 ) )
+
+    /* 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" ) )
         {
@@ -258,6 +345,41 @@ static int Open( vlc_object_t *p_this )
         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[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 )
+    {
+        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 */
     p_demux->pf_demux = Demux;
     p_demux->pf_control = Control;
@@ -265,6 +387,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];
@@ -273,20 +397,68 @@ 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 );
@@ -300,11 +472,13 @@ 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 );
             /* 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 )
@@ -321,14 +495,15 @@ 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;
                         }
                         PIDFillFormat( pid, i_stream_type);
                         if( pid->es->fmt.i_cat != UNKNOWN_ES )
@@ -337,8 +512,11 @@ static int Open( vlc_object_t *p_this )
                             {
                                 pid->es->fmt.i_id = i_pid;
                             }
-                            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 );
+                            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 );
                         }
                     }
                 }
@@ -351,6 +529,46 @@ 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
+        {
+            uint64_t i_ck = strtoull( psz, NULL, 16 );
+            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;
+
     return VLC_SUCCESS;
 }
 
@@ -375,37 +593,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:
  *****************************************************************************/
@@ -415,60 +652,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 )];
 
@@ -476,20 +723,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;
@@ -500,6 +766,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, p_sys->buffer,
+                   p_sys->i_ts_read * p_sys->i_packet_size );
+    }
+
     return 1;
 }
 
@@ -510,7 +783,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 )
     {
@@ -548,24 +822,148 @@ 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;
+                            }
+                        }
+                    }
+
+                    /* Set CAM descrambling */
+                    DVBCAPMTSend( p_demux );
+                }
+            }
+            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;
     }
@@ -573,20 +971,43 @@ 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->p_capmt    = NULL;
+            prg->i_capmt_size = 0;
+            prg->handle     = NULL;
+
+            TAB_APPEND( pid->psi->i_prg, pid->psi->prg, prg );
+        }
     }
     else
     {
@@ -596,7 +1017,11 @@ 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;
     }
 }
 
@@ -604,61 +1029,88 @@ static void PIDClean( es_out_t *out, ts_pid_t *pid )
 {
     if( pid->psi )
     {
-        if( pid->psi->handle )
-        {
-            dvbpsi_DetachPMT( pid->psi->handle );
-        }
-        if( pid->psi->iod )
+        int i;
+
+        if( pid->psi->handle ) dvbpsi_DetachPMT( pid->psi->handle );
+        for( i = 0; i < pid->psi->i_prg; i++ )
         {
-            IODFree( pid->psi->iod );
+            if( pid->psi->prg[i]->iod )
+                IODFree( pid->psi->prg[i]->iod );
+            if ( pid->psi->prg[i]->i_capmt_size )
+                free( pid->psi->prg[i]->p_capmt );
+            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 */
@@ -683,7 +1135,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 */
                     {
@@ -715,19 +1167,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
@@ -754,6 +1206,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 )
@@ -773,8 +1249,12 @@ static void ParsePES ( demux_t *p_demux, ts_pid_t *pid )
             break;
         }
     }
+
     if( p_pes )
     {
+        block_t *p_block;
+        int i;
+
         if( i_dts >= 0 )
         {
             p_pes->i_dts = i_dts * 100 / 9;
@@ -783,56 +1263,130 @@ static void ParsePES ( demux_t *p_demux, ts_pid_t *pid )
         {
             p_pes->i_pts = i_pts * 100 / 9;
         }
+        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 ) );
+        }
 
-        /* For mpeg4/mscodec we first gather the packet -> will make ffmpeg happier */
-        es_out_Send( p_demux->out, pid->es->id, block_ChainGather( p_pes ) );
+        es_out_Send( p_demux->out, pid->es->id, p_block );
     }
     else
     {
         msg_Warn( p_demux, "empty pes" );
     }
-};
+}
 
-static vlc_bool_t GatherPES( demux_t *p_demux, ts_pid_t *pid, block_t *p_bk )
+static void PCRHandle( demux_t *p_demux, ts_pid_t *pid, block_t *p_bk )
 {
-    const uint8_t    *p = p_bk->p_buffer;
-    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 */
-    /* transport_scrambling_control is ignored */
-
-    int         i_skip = 0;
-    vlc_bool_t  i_ret   = VLC_FALSE;
+    demux_sys_t   *p_sys = p_demux->p_sys;
+    const uint8_t *p = p_bk->p_buffer;
 
-    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( p[1]&0x80 )
+    if( ( p[3]&0x20 ) && /* adaptation */
+        ( p[5]&0x10 ) &&
+        ( p[4] >= 7 ) )
     {
-        msg_Dbg( p_demux, "transport_error_indicator set (pid=0x%x)", pid->i_pid );
-    }
+        int i;
+        mtime_t i_pcr;  /* 33 bits */
 
-    if( !b_adaptation )
-    {
-        i_skip = 4;
-    }
-    else
-    {
-        /* p[4] is adaptation length */
-        i_skip = 5 + p[4];
+        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 )
+{
+    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 */
+
+    /* transport_scrambling_control is ignored */
+
+    int         i_skip = 0;
+    vlc_bool_t  i_ret  = VLC_FALSE;
+    int         i_diff;
+
+#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=%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_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;
@@ -844,7 +1398,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 cc=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 )
@@ -855,91 +1410,73 @@ 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_DISCONTINUITY;
             }
         }
     }
 
-    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
-    {
-        const vlc_bool_t b_unit_start= p[1]&0x40;
 
-        /* we have to gather it */
-        p_bk->p_buffer += i_skip;
-        p_bk->i_buffer -= i_skip;
+    /* We have to gather it */
+    p_bk->p_buffer += i_skip;
+    p_bk->i_buffer -= i_skip;
 
-        if( b_unit_start )
+    if( b_unit_start )
+    {
+        if( pid->es->p_pes )
         {
-            if( pid->es->p_pes )
-            {
-                ParsePES( p_demux, pid );
-                i_ret = VLC_TRUE;
-            }
-
-            pid->es->p_pes = p_bk;
+            ParsePES( p_demux, pid );
+            i_ret = VLC_TRUE;
         }
-        else
+
+        block_ChainLastAppend( &pid->es->pp_last, p_bk );
+        if( p_bk->i_buffer > 6 )
         {
-            if( pid->es->p_pes == NULL )
-            {
-                /* msg_Dbg( p_demux, "broken packet" ); */
-                block_Release( p_bk );
-            }
-            else
+            pid->es->i_pes_size = GetWBE( &p_bk->p_buffer[4] );
+            if( pid->es->i_pes_size > 0 )
             {
-                /* TODO check if when have gather enough packet to form a PES (ie read PES size)*/
-                block_ChainAppend( &pid->es->p_pes, p_bk );
+                pid->es->i_pes_size += 6;
             }
         }
-    }
-
-    return i_ret;
-}
-
-static char *LanguageNameISO639( char *psz_code )
-{
-    const iso639_lang_t *pl;
-
-    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 );
+        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( *pl->psz_native_name )
+        if( pid->es->p_pes == NULL )
         {
-            return strdup( pl->psz_native_name );
+            /* 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 )
+            {
+                ParsePES( p_demux, pid );
+                i_ret = VLC_TRUE;
+            }
         }
-        return strdup( pl->psz_eng_name );
     }
+
+    return i_ret;
 }
 
 static int PIDFillFormat( ts_pid_t *pid, int i_stream_type )
@@ -963,6 +1500,7 @@ static int PIDFillFormat( ts_pid_t *pid, 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' ) );
@@ -997,13 +1535,21 @@ static int PIDFillFormat( ts_pid_t *pid, 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 ;
 }
 
@@ -1366,6 +1912,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;
@@ -1373,17 +1940,31 @@ 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;
+
+    int                  i_cad_length = 0;
+    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)" );
@@ -1391,7 +1972,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;
@@ -1402,20 +1984,39 @@ 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 )
         {
-            PIDClean( p_demux->out, pid );
+            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;
     }
+    if ( prg->i_capmt_size )
+        free( prg->p_capmt );
+    prg->i_capmt_size = 0;
 
-    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 )
@@ -1423,26 +2024,75 @@ 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_Warn( p_demux, " * descriptor : IOD (0x1d)" );
+
+            prg->iod = IODNew( p_dr->i_length, p_dr->p_data );
+        }
+        else if( p_dr->i_tag == 0x9 )
+        {
+            msg_Dbg( p_demux, " * descriptor : CA (0x9)" );
+            i_cad_length += p_dr->i_length + 2;
+        }
+        else
+        {
+            msg_Dbg( p_demux, " * descriptor : unknown (0x%x)", p_dr->i_tag );
+        }
+    }
 
-            pmt->psi->iod = IODNew( p_dr->i_length, p_dr->p_data );
+    if ( i_cad_length )
+    {
+        prg->p_capmt = malloc( 6 + i_cad_length );
+        prg->i_capmt_size = 6 + i_cad_length;
+
+        prg->p_capmt[0] = p_pmt->i_program_number >> 8;
+        prg->p_capmt[1] = p_pmt->i_program_number & 0xff;
+        prg->p_capmt[2] = (p_pmt->i_version << 1) | 0x1;
+        prg->p_capmt[3] = (i_cad_length + 1) >> 8;
+        prg->p_capmt[4] = (i_cad_length + 1) & 0xff;
+        prg->p_capmt[5] = 0x1; /* ok_descrambling */
+
+        i = 6;
+        for( p_dr = p_pmt->p_first_descriptor; p_dr != NULL; p_dr = p_dr->p_next )
+        {
+            if( p_dr->i_tag == 0x9 )
+            {
+                prg->p_capmt[i] = 0x9;
+                prg->p_capmt[i+1] = p_dr->i_length;
+                memcpy( &prg->p_capmt[i+2], p_dr->p_data, p_dr->i_length );
+                i += p_dr->i_length + 2;
+            }
         }
     }
 
     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;
+
+        /* Find out if the PID was already declared */
+        for( i = 0; i < i_clean; i++ )
+        {
+            if( pp_clean[i] == &p_sys->pid[p_es->i_pid] )
+            {
+                old_pid = pp_clean[i];
+                break;
+            }
+        }
 
-        if( pid->b_valid )
+        if( !old_pid && p_sys->pid[p_es->i_pid].b_valid )
         {
-            msg_Warn( p_demux, "pmt error: pid=0x%x already defined", p_es->i_pid );
+            msg_Warn( p_demux, "pmt error: pid=%d already defined",
+                      p_es->i_pid );
             continue;
         }
 
         PIDInit( pid, VLC_FALSE, pmt->psi );
         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;;
@@ -1451,7 +2101,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 );
@@ -1460,7 +2109,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 )
@@ -1473,34 +2122,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;
-                            break;
+                    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 */
@@ -1508,23 +2162,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;
-                            break;
+                    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
@@ -1549,51 +2203,164 @@ 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 )
             {
+                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 == 0x6a )
                 {
                     pid->es->fmt.i_cat = AUDIO_ES;
                     pid->es->fmt.i_codec = VLC_FOURCC( 'a', '5', '2', ' ' );
                 }
+                else if( p_dr->i_tag == 0x05 )
+                {
+
+                    /* DTS 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( 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 */
+                        pid->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_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];
+                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;
@@ -1602,27 +2369,179 @@ 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=0x%x type=0x%x fcc=%4.4s", p_es->i_pid, p_es->i_type, (char*)&pid->es->fmt.i_codec );
-            if( p_sys->b_es_id_pid )
+            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
             {
-                pid->es->fmt.i_id = p_es->i_pid;
+                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 );
+                }
             }
-            pid->es->id = es_out_Add( p_demux->out, &pid->es->fmt );
+        }
+
+        i_cad_length = 0;
+        /* 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 )
+            {
+                msg_Dbg( p_demux, "   * descriptor : CA (0x9)" );
+                i_cad_length += p_dr->i_length + 2;
+            }
+            else
+            {
+                msg_Dbg( p_demux, "   * descriptor : unknown (0x%x)",
+                         p_dr->i_tag );
+            }
+        }
+
+        if ( i_cad_length )
+        {
+            if ( !prg->i_capmt_size )
+            {
+                prg->p_capmt = malloc( 5 + 6 + i_cad_length );
+                prg->i_capmt_size = 5 + 6 + i_cad_length;
+
+                prg->p_capmt[0] = p_pmt->i_program_number >> 8;
+                prg->p_capmt[1] = p_pmt->i_program_number & 0xff;
+                prg->p_capmt[2] = (p_pmt->i_version << 1) | 0x1;
+                prg->p_capmt[3] = 0; /* cad length */
+                prg->p_capmt[4] = 0;
+
+                i = 5;
+            }
+            else
+            {
+                prg->p_capmt = realloc( prg->p_capmt,
+                                        prg->i_capmt_size + 6 + i_cad_length );
+                i = prg->i_capmt_size;
+                prg->i_capmt_size += 6 + i_cad_length;
+            }
+
+            prg->p_capmt[i] = p_es->i_type;
+            prg->p_capmt[i+1] = p_es->i_pid >> 8;
+            prg->p_capmt[i+2] = p_es->i_pid & 0xff;
+            prg->p_capmt[i+3] = (i_cad_length + 1) >> 8;
+            prg->p_capmt[i+4] = (i_cad_length + 1) & 0xff;
+            prg->p_capmt[i+5] = 0x1; /* ok_descrambling */
+            i += 6;
+
+            for( p_dr = p_es->p_first_descriptor; p_dr != NULL; p_dr = p_dr->p_next )
+            {
+                if( p_dr->i_tag == 0x9 )
+                {
+                    prg->p_capmt[i] = 0x9;
+                    prg->p_capmt[i+1] = p_dr->i_length;
+                    memcpy( &prg->p_capmt[i+2], p_dr->p_data, p_dr->i_length );
+                    i += p_dr->i_length + 2;
+                }
+            }
+        }
+        else if ( prg->i_capmt_size )
+        {
+            prg->p_capmt = realloc( prg->p_capmt,
+                                    prg->i_capmt_size + 5 );
+            i = prg->i_capmt_size;
+            prg->i_capmt_size += 5;
+
+            prg->p_capmt[i] = p_es->i_type;
+            prg->p_capmt[i+1] = p_es->i_pid >> 8;
+            prg->p_capmt[i+2] = p_es->i_pid & 0xff;
+            prg->p_capmt[i+3] = 0;
+            prg->p_capmt[i+4] = 0;
+            i += 5;
+        }
+
+        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 );
         }
     }
-    dvbpsi_DeletePMT(p_pmt);
+
+    dvbpsi_DeletePMT( p_pmt );
+
+    for ( i = 0; i < i_clean; i++ )
+    {
+        if( DVBProgramIsSelected( p_demux, prg->i_number ) )
+        {
+            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] );
+    }
+    if( i_clean ) free( pp_clean );
+
+    if( DVBProgramIsSelected( p_demux, prg->i_number ) )
+    {
+        /* Set CAM descrambling */
+        DVBCAPMTSend( p_demux );
+    }
 }
 
 static void PATCallBack( demux_t *p_demux, dvbpsi_pat_t *p_pat )
@@ -1630,58 +2549,284 @@ 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 )
                 {
+                    int i_prg;
+                    for( i_prg = 0; i_prg < pmt->psi->i_prg; i_prg++ )
+                    {
+                        if( p_program->i_number ==
+                            pmt->psi->prg[i_prg]->i_number )
+                        {
+                            b_keep = VLC_TRUE;
+                            break;
+                        }
+                    }
+                    if( b_keep ) break;
+                }
+            }
+
+            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++ )
+            {
+                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 );
-                    TAB_REMOVE( p_sys->i_pmt, p_sys->pmt, pid );
+                    break;
                 }
+
+                if( !pid->b_valid ) break;
             }
-            else if( pid->p_owner && pid->p_owner->i_number != 0 && pid->es->id )
+        }
+
+        /* Delete PMT pid */
+        for( i = 0; i < i_pmt_rm; i++ )
+        {
+            if( p_sys->b_dvb_control )
             {
-                /* We only remove es that aren't defined by extra pmt */
-                PIDClean( p_demux->out, pid );
+                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;
 
-            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( 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 );
+            }
 
-            TAB_APPEND( p_sys->i_pmt, p_sys->pmt, pmt );
+            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( p_sys->i_dvb_program <= 0 || p_sys->i_dvb_program == p_program->i_number )
+                    {
+                        if( p_sys->i_dvb_program == 0 )
+                            p_sys->i_dvb_program = p_program->i_number;
+
+                        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 );
 }
 
+static void DVBCAPMTSend( demux_t *p_demux )
+{
+    demux_sys_t *p_sys = p_demux->p_sys;
+    int i_nb_capmts = 0;
+    int i;
+
+    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( DVBProgramIsSelected( p_demux, pmt->psi->prg[i_prg]->i_number )
+                 && pmt->psi->prg[i_prg]->i_capmt_size )
+            {
+                i_nb_capmts++;
+            }
+        }
+    }
+
+    if ( i_nb_capmts )
+    {
+        uint8_t **pp_capmts = malloc( i_nb_capmts * sizeof(uint8_t *) );
+        int i_current_capmt = 0;
+
+        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( DVBProgramIsSelected( p_demux, pmt->psi->prg[i_prg]->i_number )
+                     && pmt->psi->prg[i_prg]->i_capmt_size )
+                {
+                    uint8_t *p_capmt = malloc( pmt->psi->prg[i_prg]->i_capmt_size + 10 );
+                    int i_pos = 0;
+                    pp_capmts[i_current_capmt] = p_capmt;
+
+                    p_capmt[i_pos] = 0x9F;
+                    p_capmt[i_pos+1] = 0x80;
+                    p_capmt[i_pos+2] = 0x32;
+                    i_pos += 3;
+
+                    if ( (pmt->psi->prg[i_prg]->i_capmt_size + 1) < 128 )
+                    {
+                        p_capmt[i_pos] = (pmt->psi->prg[i_prg]->i_capmt_size + 1);
+                        i_pos++;
+                    }
+                    else if ( (pmt->psi->prg[i_prg]->i_capmt_size + 1) < 256 )
+                    {
+                        p_capmt[i_pos] = 0x81;
+                        p_capmt[i_pos+1] = (pmt->psi->prg[i_prg]->i_capmt_size + 1);
+                        i_pos += 2;
+                    }
+                    else if ( (pmt->psi->prg[i_prg]->i_capmt_size + 1) < 65536 )
+                    {
+                        p_capmt[i_pos] = 0x82;
+                        p_capmt[i_pos+1] =
+                            (pmt->psi->prg[i_prg]->i_capmt_size + 1) >> 8;
+                        p_capmt[i_pos+2] =
+                            (pmt->psi->prg[i_prg]->i_capmt_size + 1) & 0xff;
+                        i_pos += 3;
+                    }
+                    else if ( (pmt->psi->prg[i_prg]->i_capmt_size + 1) < 16777216 )
+                    {
+                        p_capmt[i_pos] = 0x83;
+                        p_capmt[i_pos+1] =
+                            (pmt->psi->prg[i_prg]->i_capmt_size + 1) >> 16;
+                        p_capmt[i_pos+2] =
+                            ((pmt->psi->prg[i_prg]->i_capmt_size + 1) >> 8) & 0xff;
+                        p_capmt[i_pos+3] =
+                            (pmt->psi->prg[i_prg]->i_capmt_size + 1) & 0xff;
+                        i_pos += 4;
+                    }
+                    else
+                    {
+                        p_capmt[i_pos] = 0x84;
+                        p_capmt[i_pos+1] =
+                            (pmt->psi->prg[i_prg]->i_capmt_size + 1) >> 24;
+                        p_capmt[i_pos+2] =
+                            ((pmt->psi->prg[i_prg]->i_capmt_size + 1) >> 16) & 0xff;
+                        p_capmt[i_pos+3] =
+                            ((pmt->psi->prg[i_prg]->i_capmt_size + 1) >> 8) & 0xff;
+                        p_capmt[i_pos+4] =
+                            (pmt->psi->prg[i_prg]->i_capmt_size + 1) & 0xff;
+                        i_pos += 5;
+                    }
+
+                    if ( i_nb_capmts > 1 )
+                    {
+                        if ( i_current_capmt == 0 )
+                            p_capmt[i_pos] = 0x1; /* first */
+                        else if ( i_current_capmt == i_nb_capmts - 1 )
+                            p_capmt[i_pos] = 0x2; /* last */
+                        else
+                            p_capmt[i_pos] = 0x0; /* more */
+                    }
+                    else
+                        p_capmt[i_pos] = 0x3; /* only */
+                    i_pos++;
+                    i_current_capmt++;
+
+                    memcpy( &p_capmt[i_pos], pmt->psi->prg[i_prg]->p_capmt,
+                            pmt->psi->prg[i_prg]->i_capmt_size );
+                }
+            }
+        }
+
+        stream_Control( p_demux->s, STREAM_CONTROL_ACCESS,
+                        ACCESS_SET_PRIVATE_ID_CA, pp_capmts, i_nb_capmts );
+    }
+}