usb: dwc2: Update dwc2_handle_incomplete_isoc_in() function

Disabled only that ISOC endpoints,for which interrupt bit was set
in the DAINTMSK register. This will allow to minimize incomplete
ISOC IN interrupt handling.

Acked-by: John Youn <johnyoun@synopsys.com>
Signed-off-by: Razmik Karapetyan <razmik@synopsys.com>
Signed-off-by: Minas Harutyunyan <hminas@synopsys.com>
Signed-off-by: Grigor Tovmasyan <tovmasya@synopsys.com>
Signed-off-by: Felipe Balbi <felipe.balbi@linux.intel.com>

diff --git a/drivers/usb/dwc2/gadget.c b/drivers/usb/dwc2/gadget.c
index 3cc1e37..8e42537 100644 (file)
--- a/drivers/usb/dwc2/gadget.c
+++ b/drivers/usb/dwc2/gadget.c
@@ -3412,14 +3412,21 @@ static void dwc2_gadget_handle_incomplete_isoc_in(struct dwc2_hsotg *hsotg)
 {
        struct dwc2_hsotg_ep *hs_ep;
        u32 epctrl;
+       u32 daintmsk;
        u32 idx;
 
        dev_dbg(hsotg->dev, "Incomplete isoc in interrupt received:\n");
 
+       daintmsk = dwc2_readl(hsotg->regs + DAINTMSK);
+
        for (idx = 1; idx <= hsotg->num_of_eps; idx++) {
                hs_ep = hsotg->eps_in[idx];
+               /* Proceed only unmasked ISOC EPs */
+               if (!hs_ep->isochronous || (BIT(idx) & ~daintmsk))
+                       continue;
+
                epctrl = dwc2_readl(hsotg->regs + DIEPCTL(idx));
-               if ((epctrl & DXEPCTL_EPENA) && hs_ep->isochronous &&
+               if ((epctrl & DXEPCTL_EPENA) &&
                    dwc2_gadget_target_frame_elapsed(hs_ep)) {
                        epctrl |= DXEPCTL_SNAK;
                        epctrl |= DXEPCTL_EPDIS;