No need to check for "DWC2_POWER_DOWN_PARAM_HIBERNATION" param
as "hsotg->hibernated" flag is already enough for exiting from
hibernation mode.

- Removes checking of "DWC2_POWER_DOWN_PARAM_HIBERNATION" param.

- For code readability Hibernation exit code moved after
debug message print.

- Added "dwc2_exit_hibernation()" function error checking.

Signed-off-by: Artur Petrosyan <arthur.petros...@synopsys.com>
---
 drivers/usb/dwc2/hcd.c | 17 +++++++++++------
 1 file changed, 11 insertions(+), 6 deletions(-)

diff --git a/drivers/usb/dwc2/hcd.c b/drivers/usb/dwc2/hcd.c
index 04a1b53d65af..cda3f931195d 100644
--- a/drivers/usb/dwc2/hcd.c
+++ b/drivers/usb/dwc2/hcd.c
@@ -3668,9 +3668,17 @@ static int dwc2_hcd_hub_control(struct dwc2_hsotg 
*hsotg, u16 typereq,
                        break;
 
                case USB_PORT_FEAT_RESET:
-                       if (hsotg->params.power_down == 
DWC2_POWER_DOWN_PARAM_HIBERNATION &&
-                           hsotg->hibernated)
-                               dwc2_exit_hibernation(hsotg, 0, 1, 1);
+                       dev_dbg(hsotg->dev,
+                               "SetPortFeature - USB_PORT_FEAT_RESET\n");
+
+                       hprt0 = dwc2_read_hprt0(hsotg);
+
+                       if (hsotg->hibernated) {
+                               retval = dwc2_exit_hibernation(hsotg, 0, 1, 1);
+                               if (retval)
+                                       dev_err(hsotg->dev,
+                                               "exit hibernation failed\n");
+                       }
 
                        if (hsotg->in_ppd) {
                                retval = dwc2_exit_partial_power_down(hsotg, 1,
@@ -3684,9 +3692,6 @@ static int dwc2_hcd_hub_control(struct dwc2_hsotg *hsotg, 
u16 typereq,
                            DWC2_POWER_DOWN_PARAM_NONE && hsotg->bus_suspended)
                                dwc2_host_exit_clock_gating(hsotg, 0);
 
-                       hprt0 = dwc2_read_hprt0(hsotg);
-                       dev_dbg(hsotg->dev,
-                               "SetPortFeature - USB_PORT_FEAT_RESET\n");
                        pcgctl = dwc2_readl(hsotg, PCGCTL);
                        pcgctl &= ~(PCGCTL_ENBL_SLEEP_GATING | PCGCTL_STOPPCLK);
                        dwc2_writel(hsotg, pcgctl, PCGCTL);
-- 
2.25.1

Reply via email to