net: mdio-uclass: add dm_phy_find_by_ofnode() helper

Add helper to resolve PHY node from it's ofnode via DM MDIO subsystem.

Signed-off-by: Marek Behún <marek.behun@nic.cz>
Reviewed-by: Ramon Fried <rfried.dev@gmail.com>
Reviewed-by: Stefan Roese <sr@denx.de>

diff --git a/include/miiphy.h b/include/miiphy.h
index 110921f20d2a6ccfb2b4c11b6126493ec9422b01..c66a1845b58545ec18e9e562f56b08ad0866bb15 100644 (file)
--- a/include/miiphy.h
+++ b/include/miiphy.h
@@ -188,6 +188,15 @@ int dm_mdio_write(struct udevice *mdio_dev, int addr, int devad, int reg, u16 va
  */
 int dm_mdio_reset(struct udevice *mdio_dev);
 
+/**
+ * dm_phy_find_by_ofnode - Find PHY device by ofnode
+ *
+ * @phynode: PHY's ofnode
+ *
+ * Return: pointer to phy_device, or NULL on error
+ */
+struct phy_device *dm_phy_find_by_ofnode(ofnode phynode);
+
 /**
  * dm_mdio_phy_connect - Wrapper over phy_connect for DM MDIO
  *

diff --git a/net/mdio-uclass.c b/net/mdio-uclass.c
index 7593618d9adb29b1427e365c64a4a482031670fe..4401492ca015adaadc7165fb536a794d65f22c52 100644 (file)
--- a/net/mdio-uclass.c
+++ b/net/mdio-uclass.c
@@ -129,6 +129,28 @@ static int dm_mdio_pre_remove(struct udevice *dev)
        return 0;
 }
 
+struct phy_device *dm_phy_find_by_ofnode(ofnode phynode)
+{
+       struct mdio_perdev_priv *pdata;
+       struct udevice *mdiodev;
+       u32 phy_addr;
+
+       if (ofnode_read_u32(phynode, "reg", &phy_addr))
+               return NULL;
+
+       if (uclass_get_device_by_ofnode(UCLASS_MDIO,
+                                       ofnode_get_parent(phynode),
+                                       &mdiodev))
+               return NULL;
+
+       if (device_probe(mdiodev))
+               return NULL;
+
+       pdata = dev_get_uclass_priv(mdiodev);
+
+       return phy_find_by_mask(pdata->mii_bus, BIT(phy_addr));
+}
+
 struct phy_device *dm_mdio_phy_connect(struct udevice *mdiodev, int phyaddr,
                                       struct udevice *ethdev,
                                       phy_interface_t interface)