[media] saa7164: patches to monitor TS payload for inconsistencies

... and report errors to console. (Debugging a DMA buffering issue).
These are made optional in later patches.

Signed-off-by: Steven Toth <stoth@kernellabs.com>
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>

3 files changed, 82 insertions, 1 deletions

diff --git a/drivers/media/video/saa7164/saa7164-buffer.c b/drivers/media/video/saa7164/saa7164-buffer.c
index 5fccecd588ce..0760891d5fa8 100644
--- a/drivers/media/video/saa7164/saa7164-buffer.c
+++ b/drivers/media/video/saa7164/saa7164-buffer.c
@@ -180,6 +180,20 @@ int saa7164_buffer_dealloc(struct saa7164_buffer *buf)
         return SAA_OK;
 }
 
+int saa7164_buffer_zero_offsets(struct saa7164_port *port, int i)
+{
+        struct saa7164_dev *dev = port->dev;
+
+        if ((i < 0) || (i >= port->hwcfg.buffercount))
+                return -EINVAL;
+
+        dprintk(DBGLVL_BUF, "%s(idx = %d)\n", __func__, i);
+
+        saa7164_writel(port->bufoffset + (sizeof(u32) * i), 0);
+
+        return 0;
+}
+
 /* Write a buffer into the hardware */
 int saa7164_buffer_activate(struct saa7164_buffer *buf, int i)
 {
diff --git a/drivers/media/video/saa7164/saa7164-core.c b/drivers/media/video/saa7164/saa7164-core.c
index 20257664b40b..0c10aea081f8 100644
--- a/drivers/media/video/saa7164/saa7164-core.c
+++ b/drivers/media/video/saa7164/saa7164-core.c
@@ -68,6 +68,57 @@ LIST_HEAD(saa7164_devlist);
 
 #define INT_SIZE 16
 
+static void saa7164_ts_verifier(struct saa7164_buffer *buf)
+{
+        struct saa7164_port *port = buf->port;
+        struct saa7164_dev *dev = port->dev;
+        u32 i;
+        u8 tmp, cc, a;
+        u8 *bufcpu = (u8 *)buf->cpu;
+
+        port->sync_errors = 0;
+        port->v_cc_errors = 0;
+        port->a_cc_errors = 0;
+
+        for (i = 0; i < buf->actual_size; i += 188) {
+                if (*(bufcpu + i) != 0x47)
+                        port->sync_errors++;
+
+                /* Query pid lower 8 bits */
+                tmp = *(bufcpu + i + 2);
+                cc = *(bufcpu + i + 3) & 0x0f;
+
+                if (tmp == 0xf1) {
+                        a = ((port->last_v_cc + 1) & 0x0f);
+                        if (a != cc) {
+                                printk(KERN_ERR "video cc last = %x current = %x i = %d\n", port->last_v_cc, cc, i);
+                                port->v_cc_errors++;
+                        }
+
+                        port->last_v_cc = cc;
+                } else
+                if (tmp == 0xf2) {
+                        a = ((port->last_a_cc + 1) & 0x0f);
+                        if (a != cc) {
+                                printk(KERN_ERR "audio cc last = %x current = %x i = %d\n", port->last_a_cc, cc, i);
+                                port->a_cc_errors++;
+                        }
+
+                        port->last_a_cc = cc;
+                }
+
+        }
+
+        if (port->v_cc_errors)
+                printk(KERN_ERR "video pid cc, %d errors\n", port->v_cc_errors);
+
+        if (port->a_cc_errors)
+                printk(KERN_ERR "audio pid cc, %d errors\n", port->a_cc_errors);
+
+        if (port->sync_errors)
+                printk(KERN_ERR "sync_errors = %d\n", port->sync_errors);
+}
+
 static void saa7164_histogram_reset(struct saa7164_histogram *hg, char *name)
 {
         int i;
@@ -188,7 +239,10 @@ static void saa7164_work_enchandler(struct work_struct *w)
                         dprintk(DBGLVL_IRQ, "%s() wp: %d processing: %d\n",
                                 __func__, wp, rp);
 
-                        /* */
+                        /* Validate the incoming buffer content */
+                        if (port->encoder_params.stream_type == V4L2_MPEG_STREAM_TYPE_MPEG2_TS)
+                                saa7164_ts_verifier(buf);
+
                         /* find a free user buffer and clone to it */
                         if (!list_empty(&port->list_buf_free.list)) {
 
@@ -212,6 +266,11 @@ static void saa7164_work_enchandler(struct work_struct *w)
                         } else
                                 printk(KERN_ERR "encirq no free buffers\n");
 
+                        /* Ensure offset into buffer remains 0, fill buffer
+                         * with known bad data. */
+                        saa7164_buffer_zero_offsets(port, rp);
+                        memset(buf->cpu, 0xDE, buf->pci_size);
+
                         break;
                 }
 
diff --git a/drivers/media/video/saa7164/saa7164.h b/drivers/media/video/saa7164/saa7164.h
index ef98a958b75e..25044a0de8b0 100644
--- a/drivers/media/video/saa7164/saa7164.h
+++ b/drivers/media/video/saa7164/saa7164.h
@@ -375,6 +375,13 @@ struct saa7164_port {
         struct saa7164_buffer list_buf_used;
         struct saa7164_buffer list_buf_free;
         wait_queue_head_t wait_read;
+
+        /* Debug */
+        u32 sync_errors;
+        u32 v_cc_errors;
+        u32 a_cc_errors;
+        u8 last_v_cc;
+        u8 last_a_cc;
 };
 
 struct saa7164_dev {
@@ -521,6 +528,7 @@ extern int saa7164_buffer_cfg_port(struct saa7164_port *port);
 extern struct saa7164_user_buffer *saa7164_buffer_alloc_user(
         struct saa7164_dev *dev, u32 len);
 extern void saa7164_buffer_dealloc_user(struct saa7164_user_buffer *buf);
+extern int saa7164_buffer_zero_offsets(struct saa7164_port *port, int i);
 
 
 /* ----------------------------------------------------------- */