123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247 |
- // SPDX-License-Identifier: GPL-2.0+
- /*
- * A wrapper for multiple PHYs which passes all phy_* function calls to
- * multiple (actual) PHY devices. This is comes handy when initializing
- * all PHYs on a HCD and to keep them all in the same state.
- *
- * Copyright (C) 2018 Martin Blumenstingl <martin.blumenstingl@googlemail.com>
- */
- #include <linux/device.h>
- #include <linux/list.h>
- #include <linux/phy/phy.h>
- #include <linux/of.h>
- #include "phy.h"
- struct usb_phy_roothub {
- struct phy *phy;
- struct list_head list;
- };
- static int usb_phy_roothub_add_phy(struct device *dev, int index,
- struct list_head *list)
- {
- struct usb_phy_roothub *roothub_entry;
- struct phy *phy;
- phy = devm_of_phy_get_by_index(dev, dev->of_node, index);
- if (IS_ERR(phy)) {
- if (PTR_ERR(phy) == -ENODEV)
- return 0;
- else
- return PTR_ERR(phy);
- }
- 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;
- list_add_tail(&roothub_entry->list, list);
- return 0;
- }
- struct usb_phy_roothub *usb_phy_roothub_alloc(struct device *dev)
- {
- struct usb_phy_roothub *phy_roothub;
- 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 = 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)
- 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) {
- err = phy_init(roothub_entry->phy);
- if (err)
- goto err_exit_phys;
- }
- return 0;
- err_exit_phys:
- list_for_each_entry_continue_reverse(roothub_entry, head, list)
- phy_exit(roothub_entry->phy);
- return err;
- }
- EXPORT_SYMBOL_GPL(usb_phy_roothub_init);
- int usb_phy_roothub_exit(struct usb_phy_roothub *phy_roothub)
- {
- struct usb_phy_roothub *roothub_entry;
- struct list_head *head;
- int err, ret = 0;
- if (!phy_roothub)
- return 0;
- head = &phy_roothub->list;
- list_for_each_entry(roothub_entry, head, list) {
- err = phy_exit(roothub_entry->phy);
- if (err)
- ret = err;
- }
- return ret;
- }
- EXPORT_SYMBOL_GPL(usb_phy_roothub_exit);
- int usb_phy_roothub_set_mode(struct usb_phy_roothub *phy_roothub,
- enum phy_mode mode)
- {
- 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) {
- err = phy_set_mode(roothub_entry->phy, mode);
- if (err)
- goto err_out;
- }
- return 0;
- err_out:
- list_for_each_entry_continue_reverse(roothub_entry, head, list)
- phy_power_off(roothub_entry->phy);
- return err;
- }
- EXPORT_SYMBOL_GPL(usb_phy_roothub_set_mode);
- int usb_phy_roothub_calibrate(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) {
- err = phy_calibrate(roothub_entry->phy);
- if (err)
- return err;
- }
- return 0;
- }
- EXPORT_SYMBOL_GPL(usb_phy_roothub_calibrate);
- int usb_phy_roothub_power_on(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) {
- err = phy_power_on(roothub_entry->phy);
- if (err)
- goto err_out;
- }
- return 0;
- err_out:
- list_for_each_entry_continue_reverse(roothub_entry, head, list)
- phy_power_off(roothub_entry->phy);
- return err;
- }
- EXPORT_SYMBOL_GPL(usb_phy_roothub_power_on);
- void usb_phy_roothub_power_off(struct usb_phy_roothub *phy_roothub)
- {
- struct usb_phy_roothub *roothub_entry;
- if (!phy_roothub)
- return;
- list_for_each_entry_reverse(roothub_entry, &phy_roothub->list, list)
- 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);
|