usb: dwc2: Add exit clock gating from wakeup interrupt

Added exit from clock gating mode when wakeup interrupt
is detected. To exit from the clock gating
in device mode "dwc2_gadget_exit_clock_gating()"
function is used with rem_wakeup parameter 0. To exit
clock gating in host mode "dwc2_host_exit_clock_gating()"
with rem_wakeup parameter 1.

Acked-by: Minas Harutyunyan <Minas.Harutyunyan@synopsys.com>
Signed-off-by: Artur Petrosyan <Arthur.Petrosyan@synopsys.com>
Link: https://lore.kernel.org/r/20210413073630.EF2CEA0094@mailhost.synopsys.com
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>

diff --git a/drivers/usb/dwc2/core_intr.c b/drivers/usb/dwc2/core_intr.c
index ab7fe30..c764407 100644 (file)
--- a/drivers/usb/dwc2/core_intr.c
+++ b/drivers/usb/dwc2/core_intr.c
@@ -415,17 +415,24 @@ static void dwc2_handle_wakeup_detected_intr(struct dwc2_hsotg *hsotg)
        if (dwc2_is_device_mode(hsotg)) {
                dev_dbg(hsotg->dev, "DSTS=0x%0x\n",
                        dwc2_readl(hsotg, DSTS));
-               if (hsotg->lx_state == DWC2_L2 && hsotg->in_ppd) {
-                       u32 dctl = dwc2_readl(hsotg, DCTL);
-                       /* Clear Remote Wakeup Signaling */
-                       dctl &= ~DCTL_RMTWKUPSIG;
-                       dwc2_writel(hsotg, dctl, DCTL);
-                       ret = dwc2_exit_partial_power_down(hsotg, 1,
-                                                          true);
-                       if (ret)
-                               dev_err(hsotg->dev,
-                                       "exit partial_power_down failed\n");
-                       call_gadget(hsotg, resume);
+               if (hsotg->lx_state == DWC2_L2) {
+                       if (hsotg->in_ppd) {
+                               u32 dctl = dwc2_readl(hsotg, DCTL);
+                               /* Clear Remote Wakeup Signaling */
+                               dctl &= ~DCTL_RMTWKUPSIG;
+                               dwc2_writel(hsotg, dctl, DCTL);
+                               ret = dwc2_exit_partial_power_down(hsotg, 1,
+                                                                  true);
+                               if (ret)
+                                       dev_err(hsotg->dev,
+                                               "exit partial_power_down failed\n");
+                               call_gadget(hsotg, resume);
+                       }
+
+                       /* Exit gadget mode clock gating. */
+                       if (hsotg->params.power_down ==
+                           DWC2_POWER_DOWN_PARAM_NONE && hsotg->bus_suspended)
+                               dwc2_gadget_exit_clock_gating(hsotg, 0);
                } else {
                        /* Change to L0 state */
                        hsotg->lx_state = DWC2_L0;
@@ -440,6 +447,10 @@ static void dwc2_handle_wakeup_detected_intr(struct dwc2_hsotg *hsotg)
                                                "exit partial_power_down failed\n");
                        }
 
+                       if (hsotg->params.power_down ==
+                           DWC2_POWER_DOWN_PARAM_NONE && hsotg->bus_suspended)
+                               dwc2_host_exit_clock_gating(hsotg, 1);
+
                        /*
                         * If we've got this quirk then the PHY is stuck upon
                         * wakeup.  Assert reset.  This will propagate out and