1 files changed, 11 insertions, 1 deletions

diff --git a/drivers/rapidio/devices/tsi721.c b/drivers/rapidio/devices/tsi721.c
index 722246cf20ab..5d44252b7342 100644
--- a/drivers/rapidio/devices/tsi721.c
+++ b/drivers/rapidio/devices/tsi721.c
@@ -435,6 +435,9 @@ static void tsi721_db_dpc(struct work_struct *work)
                                 " info %4.4x\n", DBELL_SID(idb.bytes),
                                 DBELL_TID(idb.bytes), DBELL_INF(idb.bytes));
                 }
+
+                wr_ptr = ioread32(priv->regs +
+                                  TSI721_IDQ_WP(IDB_QUEUE)) % IDB_QSIZE;
         }
 
         iowrite32(rd_ptr & (IDB_QSIZE - 1),
@@ -445,6 +448,10 @@ static void tsi721_db_dpc(struct work_struct *work)
         regval |= TSI721_SR_CHINT_IDBQRCV;
         iowrite32(regval,
                 priv->regs + TSI721_SR_CHINTE(IDB_QUEUE));
+
+        wr_ptr = ioread32(priv->regs + TSI721_IDQ_WP(IDB_QUEUE)) % IDB_QSIZE;
+        if (wr_ptr != rd_ptr)
+                schedule_work(&priv->idb_work);
 }
 
 /**
@@ -2212,7 +2219,7 @@ static int __devinit tsi721_probe(struct pci_dev *pdev,
                                   const struct pci_device_id *id)
 {
         struct tsi721_device *priv;
-        int i, cap;
+        int cap;
         int err;
         u32 regval;
 
@@ -2232,12 +2239,15 @@ static int __devinit tsi721_probe(struct pci_dev *pdev,
         priv->pdev = pdev;
 
 #ifdef DEBUG
+        {
+        int i;
         for (i = 0; i <= PCI_STD_RESOURCE_END; i++) {
                 dev_dbg(&pdev->dev, "res[%d] @ 0x%llx (0x%lx, 0x%lx)\n",
                         i, (unsigned long long)pci_resource_start(pdev, i),
                         (unsigned long)pci_resource_len(pdev, i),
                         pci_resource_flags(pdev, i));
         }
+        }
 #endif
         /*
          * Verify BAR configuration