Something went wrong. Try again.
(I'm so sorry!) Linux kernel mirror (for testing) git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel os linux
Something went wrong. Try again.
123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372// 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;};
/* Allocate the roothub_entry by specific name of phy */static int usb_phy_roothub_add_phy_by_name(struct device *dev, const char *name, struct list_head *list){ struct usb_phy_roothub *roothub_entry; struct phy *phy;
phy = devm_of_phy_get(dev, dev->of_node, name); if (IS_ERR(phy)) 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;}
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);
if (!usb_phy_roothub_add_phy_by_name(dev, "usb2-phy", &phy_roothub->list)) return phy_roothub;
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);
/** * usb_phy_roothub_alloc_usb3_phy - alloc the roothub * @dev: the device of the host controller * * Allocate the usb phy roothub if the host use a generic usb3-phy. * * Return: On success, a pointer to the usb_phy_roothub. Otherwise, * %NULL if no use usb3 phy or %-ENOMEM if out of memory. */struct usb_phy_roothub *usb_phy_roothub_alloc_usb3_phy(struct device *dev){ struct usb_phy_roothub *phy_roothub; int num_phys, usb2_phy_index;
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;
/* * If 'usb2-phy' is not present, usb_phy_roothub_alloc() added * all PHYs to the primary HCD's phy_roothub already, so skip * adding 'usb3-phy' here to avoid double use of that. */ usb2_phy_index = of_property_match_string(dev->of_node, "phy-names", "usb2-phy"); if (usb2_phy_index < 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);
if (!usb_phy_roothub_add_phy_by_name(dev, "usb3-phy", &phy_roothub->list)) return phy_roothub;
return NULL;}EXPORT_SYMBOL_GPL(usb_phy_roothub_alloc_usb3_phy);
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) return err; }
return 0;}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);
/** * usb_phy_roothub_notify_connect() - connect notification * @phy_roothub: the phy of roothub, if the host use a generic phy. * @port: the port index for connect * * If the phy needs to get connection status, the callback can be used. * Returns: %0 if successful, a negative error code otherwise */int usb_phy_roothub_notify_connect(struct usb_phy_roothub *phy_roothub, int port){ 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_notify_connect(roothub_entry->phy, port); if (err) return err; }
return 0;}EXPORT_SYMBOL_GPL(usb_phy_roothub_notify_connect);
/** * usb_phy_roothub_notify_disconnect() - disconnect notification * @phy_roothub: the phy of roothub, if the host use a generic phy. * @port: the port index for disconnect * * If the phy needs to get connection status, the callback can be used. * Returns: %0 if successful, a negative error code otherwise */int usb_phy_roothub_notify_disconnect(struct usb_phy_roothub *phy_roothub, int port){ 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_notify_disconnect(roothub_entry->phy, port); if (err) return err; }
return 0;}EXPORT_SYMBOL_GPL(usb_phy_roothub_notify_disconnect);
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);