123 lines
2.6 KiB
C
123 lines
2.6 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright 2020 NXP
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <dm.h>
|
|
#include <net.h>
|
|
#include <dm/device-internal.h>
|
|
#include <dm/uclass-internal.h>
|
|
#include <dm/lists.h>
|
|
|
|
struct eth_phy_device_priv {
|
|
struct mii_dev *mdio_bus;
|
|
};
|
|
|
|
int eth_phy_binds_nodes(struct udevice *eth_dev)
|
|
{
|
|
ofnode mdio_node, phy_node;
|
|
const char *node_name;
|
|
int ret;
|
|
|
|
mdio_node = dev_read_subnode(eth_dev, "mdio");
|
|
if (!ofnode_valid(mdio_node)) {
|
|
debug("%s: %s mdio subnode not found!", __func__,
|
|
eth_dev->name);
|
|
return -ENXIO;
|
|
}
|
|
|
|
ofnode_for_each_subnode(phy_node, mdio_node) {
|
|
node_name = ofnode_get_name(phy_node);
|
|
|
|
debug("* Found child node: '%s'\n", node_name);
|
|
|
|
ret = device_bind_driver_to_node(eth_dev,
|
|
"eth_phy_generic_drv",
|
|
node_name, phy_node, NULL);
|
|
if (ret) {
|
|
debug(" - Eth phy binding error: %d\n", ret);
|
|
continue;
|
|
}
|
|
|
|
debug(" - bound phy device: '%s'\n", node_name);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int eth_phy_set_mdio_bus(struct udevice *eth_dev, struct mii_dev *mdio_bus)
|
|
{
|
|
struct udevice *dev;
|
|
struct eth_phy_device_priv *uc_priv;
|
|
|
|
for (uclass_first_device(UCLASS_ETH_PHY, &dev); dev;
|
|
uclass_next_device(&dev)) {
|
|
if (dev->parent == eth_dev) {
|
|
uc_priv = (struct eth_phy_device_priv *)(dev_get_uclass_priv(dev));
|
|
|
|
if (!uc_priv->mdio_bus)
|
|
uc_priv->mdio_bus = mdio_bus;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
struct mii_dev *eth_phy_get_mdio_bus(struct udevice *eth_dev)
|
|
{
|
|
int ret;
|
|
struct udevice *phy_dev;
|
|
struct eth_phy_device_priv *uc_priv;
|
|
|
|
/* Will probe the parent of phy device, then phy device */
|
|
ret = uclass_get_device_by_phandle(UCLASS_ETH_PHY, eth_dev,
|
|
"phy-handle", &phy_dev);
|
|
if (!ret) {
|
|
if (eth_dev != phy_dev->parent) {
|
|
/*
|
|
* phy_dev is shared and controlled by
|
|
* other eth controller
|
|
*/
|
|
uc_priv = (struct eth_phy_device_priv *)(dev_get_uclass_priv(phy_dev));
|
|
if (uc_priv->mdio_bus)
|
|
printf("Get shared mii bus on %s\n", eth_dev->name);
|
|
else
|
|
printf("Can't get shared mii bus on %s\n", eth_dev->name);
|
|
|
|
return uc_priv->mdio_bus;
|
|
}
|
|
} else {
|
|
printf("FEC: can't find phy-handle\n");
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
int eth_phy_get_addr(struct udevice *dev)
|
|
{
|
|
struct ofnode_phandle_args phandle_args;
|
|
int reg;
|
|
|
|
if (dev_read_phandle_with_args(dev, "phy-handle", NULL, 0, 0,
|
|
&phandle_args)) {
|
|
debug("Failed to find phy-handle");
|
|
return -ENODEV;
|
|
}
|
|
|
|
reg = ofnode_read_u32_default(phandle_args.node, "reg", 0);
|
|
|
|
return reg;
|
|
}
|
|
|
|
UCLASS_DRIVER(eth_phy_generic) = {
|
|
.id = UCLASS_ETH_PHY,
|
|
.name = "eth_phy_generic",
|
|
.per_device_auto = sizeof(struct eth_phy_device_priv),
|
|
};
|
|
|
|
U_BOOT_DRIVER(eth_phy_generic_drv) = {
|
|
.name = "eth_phy_generic_drv",
|
|
.id = UCLASS_ETH_PHY,
|
|
};
|