This patch is to add runtime pm callback for usb port device.
Set/clear PORT_POWER feature in the resume/suspend callbak.
Add portnum for struct usb_port to record port number.
Signed-off-by: Lan Tianyu <tianyu.lan@xxxxxxxxx>
---
drivers/usb/core/hub.c | 14 ++++++++++++++
drivers/usb/core/port.c | 39 +++++++++++++++++++++++++++++++++++++++
drivers/usb/core/usb.h | 2 ++
include/linux/usb.h | 2 ++
4 files changed, 57 insertions(+)
diff --git a/drivers/usb/core/hub.c b/drivers/usb/core/hub.c
index 60746aa..2cb414e 100644
--- a/drivers/usb/core/hub.c
+++ b/drivers/usb/core/hub.c
@@ -765,6 +765,20 @@ static void hub_tt_work(struct work_struct *work)
spin_unlock_irqrestore (&hub->tt.lock, flags);
}
+int usb_hub_set_port_power(struct usb_device *hdev, int port1,
+ bool set)
+{
+ int ret;
+
+ if (set)
+ ret = set_port_feature(hdev, port1,
+ USB_PORT_FEAT_POWER);
+ else
+ ret = clear_port_feature(hdev, port1,
+ USB_PORT_FEAT_POWER);
+ return ret;
+}
+
/**
* usb_hub_clear_tt_buffer - clear control/bulk TT state in high speed hub
* @urb: an URB associated with the failed or incomplete split transaction
diff --git a/drivers/usb/core/port.c b/drivers/usb/core/port.c
index 6523a03..1cda766 100644
--- a/drivers/usb/core/port.c
+++ b/drivers/usb/core/port.c
@@ -53,9 +53,45 @@ static void usb_port_device_release(struct device *dev)
kfree(port_dev);
}
+static int usb_port_runtime_resume(struct device *dev)
+{
+ struct usb_port *port_dev = to_usb_port(dev);
+ struct usb_device *hdev =
+ to_usb_device(dev->parent->parent);
+
+ return usb_hub_set_port_power(hdev, port_dev->portnum,
+ true);
+}
+
+static int usb_port_runtime_suspend(struct device *dev)
+{
+ struct usb_port *port_dev = to_usb_port(dev);
+ struct usb_device *hdev =
+ to_usb_device(dev->parent->parent);
+
+ return usb_hub_set_port_power(hdev, port_dev->portnum,
+ false);
+}
+
+static int usb_port_runtime_idle(struct device *dev)
+{
+ struct usb_port *port_dev = to_usb_port(dev);
+
+ return pm_runtime_suspend(&port_dev->dev);
+}
+
+static const struct dev_pm_ops usb_port_pm_ops = {
+#ifdef CONFIG_USB_SUSPEND
+.runtime_suspend = usb_port_runtime_suspend,
+.runtime_resume = usb_port_runtime_resume,
+.runtime_idle = usb_port_runtime_idle,
+#endif
+};
+
struct device_type usb_port_device_type = {
.name = "usb_port",
.release = usb_port_device_release,
+ .pm = &usb_port_pm_ops,
};
int usb_hub_create_port_device(struct device *intfdev,
@@ -63,6 +99,7 @@ int usb_hub_create_port_device(struct device *intfdev,
{
int retval;
+ port_dev->portnum = port1;
port_dev->dev.parent = intfdev;
port_dev->dev.groups = port_dev_group;
port_dev->dev.type = &usb_port_device_type;
@@ -72,6 +109,8 @@ int usb_hub_create_port_device(struct device *intfdev,
if (retval)
goto error_register;
+ pm_runtime_set_active(&port_dev->dev);
+ pm_runtime_enable(&port_dev->dev);
usb_acpi_register_power_resources(&port_dev->dev);
return 0;
diff --git a/drivers/usb/core/usb.h b/drivers/usb/core/usb.h
index de7434b..47d77d4 100644
--- a/drivers/usb/core/usb.h
+++ b/drivers/usb/core/usb.h
@@ -62,6 +62,8 @@ extern void usb_major_cleanup(void);
extern int usb_hub_create_port_device(struct device *intfdev,
int port1, struct usb_port *port_dev);
+extern int usb_hub_set_port_power(struct usb_device *hdev,
+ int port1, bool set);
#ifdef CONFIG_PM
diff --git a/include/linux/usb.h b/include/linux/usb.h
index c1f1346..71510bf 100644
--- a/include/linux/usb.h
+++ b/include/linux/usb.h
@@ -578,12 +578,14 @@ struct usb_device {
* @dev: generic device interface
* @port_owner: port's owner
* @connect_type: port's connect type
+ * @portnum: port index num based one
*/
struct usb_port {
struct usb_device *child;
struct device dev;
struct dev_state *port_owner;
enum usb_port_connect_type connect_type;
+ u8 portnum;
};
#define to_usb_port(_dev) \
container_of(_dev, struct usb_port, dev)
--
1.7.10.4
--
To unsubscribe from this list: send the line "unsubscribe linux-usb" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
