usb: renesas_usbhs: add power control function

Signed-off-by: Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>

diff --git a/drivers/usb/renesas_usbhs/common.c b/drivers/usb/renesas_usbhs/common.c
index 53be4443b5edf23215e0b882c22b85ab37ac65e0..db13cef9effe41d2b5d174fcbf715a9c6e5dd724 100644 (file)
--- a/drivers/usb/renesas_usbhs/common.c
+++ b/drivers/usb/renesas_usbhs/common.c
@@ -148,7 +148,31 @@ static u32 usbhsc_default_pipe_type[] = {
 };
 
 /*
- *             driver callback functions
+ *             power control
+ */
+static void usbhsc_power_ctrl(struct usbhs_priv *priv, int enable)
+{
+       struct device *dev = usbhs_priv_to_dev(priv);
+
+       if (enable) {
+               /* enable PM */
+               pm_runtime_get_sync(dev);
+
+               /* USB on */
+               usbhs_sys_clock_ctrl(priv, enable);
+               usbhsc_bus_ctrl(priv, enable);
+       } else {
+               /* USB off */
+               usbhsc_bus_ctrl(priv, enable);
+               usbhs_sys_clock_ctrl(priv, enable);
+
+               /* disable PM */
+               pm_runtime_put_sync(dev);
+       }
+}
+
+/*
+ *             notify hotplug
  */
 static void usbhsc_notify_hotplug(struct work_struct *work)
 {
@@ -178,12 +202,8 @@ static void usbhsc_notify_hotplug(struct work_struct *work)
 
                dev_dbg(&pdev->dev, "%s enable\n", __func__);
 
-               /* enable PM */
-               pm_runtime_get_sync(&pdev->dev);
-
-               /* USB on */
-               usbhs_sys_clock_ctrl(priv, enable);
-               usbhsc_bus_ctrl(priv, enable);
+               /* power on */
+               usbhsc_power_ctrl(priv, enable);
 
                /* module start */
                usbhs_mod_call(priv, start, priv);
@@ -194,12 +214,8 @@ static void usbhsc_notify_hotplug(struct work_struct *work)
                /* module stop */
                usbhs_mod_call(priv, stop, priv);
 
-               /* USB off */
-               usbhsc_bus_ctrl(priv, enable);
-               usbhs_sys_clock_ctrl(priv, enable);
-
-               /* disable PM */
-               pm_runtime_put_sync(&pdev->dev);
+               /* power off */
+               usbhsc_power_ctrl(priv, enable);
 
                usbhs_mod_change(priv, -1);