usb: cdns3: add power lost support for system resume

If the controller lost its power during the system suspend, we need
to do all initialiation operations.

Signed-off-by: Peter Chen <peter.chen@nxp.com>
Signed-off-by: Frank Li <frank.li@nxp.com>
Signed-off-by: Peter Chen <peter.chen@kernel.org>

diff --git a/drivers/usb/cdns3/cdns3-gadget.c b/drivers/usb/cdns3/cdns3-gadget.c
index 582bfec..44b7301 100644 (file)
--- a/drivers/usb/cdns3/cdns3-gadget.c
+++ b/drivers/usb/cdns3/cdns3-gadget.c
@@ -3304,6 +3304,8 @@ static int cdns3_gadget_resume(struct cdns *cdns, bool hibernated)
                return 0;
 
        cdns3_gadget_config(priv_dev);
+       if (hibernated)
+               writel(USB_CONF_DEVEN, &priv_dev->regs->usb_conf);
 
        return 0;
 }

diff --git a/drivers/usb/cdns3/cdns3-plat.c b/drivers/usb/cdns3/cdns3-plat.c
index 4b18e1c..e1deead 100644 (file)
--- a/drivers/usb/cdns3/cdns3-plat.c
+++ b/drivers/usb/cdns3/cdns3-plat.c
@@ -19,6 +19,7 @@
 
 #include "core.h"
 #include "gadget-export.h"
+#include "drd.h"
 
 static int set_phy_power_on(struct cdns *cdns)
 {
@@ -236,6 +237,18 @@ static int cdns3_controller_resume(struct device *dev, pm_message_t msg)
        if (!cdns->in_lpm)
                return 0;
 
+       if (cdns_power_is_lost(cdns)) {
+               phy_exit(cdns->usb2_phy);
+               ret = phy_init(cdns->usb2_phy);
+               if (ret)
+                       return ret;
+
+               phy_exit(cdns->usb3_phy);
+               ret = phy_init(cdns->usb3_phy);
+               if (ret)
+                       return ret;
+       }
+
        ret = set_phy_power_on(cdns);
        if (ret)
                return ret;
@@ -270,10 +283,18 @@ static int cdns3_plat_runtime_resume(struct device *dev)
 static int cdns3_plat_suspend(struct device *dev)
 {
        struct cdns *cdns = dev_get_drvdata(dev);
+       int ret;
 
        cdns_suspend(cdns);
 
-       return cdns3_controller_suspend(dev, PMSG_SUSPEND);
+       ret = cdns3_controller_suspend(dev, PMSG_SUSPEND);
+       if (ret)
+               return ret;
+
+       if (device_may_wakeup(dev) && cdns->wakeup_irq)
+               enable_irq_wake(cdns->wakeup_irq);
+
+       return ret;
 }
 
 static int cdns3_plat_resume(struct device *dev)

diff --git a/drivers/usb/cdns3/core.c b/drivers/usb/cdns3/core.c
index 1997137..5d486c8 100644 (file)
--- a/drivers/usb/cdns3/core.c
+++ b/drivers/usb/cdns3/core.c
@@ -525,9 +525,36 @@ EXPORT_SYMBOL_GPL(cdns_suspend);
 int cdns_resume(struct cdns *cdns, u8 set_active)
 {
        struct device *dev = cdns->dev;
+       enum usb_role real_role;
+       bool role_changed = false;
+       int ret;
+
+       if (cdns_power_is_lost(cdns)) {
+               if (cdns->role_sw) {
+                       cdns->role = cdns_role_get(cdns->role_sw);
+               } else {
+                       real_role = cdns_hw_role_state_machine(cdns);
+                       if (real_role != cdns->role) {
+                               ret = cdns_hw_role_switch(cdns);
+                               if (ret)
+                                       return ret;
+                               role_changed = true;
+                       }
+               }
+
+               if (!role_changed) {
+                       if (cdns->role == USB_ROLE_HOST)
+                               ret = cdns_drd_host_on(cdns);
+                       else if (cdns->role == USB_ROLE_DEVICE)
+                               ret = cdns_drd_gadget_on(cdns);
+
+                       if (ret)
+                               return ret;
+               }
+       }
 
        if (cdns->roles[cdns->role]->resume)
-               cdns->roles[cdns->role]->resume(cdns, false);
+               cdns->roles[cdns->role]->resume(cdns, cdns_power_is_lost(cdns));
 
        if (set_active) {
                pm_runtime_disable(dev);

diff --git a/drivers/usb/cdns3/drd.c b/drivers/usb/cdns3/drd.c
index fa5318a..55c73b1 100644 (file)
--- a/drivers/usb/cdns3/drd.c
+++ b/drivers/usb/cdns3/drd.c
@@ -478,3 +478,18 @@ int cdns_drd_exit(struct cdns *cdns)
 
        return 0;
 }
+
+
+/* Indicate the cdns3 core was power lost before */
+bool cdns_power_is_lost(struct cdns *cdns)
+{
+       if (cdns->version == CDNS3_CONTROLLER_V1) {
+               if (!(readl(&cdns->otg_v1_regs->simulate) & BIT(0)))
+                       return true;
+       } else {
+               if (!(readl(&cdns->otg_v0_regs->simulate) & BIT(0)))
+                       return true;
+       }
+       return false;
+}
+EXPORT_SYMBOL_GPL(cdns_power_is_lost);

diff --git a/drivers/usb/cdns3/drd.h b/drivers/usb/cdns3/drd.h
index 9724acd..cbdf94f 100644 (file)
--- a/drivers/usb/cdns3/drd.h
+++ b/drivers/usb/cdns3/drd.h
@@ -215,5 +215,5 @@ int cdns_drd_gadget_on(struct cdns *cdns);
 void cdns_drd_gadget_off(struct cdns *cdns);
 int cdns_drd_host_on(struct cdns *cdns);
 void cdns_drd_host_off(struct cdns *cdns);
-
+bool cdns_power_is_lost(struct cdns *cdns);
 #endif /* __LINUX_CDNS3_DRD */