1 files changed, 41 insertions, 3 deletions

diff --git a/drivers/usb/dwc2/platform.c b/drivers/usb/dwc2/platform.c
index 121dbdafc06b..6a795aa2ff05 100644
--- a/drivers/usb/dwc2/platform.c
+++ b/drivers/usb/dwc2/platform.c
@@ -40,6 +40,7 @@
 #include <linux/device.h>
 #include <linux/dma-mapping.h>
 #include <linux/of_device.h>
+#include <linux/mutex.h>
 #include <linux/platform_device.h>
 
 #include <linux/usb/of.h>
@@ -121,6 +122,7 @@ static int dwc2_driver_remove(struct platform_device *dev)
         struct dwc2_hsotg *hsotg = platform_get_drvdata(dev);
 
         dwc2_hcd_remove(hsotg);
+        s3c_hsotg_remove(hsotg);
 
         return 0;
 }
@@ -129,6 +131,7 @@ static const struct of_device_id dwc2_of_match_table[] = {
         { .compatible = "brcm,bcm2835-usb", .data = &params_bcm2835 },
         { .compatible = "rockchip,rk3066-usb", .data = &params_rk3066 },
         { .compatible = "snps,dwc2", .data = NULL },
+        { .compatible = "samsung,s3c6400-hsotg", .data = NULL},
         {},
 };
 MODULE_DEVICE_TABLE(of, dwc2_of_match_table);
@@ -155,9 +158,6 @@ static int dwc2_driver_probe(struct platform_device *dev)
         int retval;
         int irq;
 
-        if (usb_disabled())
-                return -ENODEV;
-
         match = of_match_device(dwc2_of_match_table, &dev->dev);
         if (match && match->data) {
                 params = match->data;
@@ -194,6 +194,14 @@ static int dwc2_driver_probe(struct platform_device *dev)
                 return irq;
         }
 
+        dev_dbg(hsotg->dev, "registering common handler for irq%d\n",
+                irq);
+        retval = devm_request_irq(hsotg->dev, irq,
+                                  dwc2_handle_common_intr, IRQF_SHARED,
+                                  dev_name(hsotg->dev), hsotg);
+        if (retval)
+                return retval;
+
         res = platform_get_resource(dev, IORESOURCE_MEM, 0);
         hsotg->regs = devm_ioremap_resource(&dev->dev, res);
         if (IS_ERR(hsotg->regs))
@@ -204,6 +212,11 @@ static int dwc2_driver_probe(struct platform_device *dev)
 
         hsotg->dr_mode = of_usb_get_dr_mode(dev->dev.of_node);
 
+        spin_lock_init(&hsotg->lock);
+        mutex_init(&hsotg->init_mutex);
+        retval = dwc2_gadget_init(hsotg, irq);
+        if (retval)
+                return retval;
         retval = dwc2_hcd_init(hsotg, irq, params);
         if (retval)
                 return retval;
@@ -213,10 +226,35 @@ static int dwc2_driver_probe(struct platform_device *dev)
         return retval;
 }
 
+static int __maybe_unused dwc2_suspend(struct device *dev)
+{
+        struct dwc2_hsotg *dwc2 = dev_get_drvdata(dev);
+        int ret = 0;
+
+        if (dwc2_is_device_mode(dwc2))
+                ret = s3c_hsotg_suspend(dwc2);
+        return ret;
+}
+
+static int __maybe_unused dwc2_resume(struct device *dev)
+{
+        struct dwc2_hsotg *dwc2 = dev_get_drvdata(dev);
+        int ret = 0;
+
+        if (dwc2_is_device_mode(dwc2))
+                ret = s3c_hsotg_resume(dwc2);
+        return ret;
+}
+
+static const struct dev_pm_ops dwc2_dev_pm_ops = {
+        SET_SYSTEM_SLEEP_PM_OPS(dwc2_suspend, dwc2_resume)
+};
+
 static struct platform_driver dwc2_platform_driver = {
         .driver = {
                 .name = dwc2_driver_name,
                 .of_match_table = dwc2_of_match_table,
+                .pm = &dwc2_dev_pm_ops,
         },
         .probe = dwc2_driver_probe,
         .remove = dwc2_driver_remove,