usb: ehci: Make the PHY handling generic
Pull out the EHCI PHY functions into the ehci-hcd.c to let other EHCI drivers use them. Signed-off-by: Marek Vasut <marek.vasut+renesas@gmail.com>
This commit is contained in:
parent
a265e5ef42
commit
b43cdf9b3f
@ -26,56 +26,6 @@ struct generic_ehci {
|
|||||||
int reset_count;
|
int reset_count;
|
||||||
};
|
};
|
||||||
|
|
||||||
static int ehci_setup_phy(struct udevice *dev, int index)
|
|
||||||
{
|
|
||||||
struct generic_ehci *priv = dev_get_priv(dev);
|
|
||||||
int ret;
|
|
||||||
|
|
||||||
ret = generic_phy_get_by_index(dev, index, &priv->phy);
|
|
||||||
if (ret) {
|
|
||||||
if (ret != -ENOENT) {
|
|
||||||
dev_err(dev, "failed to get usb phy\n");
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
} else {
|
|
||||||
ret = generic_phy_init(&priv->phy);
|
|
||||||
if (ret) {
|
|
||||||
dev_err(dev, "failed to init usb phy\n");
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
|
|
||||||
ret = generic_phy_power_on(&priv->phy);
|
|
||||||
if (ret) {
|
|
||||||
dev_err(dev, "failed to power on usb phy\n");
|
|
||||||
return generic_phy_exit(&priv->phy);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int ehci_shutdown_phy(struct udevice *dev)
|
|
||||||
{
|
|
||||||
struct generic_ehci *priv = dev_get_priv(dev);
|
|
||||||
int ret = 0;
|
|
||||||
|
|
||||||
if (generic_phy_valid(&priv->phy)) {
|
|
||||||
ret = generic_phy_power_off(&priv->phy);
|
|
||||||
if (ret) {
|
|
||||||
dev_err(dev, "failed to power off usb phy\n");
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
|
|
||||||
ret = generic_phy_exit(&priv->phy);
|
|
||||||
if (ret) {
|
|
||||||
dev_err(dev, "failed to power off usb phy\n");
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int ehci_usb_probe(struct udevice *dev)
|
static int ehci_usb_probe(struct udevice *dev)
|
||||||
{
|
{
|
||||||
struct generic_ehci *priv = dev_get_priv(dev);
|
struct generic_ehci *priv = dev_get_priv(dev);
|
||||||
@ -145,7 +95,7 @@ static int ehci_usb_probe(struct udevice *dev)
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
err = ehci_setup_phy(dev, 0);
|
err = ehci_setup_phy(dev, &priv->phy, 0);
|
||||||
if (err)
|
if (err)
|
||||||
goto reset_err;
|
goto reset_err;
|
||||||
|
|
||||||
@ -160,7 +110,7 @@ static int ehci_usb_probe(struct udevice *dev)
|
|||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
phy_err:
|
phy_err:
|
||||||
ret = ehci_shutdown_phy(dev);
|
ret = ehci_shutdown_phy(dev, &priv->phy);
|
||||||
if (ret)
|
if (ret)
|
||||||
dev_err(dev, "failed to shutdown usb phy\n");
|
dev_err(dev, "failed to shutdown usb phy\n");
|
||||||
|
|
||||||
@ -185,7 +135,7 @@ static int ehci_usb_remove(struct udevice *dev)
|
|||||||
if (ret)
|
if (ret)
|
||||||
return ret;
|
return ret;
|
||||||
|
|
||||||
ret = ehci_shutdown_phy(dev);
|
ret = ehci_shutdown_phy(dev, &priv->phy);
|
||||||
if (ret)
|
if (ret)
|
||||||
return ret;
|
return ret;
|
||||||
|
|
||||||
|
@ -1675,3 +1675,69 @@ struct dm_usb_ops ehci_usb_ops = {
|
|||||||
};
|
};
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
#ifdef CONFIG_PHY
|
||||||
|
int ehci_setup_phy(struct udevice *dev, struct phy *phy, int index)
|
||||||
|
{
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
if (!phy)
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
ret = generic_phy_get_by_index(dev, index, phy);
|
||||||
|
if (ret) {
|
||||||
|
if (ret != -ENOENT) {
|
||||||
|
dev_err(dev, "failed to get usb phy\n");
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
ret = generic_phy_init(phy);
|
||||||
|
if (ret) {
|
||||||
|
dev_err(dev, "failed to init usb phy\n");
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
ret = generic_phy_power_on(phy);
|
||||||
|
if (ret) {
|
||||||
|
dev_err(dev, "failed to power on usb phy\n");
|
||||||
|
return generic_phy_exit(phy);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
int ehci_shutdown_phy(struct udevice *dev, struct phy *phy)
|
||||||
|
{
|
||||||
|
int ret = 0;
|
||||||
|
|
||||||
|
if (!phy)
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
if (generic_phy_valid(phy)) {
|
||||||
|
ret = generic_phy_power_off(phy);
|
||||||
|
if (ret) {
|
||||||
|
dev_err(dev, "failed to power off usb phy\n");
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
ret = generic_phy_exit(phy);
|
||||||
|
if (ret) {
|
||||||
|
dev_err(dev, "failed to power off usb phy\n");
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
#else
|
||||||
|
int ehci_setup_phy(struct udevice *dev, struct phy *phy, int index)
|
||||||
|
{
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
int ehci_shutdown_phy(struct udevice *dev, struct phy *phy)
|
||||||
|
{
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
@ -9,6 +9,7 @@
|
|||||||
#define USB_EHCI_H
|
#define USB_EHCI_H
|
||||||
|
|
||||||
#include <usb.h>
|
#include <usb.h>
|
||||||
|
#include <generic-phy.h>
|
||||||
|
|
||||||
/* Section 2.2.3 - N_PORTS */
|
/* Section 2.2.3 - N_PORTS */
|
||||||
#define MAX_HC_PORTS 15
|
#define MAX_HC_PORTS 15
|
||||||
@ -288,4 +289,8 @@ int ehci_register(struct udevice *dev, struct ehci_hccr *hccr,
|
|||||||
int ehci_deregister(struct udevice *dev);
|
int ehci_deregister(struct udevice *dev);
|
||||||
extern struct dm_usb_ops ehci_usb_ops;
|
extern struct dm_usb_ops ehci_usb_ops;
|
||||||
|
|
||||||
|
/* EHCI PHY functions */
|
||||||
|
int ehci_setup_phy(struct udevice *dev, struct phy *phy, int index);
|
||||||
|
int ehci_shutdown_phy(struct udevice *dev, struct phy *phy);
|
||||||
|
|
||||||
#endif /* USB_EHCI_H */
|
#endif /* USB_EHCI_H */
|
||||||
|
Loading…
Reference in New Issue
Block a user