V4L/DVB (8795): saa7134-empress: insert leading null bytes for Beholder M6 empress cards

Additional code to improve the init sequence and add board type tests
were done by Hans Verkuil.

Signed-off-by: Beholder Intl. Ltd. Dmitry Belimov <d.belimov@gmail.com>
Signed-off-by: Hans Verkuil <hverkuil@xs4all.nl>
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>

1 files changed, 11 insertions, 6 deletions

diff --git a/drivers/media/video/saa7134/saa6752hs.c b/drivers/media/video/saa7134/saa6752hs.c
index 28499e591925..f40cb0b479b1 100644
--- a/drivers/media/video/saa7134/saa6752hs.c
+++ b/drivers/media/video/saa7134/saa6752hs.c
@@ -653,7 +653,7 @@ static int saa6752hs_qmenu(struct saa6752hs_state *h,
         return v4l2_ctrl_query_menu(qmenu, &qctrl, NULL);
 }
 
-static int saa6752hs_init(struct i2c_client* client)
+static int saa6752hs_init(struct i2c_client *client, u32 leading_null_bytes)
 {
         unsigned char buf[9], buf2[4];
         struct saa6752hs_state *h;
@@ -705,6 +705,12 @@ static int saa6752hs_init(struct i2c_client* client)
         buf[1] = 0x05;
         i2c_master_send(client,buf,2);
 
+        /* Set leading null byte for TS */
+        buf[0] = 0xF6;
+        buf[1] = (leading_null_bytes >> 8) & 0xff;
+        buf[2] = leading_null_bytes & 0xff;
+        i2c_master_send(client, buf, 3);
+
         /* compute PAT */
         memcpy(localPAT, PAT, sizeof(PAT));
         localPAT[17] = 0xe0 | ((h->params.ts_pid_pmt >> 8) & 0x0f);
@@ -812,14 +818,13 @@ saa6752hs_command(struct i2c_client *client, unsigned int cmd, void *arg)
         int i;
 
         switch (cmd) {
+        case VIDIOC_INT_INIT:
+                /* apply settings and start encoder */
+                saa6752hs_init(client, *(u32 *)arg);
+                break;
         case VIDIOC_S_EXT_CTRLS:
                 if (ctrls->ctrl_class != V4L2_CTRL_CLASS_MPEG)
                         return -EINVAL;
-                if (ctrls->count == 0) {
-                        /* apply settings and start encoder */
-                        saa6752hs_init(client);
-                        break;
-                }
                 /* fall through */
         case VIDIOC_TRY_EXT_CTRLS:
         case VIDIOC_G_EXT_CTRLS: