usb: gadget: mv_udc: add shutdown function for it

put the device in idle when shutdown.

Signed-off-by: Neil Zhang <zhangwm@marvell.com>
Signed-off-by: Felipe Balbi <balbi@ti.com>

1 files changed, 12 insertions, 0 deletions

diff --git a/drivers/usb/gadget/mv_udc_core.c b/drivers/usb/gadget/mv_udc_core.c
index f8dc5b3dd79..ffa6f3097a6 100644
--- a/drivers/usb/gadget/mv_udc_core.c
+++ b/drivers/usb/gadget/mv_udc_core.c
@@ -2206,9 +2206,21 @@ static const struct dev_pm_ops mv_udc_pm_ops = {
 };
 #endif
 
+static void mv_udc_shutdown(struct platform_device *dev)
+{
+        struct mv_udc *udc = the_controller;
+        u32 mode;
+
+        /* reset controller mode to IDLE */
+        mode = readl(&udc->op_regs->usbmode);
+        mode &= ~3;
+        writel(mode, &udc->op_regs->usbmode);
+}
+
 static struct platform_driver udc_driver = {
         .probe          = mv_udc_probe,
         .remove         = __exit_p(mv_udc_remove),
+        .shutdown       = mv_udc_shutdown,
         .driver         = {
                 .owner  = THIS_MODULE,
                 .name   = "pxa-u2o",