net: phy: register phys specified in devicetree
When a mdio bus has a device node attached then register the phys specified there. This makes it possible to lookup the phys using phandles later. Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
This commit is contained in:
parent
b90dc18054
commit
9b259eb3fd
|
@ -49,6 +49,71 @@ int mdiobus_detect(struct device_d *dev)
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int of_mdiobus_register_phy(struct mii_bus *mdio, struct device_node *child,
|
||||||
|
u32 addr)
|
||||||
|
{
|
||||||
|
struct phy_device *phy;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
phy = get_phy_device(mdio, addr);
|
||||||
|
if (IS_ERR(phy))
|
||||||
|
return PTR_ERR(phy);
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Associate the OF node with the device structure so it
|
||||||
|
* can be looked up later
|
||||||
|
*/
|
||||||
|
phy->dev.device_node = child;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* All data is now stored in the phy struct;
|
||||||
|
* register it
|
||||||
|
*/
|
||||||
|
ret = phy_register_device(phy);
|
||||||
|
if (ret)
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
dev_dbg(&mdio->dev, "registered phy %s at address %i\n",
|
||||||
|
child->name, addr);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* of_mdiobus_register - Register mii_bus and create PHYs from the device tree
|
||||||
|
* @mdio: pointer to mii_bus structure
|
||||||
|
* @np: pointer to device_node of MDIO bus.
|
||||||
|
*
|
||||||
|
* This function registers the mii_bus structure and registers a phy_device
|
||||||
|
* for each child node of @np.
|
||||||
|
*/
|
||||||
|
static int of_mdiobus_register(struct mii_bus *mdio, struct device_node *np)
|
||||||
|
{
|
||||||
|
struct device_node *child;
|
||||||
|
u32 addr;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
/* Loop over the child nodes and register a phy_device for each one */
|
||||||
|
for_each_available_child_of_node(np, child) {
|
||||||
|
ret = of_property_read_u32(child, "reg", &addr);
|
||||||
|
if (ret) {
|
||||||
|
dev_err(&mdio->dev, "%s has invalid PHY address\n",
|
||||||
|
child->full_name);
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (addr >= PHY_MAX_ADDR) {
|
||||||
|
dev_err(&mdio->dev, "%s PHY address %i is too large\n",
|
||||||
|
child->full_name, addr);
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
|
||||||
|
of_mdiobus_register_phy(mdio, child, addr);
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* mdiobus_register - bring up all the PHYs on a given bus and attach them to bus
|
* mdiobus_register - bring up all the PHYs on a given bus and attach them to bus
|
||||||
* @bus: target mii_bus
|
* @bus: target mii_bus
|
||||||
|
@ -85,6 +150,10 @@ int mdiobus_register(struct mii_bus *bus)
|
||||||
list_add_tail(&bus->list, &mii_bus_list);
|
list_add_tail(&bus->list, &mii_bus_list);
|
||||||
|
|
||||||
pr_info("%s: probed\n", dev_name(&bus->dev));
|
pr_info("%s: probed\n", dev_name(&bus->dev));
|
||||||
|
|
||||||
|
if (bus->dev.device_node)
|
||||||
|
of_mdiobus_register(bus, bus->dev.device_node);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
EXPORT_SYMBOL(mdiobus_register);
|
EXPORT_SYMBOL(mdiobus_register);
|
||||||
|
|
Loading…
Reference in New Issue