V4L/DVB (6194): Changes to support interrupts on VIDB

Changes to support interrupts on VIDB

Signed-off-by: Steven Toth <stoth@hauppauge.com>
Reviewed-by: Michael Krufky <mkrufky@linuxtv.org>
Signed-off-by: Mauro Carvalho Chehab <mchehab@infradead.org>

1 files changed, 54 insertions, 5 deletions

diff --git a/drivers/media/video/cx23885/cx23885-core.c b/drivers/media/video/cx23885/cx23885-core.c
index 907ea4c2ea38..d155f5fb133c 100644
--- a/drivers/media/video/cx23885/cx23885-core.c
+++ b/drivers/media/video/cx23885/cx23885-core.c
@@ -1252,20 +1252,23 @@ static irqreturn_t cx23885_irq(int irq, void *dev_id)
         struct cx23885_dev *dev = dev_id;
         struct cx23885_tsport *port = &dev->ts2;
         u32 pci_status, pci_mask;
+        u32 ts1_status, ts1_mask;
         u32 ts2_status, ts2_mask;
         int count = 0, handled = 0;
 
         pci_status = cx_read(PCI_INT_STAT);
         pci_mask = cx_read(PCI_INT_MSK);
-
+        ts1_status = cx_read(VID_B_INT_STAT);
+        ts1_mask = cx_read(VID_B_INT_MSK);
         ts2_status = cx_read(VID_C_INT_STAT);
         ts2_mask = cx_read(VID_C_INT_MSK);
 
-        if ( (pci_status == 0) && (ts2_status == 0) )
+        if ( (pci_status == 0) && (ts2_status == 0) && (ts1_status == 0) )
                 goto out;
 
         count = cx_read(port->reg_gpcnt);
         dprintk(7, "pci_status: 0x%08x  pci_mask: 0x%08x\n", pci_status, pci_mask );
+        dprintk(7, "ts1_status: 0x%08x  ts1_mask: 0x%08x count: 0x%x\n", ts1_status, ts1_mask, count );
         dprintk(7, "ts2_status: 0x%08x  ts2_mask: 0x%08x count: 0x%x\n", ts2_status, ts2_mask, count );
 
         if ( (pci_status & PCI_MSK_RISC_RD) ||
@@ -1303,6 +1306,48 @@ static irqreturn_t cx23885_irq(int irq, void *dev_id)
 
         }
 
+        if ( (ts1_status & VID_B_MSK_OPC_ERR) ||
+             (ts1_status & VID_B_MSK_BAD_PKT) ||
+             (ts1_status & VID_B_MSK_SYNC) ||
+             (ts1_status & VID_B_MSK_OF))
+        {
+                if (ts1_status & VID_B_MSK_OPC_ERR)
+                        dprintk(7, " (VID_B_MSK_OPC_ERR 0x%08x)\n", VID_B_MSK_OPC_ERR);
+                if (ts1_status & VID_B_MSK_BAD_PKT)
+                        dprintk(7, " (VID_B_MSK_BAD_PKT 0x%08x)\n", VID_B_MSK_BAD_PKT);
+                if (ts1_status & VID_B_MSK_SYNC)
+                        dprintk(7, " (VID_B_MSK_SYNC    0x%08x)\n", VID_B_MSK_SYNC);
+                if (ts1_status & VID_B_MSK_OF)
+                        dprintk(7, " (VID_B_MSK_OF      0x%08x)\n", VID_B_MSK_OF);
+
+                printk(KERN_ERR "%s: mpeg risc op code error\n", dev->name);
+
+                cx_clear(port->reg_dma_ctl, port->dma_ctl_val);
+                cx23885_sram_channel_dump(dev, &dev->sram_channels[ port->sram_chno ]);
+
+        } else if (ts1_status & VID_B_MSK_RISCI1) {
+
+                dprintk(7, " (RISCI1            0x%08x)\n", VID_B_MSK_RISCI1);
+
+                spin_lock(&port->slock);
+                count = cx_read(port->reg_gpcnt);
+                cx23885_wakeup(port, &port->mpegq, count);
+                spin_unlock(&port->slock);
+
+        } else if (ts1_status & VID_B_MSK_RISCI2) {
+
+                dprintk(7, " (RISCI2            0x%08x)\n", VID_B_MSK_RISCI2);
+
+                spin_lock(&port->slock);
+                cx23885_restart_queue(port, &port->mpegq);
+                spin_unlock(&port->slock);
+
+        }
+        if (ts1_status) {
+                cx_write(VID_B_INT_STAT, ts1_status);
+                handled = 1;
+        }
+
         if ( (ts2_status & VID_C_MSK_OPC_ERR) ||
              (ts2_status & VID_C_MSK_BAD_PKT) ||
              (ts2_status & VID_C_MSK_SYNC) ||
@@ -1341,9 +1386,13 @@ static irqreturn_t cx23885_irq(int irq, void *dev_id)
 
         }
 
-        cx_write(VID_C_INT_STAT, ts2_status);
-        cx_write(PCI_INT_STAT, pci_status);
-        handled = 1;
+        if (ts2_status) {
+                cx_write(VID_C_INT_STAT, ts2_status);
+                handled = 1;
+        }
+
+        if (handled)
+                cx_write(PCI_INT_STAT, pci_status);
 out:
         return IRQ_RETVAL(handled);
 }