ENGR00320439-5 usb: chipidea: udc: save and restore routine for power lost of udc

Set OP_ENDPTLISTADDR value to be non-zero for power lost check if its value is 0
when suspend. If the controller experienced a power lost in device mode, only
force a disconnection if vbus on, and enable vbus irq.

Signed-off-by: Li Jun <b47624@freescale.com>

1 files changed, 25 insertions, 0 deletions

diff --git a/drivers/usb/chipidea/udc.c b/drivers/usb/chipidea/udc.c
index 85cdeba60fe6..d84aefde1a79 100644
--- a/drivers/usb/chipidea/udc.c
+++ b/drivers/usb/chipidea/udc.c
@@ -1937,6 +1937,29 @@ static void udc_id_switch_for_host(struct ci_hdrc *ci)
                 hw_write_otgsc(ci, OTGSC_BSVIE | OTGSC_BSVIS, OTGSC_BSVIS);
 }
 
+static void udc_suspend_for_power_lost(struct ci_hdrc *ci)
+{
+        /*
+         * Set OP_ENDPTLISTADDR to be non-zero for
+         * checking if controller resume from power lost
+         * in non-host mode.
+         */
+        if (hw_read(ci, OP_ENDPTLISTADDR, ~0) == 0)
+                hw_write(ci, OP_ENDPTLISTADDR, ~0, ~0);
+}
+
+/* Power lost with device mode */
+static void udc_resume_from_power_lost(struct ci_hdrc *ci)
+{
+        /* Force disconnect if power lost with vbus on */
+        if (ci->vbus_active)
+                usb_gadget_vbus_disconnect(&ci->gadget);
+
+        if (ci->is_otg)
+                hw_write_otgsc(ci, OTGSC_BSVIS | OTGSC_BSVIE,
+                                        OTGSC_BSVIS | OTGSC_BSVIE);
+}
+
 /**
  * ci_hdrc_gadget_init - initialize device related bits
  * ci: the controller
@@ -1957,6 +1980,8 @@ int ci_hdrc_gadget_init(struct ci_hdrc *ci)
         rdrv->start     = udc_id_switch_for_device;
         rdrv->stop      = udc_id_switch_for_host;
         rdrv->irq       = udc_irq;
+        rdrv->save = udc_suspend_for_power_lost;
+        rdrv->restore = udc_resume_from_power_lost;
         rdrv->name      = "gadget";
         ci->roles[CI_ROLE_GADGET] = rdrv;