|
@@ -19,19 +19,6 @@ struct usb_phy_roothub {
|
|
|
struct list_head list;
|
|
|
};
|
|
|
|
|
|
-static struct usb_phy_roothub *usb_phy_roothub_alloc(struct device *dev)
|
|
|
-{
|
|
|
- struct usb_phy_roothub *roothub_entry;
|
|
|
-
|
|
|
- roothub_entry = devm_kzalloc(dev, sizeof(*roothub_entry), GFP_KERNEL);
|
|
|
- if (!roothub_entry)
|
|
|
- return ERR_PTR(-ENOMEM);
|
|
|
-
|
|
|
- INIT_LIST_HEAD(&roothub_entry->list);
|
|
|
-
|
|
|
- return roothub_entry;
|
|
|
-}
|
|
|
-
|
|
|
static int usb_phy_roothub_add_phy(struct device *dev, int index,
|
|
|
struct list_head *list)
|
|
|
{
|
|
@@ -45,9 +32,11 @@ static int usb_phy_roothub_add_phy(struct device *dev, int index,
|
|
|
return PTR_ERR(phy);
|
|
|
}
|
|
|
|
|
|
- roothub_entry = usb_phy_roothub_alloc(dev);
|
|
|
- if (IS_ERR(roothub_entry))
|
|
|
- return PTR_ERR(roothub_entry);
|
|
|
+ roothub_entry = devm_kzalloc(dev, sizeof(*roothub_entry), GFP_KERNEL);
|
|
|
+ if (!roothub_entry)
|
|
|
+ return -ENOMEM;
|
|
|
+
|
|
|
+ INIT_LIST_HEAD(&roothub_entry->list);
|
|
|
|
|
|
roothub_entry->phy = phy;
|
|
|
|
|
@@ -56,28 +45,44 @@ static int usb_phy_roothub_add_phy(struct device *dev, int index,
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
-struct usb_phy_roothub *usb_phy_roothub_init(struct device *dev)
|
|
|
+struct usb_phy_roothub *usb_phy_roothub_alloc(struct device *dev)
|
|
|
{
|
|
|
struct usb_phy_roothub *phy_roothub;
|
|
|
- struct usb_phy_roothub *roothub_entry;
|
|
|
- struct list_head *head;
|
|
|
int i, num_phys, err;
|
|
|
|
|
|
+ if (!IS_ENABLED(CONFIG_GENERIC_PHY))
|
|
|
+ return NULL;
|
|
|
+
|
|
|
num_phys = of_count_phandle_with_args(dev->of_node, "phys",
|
|
|
"#phy-cells");
|
|
|
if (num_phys <= 0)
|
|
|
return NULL;
|
|
|
|
|
|
- phy_roothub = usb_phy_roothub_alloc(dev);
|
|
|
- if (IS_ERR(phy_roothub))
|
|
|
- return phy_roothub;
|
|
|
+ phy_roothub = devm_kzalloc(dev, sizeof(*phy_roothub), GFP_KERNEL);
|
|
|
+ if (!phy_roothub)
|
|
|
+ return ERR_PTR(-ENOMEM);
|
|
|
+
|
|
|
+ INIT_LIST_HEAD(&phy_roothub->list);
|
|
|
|
|
|
for (i = 0; i < num_phys; i++) {
|
|
|
err = usb_phy_roothub_add_phy(dev, i, &phy_roothub->list);
|
|
|
if (err)
|
|
|
- goto err_out;
|
|
|
+ return ERR_PTR(err);
|
|
|
}
|
|
|
|
|
|
+ return phy_roothub;
|
|
|
+}
|
|
|
+EXPORT_SYMBOL_GPL(usb_phy_roothub_alloc);
|
|
|
+
|
|
|
+int usb_phy_roothub_init(struct usb_phy_roothub *phy_roothub)
|
|
|
+{
|
|
|
+ struct usb_phy_roothub *roothub_entry;
|
|
|
+ struct list_head *head;
|
|
|
+ int err;
|
|
|
+
|
|
|
+ if (!phy_roothub)
|
|
|
+ return 0;
|
|
|
+
|
|
|
head = &phy_roothub->list;
|
|
|
|
|
|
list_for_each_entry(roothub_entry, head, list) {
|
|
@@ -86,14 +91,13 @@ struct usb_phy_roothub *usb_phy_roothub_init(struct device *dev)
|
|
|
goto err_exit_phys;
|
|
|
}
|
|
|
|
|
|
- return phy_roothub;
|
|
|
+ return 0;
|
|
|
|
|
|
err_exit_phys:
|
|
|
list_for_each_entry_continue_reverse(roothub_entry, head, list)
|
|
|
phy_exit(roothub_entry->phy);
|
|
|
|
|
|
-err_out:
|
|
|
- return ERR_PTR(err);
|
|
|
+ return err;
|
|
|
}
|
|
|
EXPORT_SYMBOL_GPL(usb_phy_roothub_init);
|
|
|
|
|
@@ -111,7 +115,7 @@ int usb_phy_roothub_exit(struct usb_phy_roothub *phy_roothub)
|
|
|
list_for_each_entry(roothub_entry, head, list) {
|
|
|
err = phy_exit(roothub_entry->phy);
|
|
|
if (err)
|
|
|
- ret = ret;
|
|
|
+ ret = err;
|
|
|
}
|
|
|
|
|
|
return ret;
|
|
@@ -156,3 +160,38 @@ void usb_phy_roothub_power_off(struct usb_phy_roothub *phy_roothub)
|
|
|
phy_power_off(roothub_entry->phy);
|
|
|
}
|
|
|
EXPORT_SYMBOL_GPL(usb_phy_roothub_power_off);
|
|
|
+
|
|
|
+int usb_phy_roothub_suspend(struct device *controller_dev,
|
|
|
+ struct usb_phy_roothub *phy_roothub)
|
|
|
+{
|
|
|
+ usb_phy_roothub_power_off(phy_roothub);
|
|
|
+
|
|
|
+ /* keep the PHYs initialized so the device can wake up the system */
|
|
|
+ if (device_may_wakeup(controller_dev))
|
|
|
+ return 0;
|
|
|
+
|
|
|
+ return usb_phy_roothub_exit(phy_roothub);
|
|
|
+}
|
|
|
+EXPORT_SYMBOL_GPL(usb_phy_roothub_suspend);
|
|
|
+
|
|
|
+int usb_phy_roothub_resume(struct device *controller_dev,
|
|
|
+ struct usb_phy_roothub *phy_roothub)
|
|
|
+{
|
|
|
+ int err;
|
|
|
+
|
|
|
+ /* if the device can't wake up the system _exit was called */
|
|
|
+ if (!device_may_wakeup(controller_dev)) {
|
|
|
+ err = usb_phy_roothub_init(phy_roothub);
|
|
|
+ if (err)
|
|
|
+ return err;
|
|
|
+ }
|
|
|
+
|
|
|
+ err = usb_phy_roothub_power_on(phy_roothub);
|
|
|
+
|
|
|
+ /* undo _init if _power_on failed */
|
|
|
+ if (err && !device_may_wakeup(controller_dev))
|
|
|
+ usb_phy_roothub_exit(phy_roothub);
|
|
|
+
|
|
|
+ return err;
|
|
|
+}
|
|
|
+EXPORT_SYMBOL_GPL(usb_phy_roothub_resume);
|