Message ID | 20170903213829.6589-3-martin.blumenstingl@googlemail.com (mailing list archive) |
---|---|
State | Not Applicable |
Headers | show |
On 04.09.2017 00:38, Martin Blumenstingl wrote: > Many SoC platforms have separate devices for the USB PHY which are > registered through the generic PHY framework. These PHYs have to be > enabled to make the USB controller actually work. They also have to be > disabled again on shutdown/suspend. > > Currently (at least) the following HCI platform drivers are using custom > code to obtain all PHYs via devicetree for the roothub/controller and > disable/enable them when required: > - ehci-platform.c has ehci_platform_power_{on,off} > - xhci-mtk.c has xhci_mtk_phy_{init,exit,power_on,power_off} > - ohci-platform.c has ohci_platform_power_{on,off} > > These drivers are not using the generic devicetree USB device bindings > yet which were only introduced recently (documentation is available in > devicetree/bindings/usb/usb-device.txt). > With this new driver the usb2-phy and usb3-phy can be specified directly > in the child-node of the corresponding port of the roothub via > devicetree. This can be extended by not just parsing PHYs (some of the > other drivers listed above are for example also parsing a list of clocks > as well) when required. usb_add_hcd() in usb/core/hcd.c is already finding, initializing and turning on a phy, would it make sense to expand that one to support several phys instead? xhci will add two hcd's one for USB2 and one for USB3 > > Signed-off-by: Martin Blumenstingl <martin.blumenstingl@googlemail.com> > Tested-by: Chunfeng Yun <chunfeng.yun@mediatek.com> > --- > drivers/usb/host/Kconfig | 3 + > drivers/usb/host/Makefile | 2 + > drivers/usb/host/platform-roothub.c | 180 ++++++++++++++++++++++++++++++++++++ > drivers/usb/host/platform-roothub.h | 12 +++ > 4 files changed, 197 insertions(+) > create mode 100644 drivers/usb/host/platform-roothub.c > create mode 100644 drivers/usb/host/platform-roothub.h > Instead of creating platform-roothub files could this content be added into into core/hcd.*, core/phy.* and host/xhci-plat.c > diff --git a/drivers/usb/host/Kconfig b/drivers/usb/host/Kconfig > index fa5692dec832..b8b05c786b2a 100644 > --- a/drivers/usb/host/Kconfig > +++ b/drivers/usb/host/Kconfig > @@ -805,6 +805,9 @@ config USB_HCD_SSB > > If unsure, say N. > > +config USB_PLATFORM_ROOTHUB > + bool > + > config USB_HCD_TEST_MODE > bool "HCD test mode support" > ---help--- > diff --git a/drivers/usb/host/Makefile b/drivers/usb/host/Makefile > index cf2691fffcc0..dc817f82d632 100644 > --- a/drivers/usb/host/Makefile > +++ b/drivers/usb/host/Makefile > @@ -29,6 +29,8 @@ obj-$(CONFIG_USB_WHCI_HCD) += whci/ > > obj-$(CONFIG_USB_PCI) += pci-quirks.o > > +obj-$(CONFIG_USB_PLATFORM_ROOTHUB) += platform-roothub.o > + > obj-$(CONFIG_USB_EHCI_HCD) += ehci-hcd.o > obj-$(CONFIG_USB_EHCI_PCI) += ehci-pci.o > obj-$(CONFIG_USB_EHCI_HCD_PLATFORM) += ehci-platform.o > diff --git a/drivers/usb/host/platform-roothub.c b/drivers/usb/host/platform-roothub.c > new file mode 100644 > index 000000000000..70d2d97aa8b2 > --- /dev/null > +++ b/drivers/usb/host/platform-roothub.c > @@ -0,0 +1,180 @@ > +/* > + * platform roothub driver - a virtual PHY device which passes all phy_* > + * function calls to multiple (actual) PHY devices. This is comes handy when > + * initializing all PHYs on a root-hub (to keep them all in the same state). > + * > + * Copyright (C) 2017 Martin Blumenstingl <martin.blumenstingl@googlemail.com> > + * > + * This program is free software; you can redistribute it and/or modify > + * it under the terms of the GNU General Public License version 2 as > + * published by the Free Software Foundation. > + * > + * You should have received a copy of the GNU General Public License > + * along with this program. If not, see <http://www.gnu.org/licenses/>. > + */ > + > +#include <linux/device.h> > +#include <linux/list.h> > +#include <linux/phy/phy.h> > +#include <linux/of.h> > +#include <linux/usb/of.h> > + > +#include "platform-roothub.h" > + > +#define ROOTHUB_PORTNUM 0 > + > +struct platform_roothub { > + struct phy *phy; > + struct list_head list; > +}; > + > +static struct platform_roothub *platform_roothub_alloc(struct device *dev) > +{ > + struct platform_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 platform_roothub_add_phy(struct device *dev, > + struct device_node *port_np, > + const char *con_id, struct list_head *list) > +{ > + struct platform_roothub *roothub_entry; > + struct phy *phy = devm_of_phy_get(dev, port_np, con_id); > + > + if (IS_ERR_OR_NULL(phy)) { > + if (!phy || PTR_ERR(phy) == -ENODEV) > + return 0; > + else > + return PTR_ERR(phy); > + } > + > + roothub_entry = platform_roothub_alloc(dev); > + if (IS_ERR(roothub_entry)) > + return PTR_ERR(roothub_entry); > + > + roothub_entry->phy = phy; > + > + list_add_tail(&roothub_entry->list, list); > + > + return 0; > +} > + > +struct platform_roothub *platform_roothub_init(struct device *dev) > +{ > + struct device_node *roothub_np, *port_np; > + struct platform_roothub *plat_roothub; > + struct platform_roothub *roothub_entry; > + struct list_head *head; > + int err; > + > + roothub_np = usb_of_get_child_node(dev->of_node, ROOTHUB_PORTNUM); > + if (!of_device_is_available(roothub_np)) > + return NULL; > + > + plat_roothub = platform_roothub_alloc(dev); > + if (IS_ERR(plat_roothub)) > + return plat_roothub; > + > + for_each_available_child_of_node(roothub_np, port_np) { > + err = platform_roothub_add_phy(dev, port_np, "usb2-phy", > + &plat_roothub->list); > + if (err) > + goto err_out; > + > + err = platform_roothub_add_phy(dev, port_np, "usb3-phy", > + &plat_roothub->list); So if the first 10 ports have the same phy, and 11th and 12th have an other one, won't we end up with a phy list with 12 entries for 2 phys, and initialize and turn on the same first phy 10 times? I'm also not sure I understand the reason for having the "usb3-phy" and "usb2-phy" phy-names for the ports if we anyways just add everything to one list. -Mathias
Hi Mathias, thank you for taking the time to go through my patch On Wed, Oct 4, 2017 at 3:05 PM, Mathias Nyman <mathias.nyman@linux.intel.com> wrote: > On 04.09.2017 00:38, Martin Blumenstingl wrote: >> >> Many SoC platforms have separate devices for the USB PHY which are >> registered through the generic PHY framework. These PHYs have to be >> enabled to make the USB controller actually work. They also have to be >> disabled again on shutdown/suspend. >> >> Currently (at least) the following HCI platform drivers are using custom >> code to obtain all PHYs via devicetree for the roothub/controller and >> disable/enable them when required: >> - ehci-platform.c has ehci_platform_power_{on,off} >> - xhci-mtk.c has xhci_mtk_phy_{init,exit,power_on,power_off} >> - ohci-platform.c has ohci_platform_power_{on,off} >> >> These drivers are not using the generic devicetree USB device bindings >> yet which were only introduced recently (documentation is available in >> devicetree/bindings/usb/usb-device.txt). >> With this new driver the usb2-phy and usb3-phy can be specified directly >> in the child-node of the corresponding port of the roothub via >> devicetree. This can be extended by not just parsing PHYs (some of the >> other drivers listed above are for example also parsing a list of clocks >> as well) when required. > > > usb_add_hcd() in usb/core/hcd.c is already finding, initializing and turning > on a phy, would it make sense to expand that one to support several phys > instead? > > xhci will add two hcd's one for USB2 and one for USB3 that is a great suggestion - thank you for bringing this up! as a benefit we would add multiple PHY support for all the other use-cases I found (at least: ehci-platform.c, xhci-mtk.c, ohci-platform.c) - instead of just handling this in xhci-plat.c I have one quick question regarding usb/core/hcd.c: are hcd_bus_suspend() and hcd_bus_resume() the right places to power_{off,on} the PHYs during suspend? (currently usb/core/hcd.c doesn't touch the PHY during suspend/resume - xhci-mtk.c on the other hand seems to require it during a suspend/resume cycle) >> >> Signed-off-by: Martin Blumenstingl <martin.blumenstingl@googlemail.com> >> Tested-by: Chunfeng Yun <chunfeng.yun@mediatek.com> >> --- >> drivers/usb/host/Kconfig | 3 + >> drivers/usb/host/Makefile | 2 + >> drivers/usb/host/platform-roothub.c | 180 >> ++++++++++++++++++++++++++++++++++++ >> drivers/usb/host/platform-roothub.h | 12 +++ >> 4 files changed, 197 insertions(+) >> create mode 100644 drivers/usb/host/platform-roothub.c >> create mode 100644 drivers/usb/host/platform-roothub.h >> > > Instead of creating platform-roothub files could this content > be added into into core/hcd.*, core/phy.* and host/xhci-plat.c OK, I will try this and send a patch so we can have a look at the potential result and start a discussion based on that (if required) > >> diff --git a/drivers/usb/host/Kconfig b/drivers/usb/host/Kconfig >> index fa5692dec832..b8b05c786b2a 100644 >> --- a/drivers/usb/host/Kconfig >> +++ b/drivers/usb/host/Kconfig >> @@ -805,6 +805,9 @@ config USB_HCD_SSB >> >> If unsure, say N. >> >> +config USB_PLATFORM_ROOTHUB >> + bool >> + >> config USB_HCD_TEST_MODE >> bool "HCD test mode support" >> ---help--- >> diff --git a/drivers/usb/host/Makefile b/drivers/usb/host/Makefile >> index cf2691fffcc0..dc817f82d632 100644 >> --- a/drivers/usb/host/Makefile >> +++ b/drivers/usb/host/Makefile >> @@ -29,6 +29,8 @@ obj-$(CONFIG_USB_WHCI_HCD) += whci/ >> >> obj-$(CONFIG_USB_PCI) += pci-quirks.o >> >> +obj-$(CONFIG_USB_PLATFORM_ROOTHUB) += platform-roothub.o >> + >> obj-$(CONFIG_USB_EHCI_HCD) += ehci-hcd.o >> obj-$(CONFIG_USB_EHCI_PCI) += ehci-pci.o >> obj-$(CONFIG_USB_EHCI_HCD_PLATFORM) += ehci-platform.o >> diff --git a/drivers/usb/host/platform-roothub.c >> b/drivers/usb/host/platform-roothub.c >> new file mode 100644 >> index 000000000000..70d2d97aa8b2 >> --- /dev/null >> +++ b/drivers/usb/host/platform-roothub.c >> @@ -0,0 +1,180 @@ >> +/* >> + * platform roothub driver - a virtual PHY device which passes all phy_* >> + * function calls to multiple (actual) PHY devices. This is comes handy >> when >> + * initializing all PHYs on a root-hub (to keep them all in the same >> state). >> + * >> + * Copyright (C) 2017 Martin Blumenstingl >> <martin.blumenstingl@googlemail.com> >> + * >> + * This program is free software; you can redistribute it and/or modify >> + * it under the terms of the GNU General Public License version 2 as >> + * published by the Free Software Foundation. >> + * >> + * You should have received a copy of the GNU General Public License >> + * along with this program. If not, see <http://www.gnu.org/licenses/>. >> + */ >> + >> +#include <linux/device.h> >> +#include <linux/list.h> >> +#include <linux/phy/phy.h> >> +#include <linux/of.h> >> +#include <linux/usb/of.h> >> + >> +#include "platform-roothub.h" >> + >> +#define ROOTHUB_PORTNUM 0 >> + >> +struct platform_roothub { >> + struct phy *phy; >> + struct list_head list; >> +}; >> + >> +static struct platform_roothub *platform_roothub_alloc(struct device >> *dev) >> +{ >> + struct platform_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 platform_roothub_add_phy(struct device *dev, >> + struct device_node *port_np, >> + const char *con_id, struct list_head >> *list) >> +{ >> + struct platform_roothub *roothub_entry; >> + struct phy *phy = devm_of_phy_get(dev, port_np, con_id); >> + >> + if (IS_ERR_OR_NULL(phy)) { >> + if (!phy || PTR_ERR(phy) == -ENODEV) >> + return 0; >> + else >> + return PTR_ERR(phy); >> + } >> + >> + roothub_entry = platform_roothub_alloc(dev); >> + if (IS_ERR(roothub_entry)) >> + return PTR_ERR(roothub_entry); >> + >> + roothub_entry->phy = phy; >> + >> + list_add_tail(&roothub_entry->list, list); >> + >> + return 0; >> +} >> + >> +struct platform_roothub *platform_roothub_init(struct device *dev) >> +{ >> + struct device_node *roothub_np, *port_np; >> + struct platform_roothub *plat_roothub; >> + struct platform_roothub *roothub_entry; >> + struct list_head *head; >> + int err; >> + >> + roothub_np = usb_of_get_child_node(dev->of_node, ROOTHUB_PORTNUM); >> + if (!of_device_is_available(roothub_np)) >> + return NULL; >> + >> + plat_roothub = platform_roothub_alloc(dev); >> + if (IS_ERR(plat_roothub)) >> + return plat_roothub; >> + >> + for_each_available_child_of_node(roothub_np, port_np) { >> + err = platform_roothub_add_phy(dev, port_np, "usb2-phy", >> + &plat_roothub->list); >> + if (err) >> + goto err_out; >> + >> + err = platform_roothub_add_phy(dev, port_np, "usb3-phy", >> + &plat_roothub->list); > > > So if the first 10 ports have the same phy, and 11th and 12th have an other > one, won't we end up > with a phy list with 12 entries for 2 phys, and initialize and turn on the > same first phy 10 times? indeed, we would call phy_init() and phy_power_on() multiple times on the same PHY. however, this is not an issue since the PHY framework is doing ref-counting for us (see [0] and [1] - the PHY driver's .init() and .power_on() callbacks will only be called once for each PHY in your scenario) do you see any other issues with this? > I'm also not sure I understand the reason for having the "usb3-phy" and > "usb2-phy" phy-names > for the ports if we anyways just add everything to one list. the PHY devicetree bindings state that the "phy-names" property is mandatory: [2] when moving the whole multiple PHY logic to usb_add_hcd() then it even makes sense to look for specific PHYs (imho): - let's assume we have a XHCI controller with two ports - both ports have a USB2 PHY, but only one has a USB3 PHY - (this basically describes the situation on the Amlogic Meson GXL SoCs, Mediatek uses similar designs) this would result in the following flow: 1. usb_add_hcd is called for the high-speed HCD 2. we would parse the PHYs for the high-speed HCD 3. usb_add_hcd is called for the super-speed HCD 4. we would parse the PHYs for the super-speed HCD depending on how we parse the PHYs (mapping the controller-type to phy-name "usb2-phy" or "usb3-phy") we either end up with: - 3 PHY handles (2x USB2, 1x USB3) if we take the controller-type/phy-name into account - 6 PHY handles (doubling the amount from the use-case above) if we don't please let me know if there is an easier solution - I prefer simple code myself, so I don't want to add complexity where it's not needed. Regards, Martin [0] http://elixir.free-electrons.com/linux/v4.14-rc3/source/drivers/phy/phy-core.c#L231 [1] http://elixir.free-electrons.com/linux/v4.14-rc3/source/drivers/phy/phy-core.c#L296 [2] http://elixir.free-electrons.com/linux/v4.14-rc3/source/Documentation/devicetree/bindings/phy/phy-bindings.txt#L36
On 07.10.2017 20:08, Martin Blumenstingl wrote: > Hi Mathias, > > thank you for taking the time to go through my patch > > On Wed, Oct 4, 2017 at 3:05 PM, Mathias Nyman > <mathias.nyman@linux.intel.com> wrote: >> On 04.09.2017 00:38, Martin Blumenstingl wrote: >>> >>> Many SoC platforms have separate devices for the USB PHY which are >>> registered through the generic PHY framework. These PHYs have to be >>> enabled to make the USB controller actually work. They also have to be >>> disabled again on shutdown/suspend. >>> >>> Currently (at least) the following HCI platform drivers are using custom >>> code to obtain all PHYs via devicetree for the roothub/controller and >>> disable/enable them when required: >>> - ehci-platform.c has ehci_platform_power_{on,off} >>> - xhci-mtk.c has xhci_mtk_phy_{init,exit,power_on,power_off} >>> - ohci-platform.c has ohci_platform_power_{on,off} >>> >>> These drivers are not using the generic devicetree USB device bindings >>> yet which were only introduced recently (documentation is available in >>> devicetree/bindings/usb/usb-device.txt). >>> With this new driver the usb2-phy and usb3-phy can be specified directly >>> in the child-node of the corresponding port of the roothub via >>> devicetree. This can be extended by not just parsing PHYs (some of the >>> other drivers listed above are for example also parsing a list of clocks >>> as well) when required. >> >> >> usb_add_hcd() in usb/core/hcd.c is already finding, initializing and turning >> on a phy, would it make sense to expand that one to support several phys >> instead? >> >> xhci will add two hcd's one for USB2 and one for USB3 > that is a great suggestion - thank you for bringing this up! > as a benefit we would add multiple PHY support for all the other > use-cases I found (at least: ehci-platform.c, xhci-mtk.c, > ohci-platform.c) - instead of just handling this in xhci-plat.c > > I have one quick question regarding usb/core/hcd.c: > are hcd_bus_suspend() and hcd_bus_resume() the right places to > power_{off,on} the PHYs during suspend? > (currently usb/core/hcd.c doesn't touch the PHY during suspend/resume > - xhci-mtk.c on the other hand seems to require it during a > suspend/resume cycle) I'm not sure what would be the correct place, hcd_bus_suspend() will be called twice for xhci, oce for each hcd, so then we need to make sure we only turn off phys related to that hcd. Host controller can still be running when bus is suspended. xhci-mtk turns off phy when host controller is suspended and stopped. >> >> >> So if the first 10 ports have the same phy, and 11th and 12th have an other >> one, won't we end up >> with a phy list with 12 entries for 2 phys, and initialize and turn on the >> same first phy 10 times? > indeed, we would call phy_init() and phy_power_on() multiple times on > the same PHY. > however, this is not an issue since the PHY framework is doing > ref-counting for us (see [0] and [1] - the PHY driver's .init() and > .power_on() callbacks will only be called once for each PHY in your > scenario) Ok > do you see any other issues with this? > Not really, fine by me. >> I'm also not sure I understand the reason for having the "usb3-phy" and >> "usb2-phy" phy-names >> for the ports if we anyways just add everything to one list. > the PHY devicetree bindings state that the "phy-names" property is > mandatory: [2] > > when moving the whole multiple PHY logic to usb_add_hcd() then it even > makes sense to look for specific PHYs (imho): > - let's assume we have a XHCI controller with two ports > - both ports have a USB2 PHY, but only one has a USB3 PHY > - (this basically describes the situation on the Amlogic Meson GXL > SoCs, Mediatek uses similar designs) > > this would result in the following flow: > 1. usb_add_hcd is called for the high-speed HCD > 2. we would parse the PHYs for the high-speed HCD > 3. usb_add_hcd is called for the super-speed HCD > 4. we would parse the PHYs for the super-speed HCD > depending on how we parse the PHYs (mapping the controller-type to > phy-name "usb2-phy" or "usb3-phy") we either end up with: > - 3 PHY handles (2x USB2, 1x USB3) if we take the > controller-type/phy-name into account > - 6 PHY handles (doubling the amount from the use-case above) if we don't > > please let me know if there is an easier solution - I prefer simple > code myself, so I don't want to add complexity where it's not needed. Ah, ok, I'm used to the ACPI tables way of listing ports where a physical USB3 connector (HS & SS) is actually described as two separate ports. one HS and one SS. With this layout one port can have only one PHY. The Amlogic Meson GXL with two physical USB connectors (USB2&3 and USB2 only) would look something like this in ACPI: Device (RHUB) { ... Device (HS01) {...} Device (HS02) {...} Device (SS01) {...} xhci register layout is similar. Each port has its own port status/control register. Depending on if a USB2 or USB3 device is connected to a physical connector it will trigger different port status registers. Not sure which way is better. -Mathias
diff --git a/drivers/usb/host/Kconfig b/drivers/usb/host/Kconfig index fa5692dec832..b8b05c786b2a 100644 --- a/drivers/usb/host/Kconfig +++ b/drivers/usb/host/Kconfig @@ -805,6 +805,9 @@ config USB_HCD_SSB If unsure, say N. +config USB_PLATFORM_ROOTHUB + bool + config USB_HCD_TEST_MODE bool "HCD test mode support" ---help--- diff --git a/drivers/usb/host/Makefile b/drivers/usb/host/Makefile index cf2691fffcc0..dc817f82d632 100644 --- a/drivers/usb/host/Makefile +++ b/drivers/usb/host/Makefile @@ -29,6 +29,8 @@ obj-$(CONFIG_USB_WHCI_HCD) += whci/ obj-$(CONFIG_USB_PCI) += pci-quirks.o +obj-$(CONFIG_USB_PLATFORM_ROOTHUB) += platform-roothub.o + obj-$(CONFIG_USB_EHCI_HCD) += ehci-hcd.o obj-$(CONFIG_USB_EHCI_PCI) += ehci-pci.o obj-$(CONFIG_USB_EHCI_HCD_PLATFORM) += ehci-platform.o diff --git a/drivers/usb/host/platform-roothub.c b/drivers/usb/host/platform-roothub.c new file mode 100644 index 000000000000..70d2d97aa8b2 --- /dev/null +++ b/drivers/usb/host/platform-roothub.c @@ -0,0 +1,180 @@ +/* + * platform roothub driver - a virtual PHY device which passes all phy_* + * function calls to multiple (actual) PHY devices. This is comes handy when + * initializing all PHYs on a root-hub (to keep them all in the same state). + * + * Copyright (C) 2017 Martin Blumenstingl <martin.blumenstingl@googlemail.com> + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + * + * You should have received a copy of the GNU General Public License + * along with this program. If not, see <http://www.gnu.org/licenses/>. + */ + +#include <linux/device.h> +#include <linux/list.h> +#include <linux/phy/phy.h> +#include <linux/of.h> +#include <linux/usb/of.h> + +#include "platform-roothub.h" + +#define ROOTHUB_PORTNUM 0 + +struct platform_roothub { + struct phy *phy; + struct list_head list; +}; + +static struct platform_roothub *platform_roothub_alloc(struct device *dev) +{ + struct platform_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 platform_roothub_add_phy(struct device *dev, + struct device_node *port_np, + const char *con_id, struct list_head *list) +{ + struct platform_roothub *roothub_entry; + struct phy *phy = devm_of_phy_get(dev, port_np, con_id); + + if (IS_ERR_OR_NULL(phy)) { + if (!phy || PTR_ERR(phy) == -ENODEV) + return 0; + else + return PTR_ERR(phy); + } + + roothub_entry = platform_roothub_alloc(dev); + if (IS_ERR(roothub_entry)) + return PTR_ERR(roothub_entry); + + roothub_entry->phy = phy; + + list_add_tail(&roothub_entry->list, list); + + return 0; +} + +struct platform_roothub *platform_roothub_init(struct device *dev) +{ + struct device_node *roothub_np, *port_np; + struct platform_roothub *plat_roothub; + struct platform_roothub *roothub_entry; + struct list_head *head; + int err; + + roothub_np = usb_of_get_child_node(dev->of_node, ROOTHUB_PORTNUM); + if (!of_device_is_available(roothub_np)) + return NULL; + + plat_roothub = platform_roothub_alloc(dev); + if (IS_ERR(plat_roothub)) + return plat_roothub; + + for_each_available_child_of_node(roothub_np, port_np) { + err = platform_roothub_add_phy(dev, port_np, "usb2-phy", + &plat_roothub->list); + if (err) + goto err_out; + + err = platform_roothub_add_phy(dev, port_np, "usb3-phy", + &plat_roothub->list); + if (err) + goto err_out; + } + + head = &plat_roothub->list; + + list_for_each_entry(roothub_entry, head, list) { + err = phy_init(roothub_entry->phy); + if (err) + goto err_exit_phys; + } + + return plat_roothub; + +err_exit_phys: + list_for_each_entry_continue_reverse(roothub_entry, head, list) + phy_exit(roothub_entry->phy); + +err_out: + return ERR_PTR(err); +} +EXPORT_SYMBOL_GPL(platform_roothub_init); + +int platform_roothub_exit(struct platform_roothub *plat_roothub) +{ + struct platform_roothub *roothub_entry; + struct list_head *head; + int err, ret = 0; + + if (!plat_roothub) + return 0; + + head = &plat_roothub->list; + + list_for_each_entry(roothub_entry, head, list) { + err = phy_exit(roothub_entry->phy); + if (err) + ret = ret; + } + + return ret; +} +EXPORT_SYMBOL_GPL(platform_roothub_exit); + +int platform_roothub_power_on(struct platform_roothub *plat_roothub) +{ + struct platform_roothub *roothub_entry; + struct list_head *head; + int err; + + if (!plat_roothub) + return 0; + + head = &plat_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(platform_roothub_power_on); + +int platform_roothub_power_off(struct platform_roothub *plat_roothub) +{ + struct platform_roothub *roothub_entry; + int err, ret = 0; + + if (!plat_roothub) + return 0; + + list_for_each_entry_reverse(roothub_entry, &plat_roothub->list, list) { + err = phy_power_off(roothub_entry->phy); + if (err) + ret = err; + } + + return ret; +} +EXPORT_SYMBOL_GPL(platform_roothub_power_off); diff --git a/drivers/usb/host/platform-roothub.h b/drivers/usb/host/platform-roothub.h new file mode 100644 index 000000000000..0b801da66918 --- /dev/null +++ b/drivers/usb/host/platform-roothub.h @@ -0,0 +1,12 @@ +#ifndef USB_HOST_PLATFORM_ROOTHUB_H +#define USB_HOST_PLATFORM_ROOTHUB_H + +struct platform_roothub; + +struct platform_roothub *platform_roothub_init(struct device *dev); +int platform_roothub_exit(struct platform_roothub *plat_roothub); + +int platform_roothub_power_on(struct platform_roothub *plat_roothub); +int platform_roothub_power_off(struct platform_roothub *plat_roothub); + +#endif /* USB_HOST_PLATFORM_ROOTHUB_H */