[PATCH 2/3] usb: dwc3: gadget: implement ->reset notification

[Felipe Balbi]

After introducing the new ->reset method on
struct usb_gadget_driver, UDC drivers are
required to implement proper handling for it.

This patch adds proper ->reset handling for
dwc3 driver.

Signed-off-by: Felipe Balbi <ba...@ti.com>
---
 drivers/usb/dwc3/gadget.c | 22 ++++++++++++++++++++--
 1 file changed, 20 insertions(+), 2 deletions(-)

diff --git a/drivers/usb/dwc3/gadget.c b/drivers/usb/dwc3/gadget.c
index e09a7c4..1c7da22 100644
--- a/drivers/usb/dwc3/gadget.c
+++ b/drivers/usb/dwc3/gadget.c
@@ -1846,6 +1846,25 @@ static void dwc3_disconnect_gadget(struct dwc3 *dwc)
        }
 }
 
+static void dwc3_reset_gadget(struct dwc3 *dwc)
+{
+       if (!dwc->gadget_driver)
+               return;
+
+       if (dwc->gadget_driver->reset) {
+               spin_unlock(&dwc->lock);
+               dwc->gadget_driver->reset(&dwc->gadget);
+               spin_lock(&dwc->lock);
+               return;
+       }
+
+       if (dwc->gadget_driver->disconnect) {
+               spin_unlock(&dwc->lock);
+               dwc->gadget_driver->disconnect(&dwc->gadget);
+               spin_lock(&dwc->lock);
+       }
+}
+
 static void dwc3_stop_active_transfer(struct dwc3 *dwc, u32 epnum)
 {
        struct dwc3_ep *dep;
@@ -2021,8 +2040,7 @@ static void dwc3_gadget_reset_interrupt(struct dwc3 *dwc)
                dwc3_gadget_usb3_phy_suspend(dwc, false);
        }
 
-       if (dwc->gadget.speed != USB_SPEED_UNKNOWN)
-               dwc3_disconnect_gadget(dwc);
+       dwc3_reset_gadget(dwc);
 
        reg = dwc3_readl(dwc->regs, DWC3_DCTL);
        reg &= ~DWC3_DCTL_TSTCTRL_MASK;
-- 
1.7.12.rc2

--
To unsubscribe from this list: send the line "unsubscribe linux-usb" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html