1 files changed, 29 insertions, 9 deletions

diff --git a/drivers/usb/musb/musbhsdma.c b/drivers/usb/musb/musbhsdma.c
index 5e83f96d6b77..1008044a3bbc 100644
--- a/drivers/usb/musb/musbhsdma.c
+++ b/drivers/usb/musb/musbhsdma.c
@@ -33,6 +33,7 @@
 #include <linux/device.h>
 #include <linux/interrupt.h>
 #include <linux/platform_device.h>
+#include <linux/slab.h>
 #include "musb_core.h"
 #include "musbhsdma.h"
 
@@ -250,14 +251,38 @@ static irqreturn_t dma_controller_irq(int irq, void *private_data)
         u8 bchannel;
         u8 int_hsdma;
 
-        u32 addr;
+        u32 addr, count;
         u16 csr;
 
         spin_lock_irqsave(&musb->lock, flags);
 
         int_hsdma = musb_readb(mbase, MUSB_HSDMA_INTR);
-        if (!int_hsdma)
-                goto done;
+
+#ifdef CONFIG_BLACKFIN
+        /* Clear DMA interrupt flags */
+        musb_writeb(mbase, MUSB_HSDMA_INTR, int_hsdma);
+#endif
+
+        if (!int_hsdma) {
+                DBG(2, "spurious DMA irq\n");
+
+                for (bchannel = 0; bchannel < MUSB_HSDMA_CHANNELS; bchannel++) {
+                        musb_channel = (struct musb_dma_channel *)
+                                        &(controller->channel[bchannel]);
+                        channel = &musb_channel->channel;
+                        if (channel->status == MUSB_DMA_STATUS_BUSY) {
+                                count = musb_read_hsdma_count(mbase, bchannel);
+
+                                if (count == 0)
+                                        int_hsdma |= (1 << bchannel);
+                        }
+                }
+
+                DBG(2, "int_hsdma = 0x%x\n", int_hsdma);
+
+                if (!int_hsdma)
+                        goto done;
+        }
 
         for (bchannel = 0; bchannel < MUSB_HSDMA_CHANNELS; bchannel++) {
                 if (int_hsdma & (1 << bchannel)) {
@@ -280,7 +305,7 @@ static irqreturn_t dma_controller_irq(int irq, void *private_data)
                                 channel->actual_len = addr
                                         - musb_channel->start_addr;
 
-                                DBG(2, "ch %p, 0x%x -> 0x%x (%d / %d) %s\n",
+                                DBG(2, "ch %p, 0x%x -> 0x%x (%zu / %d) %s\n",
                                         channel, musb_channel->start_addr,
                                         addr, channel->actual_len,
                                         musb_channel->len,
@@ -324,11 +349,6 @@ static irqreturn_t dma_controller_irq(int irq, void *private_data)
                 }
         }
 
-#ifdef CONFIG_BLACKFIN
-        /* Clear DMA interrup flags */
-        musb_writeb(mbase, MUSB_HSDMA_INTR, int_hsdma);
-#endif
-
         retval = IRQ_HANDLED;
 done:
         spin_unlock_irqrestore(&musb->lock, flags);