[PATCH rtems-libbsd 1/3] freebsd/cgem: Add phy address to read it from device tree

[Padmarao Begari]

Read the phy address from the device tree and use it to
find the phy device if not found then search in the
range of 0 to 31.
---
 freebsd/sys/dev/cadence/if_cgem.c | 41 ++++++++++++++++++++++++++++---
 1 file changed, 37 insertions(+), 4 deletions(-)

diff --git a/freebsd/sys/dev/cadence/if_cgem.c b/freebsd/sys/dev/cadence/if_cgem.c
index 689c3611..2888a085 100644
--- a/freebsd/sys/dev/cadence/if_cgem.c
+++ b/freebsd/sys/dev/cadence/if_cgem.c
@@ -1217,6 +1217,27 @@ cgem_intr(void *arg)
 	CGEM_UNLOCK(sc);
 }
 
+static int
+cgem_get_phyaddr(phandle_t node, int *phy_addr)
+{
+	phandle_t phy_node;
+	pcell_t phy_handle, phy_reg;
+
+	if (OF_getencprop(node, "phy-handle", (void *)&phy_handle,
+		sizeof(phy_handle)) <= 0)
+		return (ENXIO);
+
+	phy_node = OF_node_from_xref(phy_handle);
+
+	if (OF_getencprop(phy_node, "reg", (void *)&phy_reg,
+		sizeof(phy_reg)) <= 0)
+		return (ENXIO);
+
+	*phy_addr = phy_reg;
+
+	return (0);
+}
+
 /* Reset hardware. */
 static void
 cgem_reset(struct cgem_softc *sc)
@@ -2003,6 +2024,7 @@ cgem_attach(device_t dev)
 	pcell_t cell;
 	int rid, err;
 	u_char eaddr[ETHER_ADDR_LEN];
+	int phy_addr;
 
 	sc->dev = dev;
 	CGEM_LOCK_INIT(sc);
@@ -2091,10 +2113,21 @@ cgem_attach(device_t dev)
 	cgem_reset(sc);
 	CGEM_UNLOCK(sc);
 
-	/* Attach phy to mii bus. */
-	err = mii_attach(dev, &sc->miibus, ifp,
-			 cgem_ifmedia_upd, cgem_ifmedia_sts,
-			 BMSR_DEFCAPMASK, MII_PHY_ANY, MII_OFFSET_ANY, 0);
+	err = cgem_get_phyaddr(node, &phy_addr);
+	if (err == 0) {
+		/* Attach phy to mii bus. */
+		err = mii_attach(dev, &sc->miibus, ifp,
+				 cgem_ifmedia_upd, cgem_ifmedia_sts,
+				 BMSR_DEFCAPMASK, phy_addr, MII_OFFSET_ANY, 0);
+	}
+
+	if (err) {
+		/* Attach phy to mii bus. */
+		err = mii_attach(dev, &sc->miibus, ifp,
+				 cgem_ifmedia_upd, cgem_ifmedia_sts,
+				 BMSR_DEFCAPMASK, MII_PHY_ANY, MII_OFFSET_ANY, 0);
+	}
+
 	if (err) {
 		device_printf(dev, "attaching PHYs failed\n");
 		cgem_detach(dev);
-- 
2.25.1