From: Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
Date: Thu, 28 Apr 2011 07:41:02 +0000 (+0900)
Subject: usb: renesas_usbhs: add power control function
X-Git-Tag: v3.0-rc1~337^2~116
X-Git-Url: https://openfabrics.org/gitweb/?a=commitdiff_plain;h=6e267da8f10b1a6551b6c4dee3779f6f56e2644d;p=~shefty%2Frdma-dev.git

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 53be4443b5e..db13cef9eff 100644
--- 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);