[U-Boot] [PATCH 1/3] net: add dm_eth_phy_connect helper to link eth/PHY based on DT

[Alex Marginean]

The helper is useful for platforms that link ethernet interfaces and PHYs
in device tree using current bindings.  Drivers could do this directly, but
the code is generic enough and helps keep drivers simpler.

Signed-off-by: Alex Marginean <alexm.osslist at gmail.com>
---
 include/miiphy.h  |  12 +++++
 net/mdio-uclass.c | 118 ++++++++++++++++++++++++++++++++++++++++++++++
 2 files changed, 130 insertions(+)

diff --git a/include/miiphy.h b/include/miiphy.h
index 9b97d09f18..c8483bb40d 100644
--- a/include/miiphy.h
+++ b/include/miiphy.h
@@ -165,6 +165,18 @@ struct phy_device *dm_mdio_phy_connect(struct udevice *dev, int addr,
 				       struct udevice *ethdev,
 				       phy_interface_t interface);
 
+/**
+ * dm_eth_phy_connect - Connect an Eth device to a PHY based on device tree
+ *
+ * Picks up the DT phy-handle/mdio-handle and phy-mode from ethernet device node
+ * and connects the ethernet device to the linked PHY.
+ *
+ * @dev: ethernet device
+ *
+ * @return pointer to phy_device, or 0 on error
+ */
+struct phy_device *dm_eth_phy_connect(struct udevice *dev);
+
 #endif
 
 #ifdef CONFIG_DM_MDIO_MUX
diff --git a/net/mdio-uclass.c b/net/mdio-uclass.c
index 36a404ff44..3289ca15f1 100644
--- a/net/mdio-uclass.c
+++ b/net/mdio-uclass.c
@@ -105,6 +105,124 @@ struct phy_device *dm_mdio_phy_connect(struct udevice *dev, int addr,
 	return phy_connect(pdata->mii_bus, addr, ethdev, interface);
 }
 
+static struct phy_device *dm_eth_connect_phy_handle(struct udevice *dev,
+						    phy_interface_t if_type)
+{
+	u32 phy_phandle, phy_addr;
+	struct udevice *mdio_dev;
+	struct phy_device *phy;
+	ofnode phy_node;
+
+	if (ofnode_read_u32(dev->node, "phy-handle", &phy_phandle)) {
+		dev_dbg(dev, "phy-handle missing in ethernet node\n");
+		return NULL;
+	}
+
+	phy_node = ofnode_get_by_phandle(phy_phandle);
+	if (!ofnode_valid(phy_node)) {
+		dev_dbg(dev, "invalid phy node\n");
+		return NULL;
+	}
+
+	if (ofnode_read_u32(phy_node, "reg", &phy_addr)) {
+		dev_dbg(dev, "missing reg property in phy node\n");
+		return NULL;
+	}
+
+	if (uclass_get_device_by_ofnode(UCLASS_MDIO,
+					ofnode_get_parent(phy_node),
+					&mdio_dev)) {
+		dev_dbg(dev, "can't find MDIO bus for node %s\n",
+			ofnode_get_name(ofnode_get_parent(phy_node)));
+		return NULL;
+	}
+
+	phy = dm_mdio_phy_connect(mdio_dev, phy_addr, dev, if_type);
+	phy->node = phy_node;
+
+	return phy;
+}
+
+static struct phy_device *dm_eth_connect_mdio_handle(struct udevice *dev,
+						     phy_interface_t if_type)
+{
+	u32 mdio_phandle;
+	ofnode mdio_node;
+	struct udevice *mdio_dev;
+	struct phy_device *phy;
+	uint mask = (uint)-1;
+	struct mdio_perdev_priv *pdata;
+
+	if (ofnode_read_u32(dev->node, "mdio-handle", &mdio_phandle)) {
+		dev_dbg(dev, "mdio-handle missing in ethernet node\n");
+		return NULL;
+	}
+
+	mdio_node = ofnode_get_by_phandle(mdio_phandle);
+	if (!ofnode_valid(mdio_node)) {
+		dev_dbg(dev, "invalid mdio node\n");
+		return NULL;
+	}
+
+	if (uclass_get_device_by_ofnode(UCLASS_MDIO, mdio_node, &mdio_dev)) {
+		dev_dbg(dev, "can't find MDIO bus for node %s\n",
+			ofnode_get_name(mdio_node));
+		return NULL;
+	}
+	pdata = dev_get_uclass_priv(mdio_dev);
+
+	phy = phy_find_by_mask(pdata->mii_bus, mask, if_type);
+	if (phy)
+		phy_connect_dev(phy, dev);
+	else
+		dev_dbg(dev, "no PHY detected on bus\n");
+
+	return phy;
+}
+
+/* Connect to a PHY linked in eth DT node */
+struct phy_device *dm_eth_phy_connect(struct udevice *dev)
+{
+	const char *if_type_str;
+	phy_interface_t if_type;
+	struct phy_device *phy;
+
+	if (!ofnode_valid(dev->node)) {
+		debug("%s: supplied eth dev has no DT node!\n", dev->name);
+		return NULL;
+	}
+
+	/*
+	 * The sequence should be as follows:
+	 * - if there is a phy-handle property, follow that,
+	 * - if there is a mdio-handle property, follow that and scan for the
+	 *   PHY,
+	 * - if the above came out empty, just return NULL.
+	 */
+
+	if_type = PHY_INTERFACE_MODE_NONE;
+	if_type_str = ofnode_read_string(dev->node, "phy-mode");
+	if (if_type_str)
+		if_type = phy_get_interface_by_name(if_type_str);
+	if (if_type < 0)
+		if_type = PHY_INTERFACE_MODE_NONE;
+
+	if (if_type == PHY_INTERFACE_MODE_NONE)
+		dev_dbg(dev, "can't find interface mode, default to NONE\n");
+
+	phy = dm_eth_connect_phy_handle(dev, if_type);
+
+	if (!phy)
+		phy = dm_eth_connect_mdio_handle(dev, if_type);
+
+	if (!phy)
+		return NULL;
+
+	phy->interface = if_type;
+
+	return phy;
+}
+
 UCLASS_DRIVER(mdio) = {
 	.id = UCLASS_MDIO,
 	.name = "mdio",
-- 
2.17.1