xref: /rk3399_rockchip-uboot/drivers/net/phy/phy.c (revision 17ecfa9b45db7964f6a20cd710a87decd2f2e1f5)
15f184715SAndy Fleming /*
25f184715SAndy Fleming  * Generic PHY Management code
35f184715SAndy Fleming  *
41a459660SWolfgang Denk  * SPDX-License-Identifier:	GPL-2.0+
55f184715SAndy Fleming  *
65f184715SAndy Fleming  * Copyright 2011 Freescale Semiconductor, Inc.
75f184715SAndy Fleming  * author Andy Fleming
85f184715SAndy Fleming  *
95f184715SAndy Fleming  * Based loosely off of Linux's PHY Lib
105f184715SAndy Fleming  */
115f184715SAndy Fleming 
125f184715SAndy Fleming #include <config.h>
135f184715SAndy Fleming #include <common.h>
14c74c8e66SSimon Glass #include <dm.h>
155f184715SAndy Fleming #include <malloc.h>
165f184715SAndy Fleming #include <net.h>
175f184715SAndy Fleming #include <command.h>
185f184715SAndy Fleming #include <miiphy.h>
195f184715SAndy Fleming #include <phy.h>
205f184715SAndy Fleming #include <errno.h>
211adb406bSTroy Kisky #include <linux/err.h>
22597fe041SShengzhou Liu #include <linux/compiler.h>
235f184715SAndy Fleming 
24abbfcbe5SMichal Simek DECLARE_GLOBAL_DATA_PTR;
25abbfcbe5SMichal Simek 
265f184715SAndy Fleming /* Generic PHY support and helper functions */
275f184715SAndy Fleming 
285f184715SAndy Fleming /**
295f184715SAndy Fleming  * genphy_config_advert - sanitize and advertise auto-negotation parameters
305f184715SAndy Fleming  * @phydev: target phy_device struct
315f184715SAndy Fleming  *
325f184715SAndy Fleming  * Description: Writes MII_ADVERTISE with the appropriate values,
335f184715SAndy Fleming  *   after sanitizing the values to make sure we only advertise
345f184715SAndy Fleming  *   what is supported.  Returns < 0 on error, 0 if the PHY's advertisement
355f184715SAndy Fleming  *   hasn't changed, and > 0 if it has changed.
365f184715SAndy Fleming  */
37960d70c6SKim Phillips static int genphy_config_advert(struct phy_device *phydev)
385f184715SAndy Fleming {
395f184715SAndy Fleming 	u32 advertise;
405f184715SAndy Fleming 	int oldadv, adv;
415f184715SAndy Fleming 	int err, changed = 0;
425f184715SAndy Fleming 
435f184715SAndy Fleming 	/* Only allow advertising what
445f184715SAndy Fleming 	 * this PHY supports */
455f184715SAndy Fleming 	phydev->advertising &= phydev->supported;
465f184715SAndy Fleming 	advertise = phydev->advertising;
475f184715SAndy Fleming 
485f184715SAndy Fleming 	/* Setup standard advertisement */
495f184715SAndy Fleming 	oldadv = adv = phy_read(phydev, MDIO_DEVAD_NONE, MII_ADVERTISE);
505f184715SAndy Fleming 
515f184715SAndy Fleming 	if (adv < 0)
525f184715SAndy Fleming 		return adv;
535f184715SAndy Fleming 
545f184715SAndy Fleming 	adv &= ~(ADVERTISE_ALL | ADVERTISE_100BASE4 | ADVERTISE_PAUSE_CAP |
555f184715SAndy Fleming 		 ADVERTISE_PAUSE_ASYM);
565f184715SAndy Fleming 	if (advertise & ADVERTISED_10baseT_Half)
575f184715SAndy Fleming 		adv |= ADVERTISE_10HALF;
585f184715SAndy Fleming 	if (advertise & ADVERTISED_10baseT_Full)
595f184715SAndy Fleming 		adv |= ADVERTISE_10FULL;
605f184715SAndy Fleming 	if (advertise & ADVERTISED_100baseT_Half)
615f184715SAndy Fleming 		adv |= ADVERTISE_100HALF;
625f184715SAndy Fleming 	if (advertise & ADVERTISED_100baseT_Full)
635f184715SAndy Fleming 		adv |= ADVERTISE_100FULL;
645f184715SAndy Fleming 	if (advertise & ADVERTISED_Pause)
655f184715SAndy Fleming 		adv |= ADVERTISE_PAUSE_CAP;
665f184715SAndy Fleming 	if (advertise & ADVERTISED_Asym_Pause)
675f184715SAndy Fleming 		adv |= ADVERTISE_PAUSE_ASYM;
68de1d786eSCharles Coldwell 	if (advertise & ADVERTISED_1000baseX_Half)
69de1d786eSCharles Coldwell 		adv |= ADVERTISE_1000XHALF;
70de1d786eSCharles Coldwell 	if (advertise & ADVERTISED_1000baseX_Full)
71de1d786eSCharles Coldwell 		adv |= ADVERTISE_1000XFULL;
725f184715SAndy Fleming 
735f184715SAndy Fleming 	if (adv != oldadv) {
745f184715SAndy Fleming 		err = phy_write(phydev, MDIO_DEVAD_NONE, MII_ADVERTISE, adv);
755f184715SAndy Fleming 
765f184715SAndy Fleming 		if (err < 0)
775f184715SAndy Fleming 			return err;
785f184715SAndy Fleming 		changed = 1;
795f184715SAndy Fleming 	}
805f184715SAndy Fleming 
815f184715SAndy Fleming 	/* Configure gigabit if it's supported */
825f184715SAndy Fleming 	if (phydev->supported & (SUPPORTED_1000baseT_Half |
835f184715SAndy Fleming 				SUPPORTED_1000baseT_Full)) {
845f184715SAndy Fleming 		oldadv = adv = phy_read(phydev, MDIO_DEVAD_NONE, MII_CTRL1000);
855f184715SAndy Fleming 
865f184715SAndy Fleming 		if (adv < 0)
875f184715SAndy Fleming 			return adv;
885f184715SAndy Fleming 
895f184715SAndy Fleming 		adv &= ~(ADVERTISE_1000FULL | ADVERTISE_1000HALF);
905f184715SAndy Fleming 		if (advertise & SUPPORTED_1000baseT_Half)
915f184715SAndy Fleming 			adv |= ADVERTISE_1000HALF;
925f184715SAndy Fleming 		if (advertise & SUPPORTED_1000baseT_Full)
935f184715SAndy Fleming 			adv |= ADVERTISE_1000FULL;
945f184715SAndy Fleming 
955f184715SAndy Fleming 		if (adv != oldadv) {
965f184715SAndy Fleming 			err = phy_write(phydev, MDIO_DEVAD_NONE, MII_CTRL1000,
975f184715SAndy Fleming 					adv);
985f184715SAndy Fleming 
995f184715SAndy Fleming 			if (err < 0)
1005f184715SAndy Fleming 				return err;
1015f184715SAndy Fleming 			changed = 1;
1025f184715SAndy Fleming 		}
1035f184715SAndy Fleming 	}
1045f184715SAndy Fleming 
1055f184715SAndy Fleming 	return changed;
1065f184715SAndy Fleming }
1075f184715SAndy Fleming 
1085f184715SAndy Fleming 
1095f184715SAndy Fleming /**
1105f184715SAndy Fleming  * genphy_setup_forced - configures/forces speed/duplex from @phydev
1115f184715SAndy Fleming  * @phydev: target phy_device struct
1125f184715SAndy Fleming  *
1135f184715SAndy Fleming  * Description: Configures MII_BMCR to force speed/duplex
1145f184715SAndy Fleming  *   to the values in phydev. Assumes that the values are valid.
1155f184715SAndy Fleming  */
116960d70c6SKim Phillips static int genphy_setup_forced(struct phy_device *phydev)
1175f184715SAndy Fleming {
1185f184715SAndy Fleming 	int err;
1195f184715SAndy Fleming 	int ctl = 0;
1205f184715SAndy Fleming 
1215f184715SAndy Fleming 	phydev->pause = phydev->asym_pause = 0;
1225f184715SAndy Fleming 
1235f184715SAndy Fleming 	if (SPEED_1000 == phydev->speed)
1245f184715SAndy Fleming 		ctl |= BMCR_SPEED1000;
1255f184715SAndy Fleming 	else if (SPEED_100 == phydev->speed)
1265f184715SAndy Fleming 		ctl |= BMCR_SPEED100;
1275f184715SAndy Fleming 
1285f184715SAndy Fleming 	if (DUPLEX_FULL == phydev->duplex)
1295f184715SAndy Fleming 		ctl |= BMCR_FULLDPLX;
1305f184715SAndy Fleming 
1315f184715SAndy Fleming 	err = phy_write(phydev, MDIO_DEVAD_NONE, MII_BMCR, ctl);
1325f184715SAndy Fleming 
1335f184715SAndy Fleming 	return err;
1345f184715SAndy Fleming }
1355f184715SAndy Fleming 
1365f184715SAndy Fleming 
1375f184715SAndy Fleming /**
1385f184715SAndy Fleming  * genphy_restart_aneg - Enable and Restart Autonegotiation
1395f184715SAndy Fleming  * @phydev: target phy_device struct
1405f184715SAndy Fleming  */
1415f184715SAndy Fleming int genphy_restart_aneg(struct phy_device *phydev)
1425f184715SAndy Fleming {
1435f184715SAndy Fleming 	int ctl;
1445f184715SAndy Fleming 
1455f184715SAndy Fleming 	ctl = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMCR);
1465f184715SAndy Fleming 
1475f184715SAndy Fleming 	if (ctl < 0)
1485f184715SAndy Fleming 		return ctl;
1495f184715SAndy Fleming 
1505f184715SAndy Fleming 	ctl |= (BMCR_ANENABLE | BMCR_ANRESTART);
1515f184715SAndy Fleming 
1525f184715SAndy Fleming 	/* Don't isolate the PHY if we're negotiating */
1535f184715SAndy Fleming 	ctl &= ~(BMCR_ISOLATE);
1545f184715SAndy Fleming 
1555f184715SAndy Fleming 	ctl = phy_write(phydev, MDIO_DEVAD_NONE, MII_BMCR, ctl);
1565f184715SAndy Fleming 
1575f184715SAndy Fleming 	return ctl;
1585f184715SAndy Fleming }
1595f184715SAndy Fleming 
1605f184715SAndy Fleming 
1615f184715SAndy Fleming /**
1625f184715SAndy Fleming  * genphy_config_aneg - restart auto-negotiation or write BMCR
1635f184715SAndy Fleming  * @phydev: target phy_device struct
1645f184715SAndy Fleming  *
1655f184715SAndy Fleming  * Description: If auto-negotiation is enabled, we configure the
1665f184715SAndy Fleming  *   advertising, and then restart auto-negotiation.  If it is not
1675f184715SAndy Fleming  *   enabled, then we write the BMCR.
1685f184715SAndy Fleming  */
1695f184715SAndy Fleming int genphy_config_aneg(struct phy_device *phydev)
1705f184715SAndy Fleming {
1715f184715SAndy Fleming 	int result;
1725f184715SAndy Fleming 
1735f184715SAndy Fleming 	if (AUTONEG_ENABLE != phydev->autoneg)
1745f184715SAndy Fleming 		return genphy_setup_forced(phydev);
1755f184715SAndy Fleming 
1765f184715SAndy Fleming 	result = genphy_config_advert(phydev);
1775f184715SAndy Fleming 
1785f184715SAndy Fleming 	if (result < 0) /* error */
1795f184715SAndy Fleming 		return result;
1805f184715SAndy Fleming 
1815f184715SAndy Fleming 	if (result == 0) {
1825f184715SAndy Fleming 		/* Advertisment hasn't changed, but maybe aneg was never on to
1835f184715SAndy Fleming 		 * begin with?  Or maybe phy was isolated? */
1845f184715SAndy Fleming 		int ctl = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMCR);
1855f184715SAndy Fleming 
1865f184715SAndy Fleming 		if (ctl < 0)
1875f184715SAndy Fleming 			return ctl;
1885f184715SAndy Fleming 
1895f184715SAndy Fleming 		if (!(ctl & BMCR_ANENABLE) || (ctl & BMCR_ISOLATE))
1905f184715SAndy Fleming 			result = 1; /* do restart aneg */
1915f184715SAndy Fleming 	}
1925f184715SAndy Fleming 
1935f184715SAndy Fleming 	/* Only restart aneg if we are advertising something different
1945f184715SAndy Fleming 	 * than we were before.	 */
1955f184715SAndy Fleming 	if (result > 0)
1965f184715SAndy Fleming 		result = genphy_restart_aneg(phydev);
1975f184715SAndy Fleming 
1985f184715SAndy Fleming 	return result;
1995f184715SAndy Fleming }
2005f184715SAndy Fleming 
2015f184715SAndy Fleming /**
2025f184715SAndy Fleming  * genphy_update_link - update link status in @phydev
2035f184715SAndy Fleming  * @phydev: target phy_device struct
2045f184715SAndy Fleming  *
2055f184715SAndy Fleming  * Description: Update the value in phydev->link to reflect the
2065f184715SAndy Fleming  *   current link value.  In order to do this, we need to read
2075f184715SAndy Fleming  *   the status register twice, keeping the second value.
2085f184715SAndy Fleming  */
2095f184715SAndy Fleming int genphy_update_link(struct phy_device *phydev)
2105f184715SAndy Fleming {
2115f184715SAndy Fleming 	unsigned int mii_reg;
2125f184715SAndy Fleming 
2135f184715SAndy Fleming 	/*
2145f184715SAndy Fleming 	 * Wait if the link is up, and autonegotiation is in progress
2155f184715SAndy Fleming 	 * (ie - we're capable and it's not done)
2165f184715SAndy Fleming 	 */
2175f184715SAndy Fleming 	mii_reg = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMSR);
2185f184715SAndy Fleming 
2195f184715SAndy Fleming 	/*
2205f184715SAndy Fleming 	 * If we already saw the link up, and it hasn't gone down, then
2215f184715SAndy Fleming 	 * we don't need to wait for autoneg again
2225f184715SAndy Fleming 	 */
2235f184715SAndy Fleming 	if (phydev->link && mii_reg & BMSR_LSTATUS)
2245f184715SAndy Fleming 		return 0;
2255f184715SAndy Fleming 
2265f184715SAndy Fleming 	if ((mii_reg & BMSR_ANEGCAPABLE) && !(mii_reg & BMSR_ANEGCOMPLETE)) {
2275f184715SAndy Fleming 		int i = 0;
2285f184715SAndy Fleming 
2295f184715SAndy Fleming 		printf("%s Waiting for PHY auto negotiation to complete",
2305f184715SAndy Fleming 			phydev->dev->name);
2315f184715SAndy Fleming 		while (!(mii_reg & BMSR_ANEGCOMPLETE)) {
2325f184715SAndy Fleming 			/*
2335f184715SAndy Fleming 			 * Timeout reached ?
2345f184715SAndy Fleming 			 */
2355f184715SAndy Fleming 			if (i > PHY_ANEG_TIMEOUT) {
2365f184715SAndy Fleming 				printf(" TIMEOUT !\n");
2375f184715SAndy Fleming 				phydev->link = 0;
2385f184715SAndy Fleming 				return 0;
2395f184715SAndy Fleming 			}
2405f184715SAndy Fleming 
2415f184715SAndy Fleming 			if (ctrlc()) {
2425f184715SAndy Fleming 				puts("user interrupt!\n");
2435f184715SAndy Fleming 				phydev->link = 0;
2445f184715SAndy Fleming 				return -EINTR;
2455f184715SAndy Fleming 			}
2465f184715SAndy Fleming 
2475f184715SAndy Fleming 			if ((i++ % 500) == 0)
2485f184715SAndy Fleming 				printf(".");
2495f184715SAndy Fleming 
2505f184715SAndy Fleming 			udelay(1000);	/* 1 ms */
2515f184715SAndy Fleming 			mii_reg = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMSR);
2525f184715SAndy Fleming 		}
2535f184715SAndy Fleming 		printf(" done\n");
2545f184715SAndy Fleming 		phydev->link = 1;
2555f184715SAndy Fleming 	} else {
2565f184715SAndy Fleming 		/* Read the link a second time to clear the latched state */
2575f184715SAndy Fleming 		mii_reg = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMSR);
2585f184715SAndy Fleming 
2595f184715SAndy Fleming 		if (mii_reg & BMSR_LSTATUS)
2605f184715SAndy Fleming 			phydev->link = 1;
2615f184715SAndy Fleming 		else
2625f184715SAndy Fleming 			phydev->link = 0;
2635f184715SAndy Fleming 	}
2645f184715SAndy Fleming 
2655f184715SAndy Fleming 	return 0;
2665f184715SAndy Fleming }
2675f184715SAndy Fleming 
2685f184715SAndy Fleming /*
2695f184715SAndy Fleming  * Generic function which updates the speed and duplex.  If
2705f184715SAndy Fleming  * autonegotiation is enabled, it uses the AND of the link
2715f184715SAndy Fleming  * partner's advertised capabilities and our advertised
2725f184715SAndy Fleming  * capabilities.  If autonegotiation is disabled, we use the
2735f184715SAndy Fleming  * appropriate bits in the control register.
2745f184715SAndy Fleming  *
2755f184715SAndy Fleming  * Stolen from Linux's mii.c and phy_device.c
2765f184715SAndy Fleming  */
277e2043f5cSYegor Yefremov int genphy_parse_link(struct phy_device *phydev)
2785f184715SAndy Fleming {
2795f184715SAndy Fleming 	int mii_reg = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMSR);
2805f184715SAndy Fleming 
2815f184715SAndy Fleming 	/* We're using autonegotiation */
2823a530d1bSDavid Dueck 	if (phydev->supported & SUPPORTED_Autoneg) {
2835f184715SAndy Fleming 		u32 lpa = 0;
284f6d1f6e4SHeiko Schocher 		int gblpa = 0;
285de1d786eSCharles Coldwell 		u32 estatus = 0;
2865f184715SAndy Fleming 
2875f184715SAndy Fleming 		/* Check for gigabit capability */
2883a530d1bSDavid Dueck 		if (phydev->supported & (SUPPORTED_1000baseT_Full |
2893a530d1bSDavid Dueck 					SUPPORTED_1000baseT_Half)) {
2905f184715SAndy Fleming 			/* We want a list of states supported by
2915f184715SAndy Fleming 			 * both PHYs in the link
2925f184715SAndy Fleming 			 */
2935f184715SAndy Fleming 			gblpa = phy_read(phydev, MDIO_DEVAD_NONE, MII_STAT1000);
294f6d1f6e4SHeiko Schocher 			if (gblpa < 0) {
295f6d1f6e4SHeiko Schocher 				debug("Could not read MII_STAT1000. Ignoring gigabit capability\n");
296f6d1f6e4SHeiko Schocher 				gblpa = 0;
297f6d1f6e4SHeiko Schocher 			}
2985f184715SAndy Fleming 			gblpa &= phy_read(phydev,
2995f184715SAndy Fleming 					MDIO_DEVAD_NONE, MII_CTRL1000) << 2;
3005f184715SAndy Fleming 		}
3015f184715SAndy Fleming 
3025f184715SAndy Fleming 		/* Set the baseline so we only have to set them
3035f184715SAndy Fleming 		 * if they're different
3045f184715SAndy Fleming 		 */
3055f184715SAndy Fleming 		phydev->speed = SPEED_10;
3065f184715SAndy Fleming 		phydev->duplex = DUPLEX_HALF;
3075f184715SAndy Fleming 
3085f184715SAndy Fleming 		/* Check the gigabit fields */
3095f184715SAndy Fleming 		if (gblpa & (PHY_1000BTSR_1000FD | PHY_1000BTSR_1000HD)) {
3105f184715SAndy Fleming 			phydev->speed = SPEED_1000;
3115f184715SAndy Fleming 
3125f184715SAndy Fleming 			if (gblpa & PHY_1000BTSR_1000FD)
3135f184715SAndy Fleming 				phydev->duplex = DUPLEX_FULL;
3145f184715SAndy Fleming 
3155f184715SAndy Fleming 			/* We're done! */
3165f184715SAndy Fleming 			return 0;
3175f184715SAndy Fleming 		}
3185f184715SAndy Fleming 
3195f184715SAndy Fleming 		lpa = phy_read(phydev, MDIO_DEVAD_NONE, MII_ADVERTISE);
3205f184715SAndy Fleming 		lpa &= phy_read(phydev, MDIO_DEVAD_NONE, MII_LPA);
3215f184715SAndy Fleming 
3220dcfb0fcSWolfgang Denk 		if (lpa & (LPA_100FULL | LPA_100HALF)) {
3235f184715SAndy Fleming 			phydev->speed = SPEED_100;
3245f184715SAndy Fleming 
3250dcfb0fcSWolfgang Denk 			if (lpa & LPA_100FULL)
3260dcfb0fcSWolfgang Denk 				phydev->duplex = DUPLEX_FULL;
3270dcfb0fcSWolfgang Denk 
3280dcfb0fcSWolfgang Denk 		} else if (lpa & LPA_10FULL)
3295f184715SAndy Fleming 			phydev->duplex = DUPLEX_FULL;
330de1d786eSCharles Coldwell 
3319ba30f6bSSascha Silbe 		/*
3329ba30f6bSSascha Silbe 		 * Extended status may indicate that the PHY supports
3339ba30f6bSSascha Silbe 		 * 1000BASE-T/X even though the 1000BASE-T registers
3349ba30f6bSSascha Silbe 		 * are missing. In this case we can't tell whether the
3359ba30f6bSSascha Silbe 		 * peer also supports it, so we only check extended
3369ba30f6bSSascha Silbe 		 * status if the 1000BASE-T registers are actually
3379ba30f6bSSascha Silbe 		 * missing.
3389ba30f6bSSascha Silbe 		 */
3399ba30f6bSSascha Silbe 		if ((mii_reg & BMSR_ESTATEN) && !(mii_reg & BMSR_ERCAP))
340de1d786eSCharles Coldwell 			estatus = phy_read(phydev, MDIO_DEVAD_NONE,
341de1d786eSCharles Coldwell 					   MII_ESTATUS);
342de1d786eSCharles Coldwell 
343de1d786eSCharles Coldwell 		if (estatus & (ESTATUS_1000_XFULL | ESTATUS_1000_XHALF |
344de1d786eSCharles Coldwell 				ESTATUS_1000_TFULL | ESTATUS_1000_THALF)) {
345de1d786eSCharles Coldwell 			phydev->speed = SPEED_1000;
346de1d786eSCharles Coldwell 			if (estatus & (ESTATUS_1000_XFULL | ESTATUS_1000_TFULL))
347de1d786eSCharles Coldwell 				phydev->duplex = DUPLEX_FULL;
348de1d786eSCharles Coldwell 		}
349de1d786eSCharles Coldwell 
3505f184715SAndy Fleming 	} else {
3515f184715SAndy Fleming 		u32 bmcr = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMCR);
3525f184715SAndy Fleming 
3535f184715SAndy Fleming 		phydev->speed = SPEED_10;
3545f184715SAndy Fleming 		phydev->duplex = DUPLEX_HALF;
3555f184715SAndy Fleming 
3565f184715SAndy Fleming 		if (bmcr & BMCR_FULLDPLX)
3575f184715SAndy Fleming 			phydev->duplex = DUPLEX_FULL;
3585f184715SAndy Fleming 
3595f184715SAndy Fleming 		if (bmcr & BMCR_SPEED1000)
3605f184715SAndy Fleming 			phydev->speed = SPEED_1000;
3615f184715SAndy Fleming 		else if (bmcr & BMCR_SPEED100)
3625f184715SAndy Fleming 			phydev->speed = SPEED_100;
3635f184715SAndy Fleming 	}
3645f184715SAndy Fleming 
3655f184715SAndy Fleming 	return 0;
3665f184715SAndy Fleming }
3675f184715SAndy Fleming 
3685f184715SAndy Fleming int genphy_config(struct phy_device *phydev)
3695f184715SAndy Fleming {
3705f184715SAndy Fleming 	int val;
3715f184715SAndy Fleming 	u32 features;
3725f184715SAndy Fleming 
3735f184715SAndy Fleming 	/* For now, I'll claim that the generic driver supports
3745f184715SAndy Fleming 	 * all possible port types */
3755f184715SAndy Fleming 	features = (SUPPORTED_TP | SUPPORTED_MII
3765f184715SAndy Fleming 			| SUPPORTED_AUI | SUPPORTED_FIBRE |
3775f184715SAndy Fleming 			SUPPORTED_BNC);
3785f184715SAndy Fleming 
3795f184715SAndy Fleming 	/* Do we support autonegotiation? */
3805f184715SAndy Fleming 	val = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMSR);
3815f184715SAndy Fleming 
3825f184715SAndy Fleming 	if (val < 0)
3835f184715SAndy Fleming 		return val;
3845f184715SAndy Fleming 
3855f184715SAndy Fleming 	if (val & BMSR_ANEGCAPABLE)
3865f184715SAndy Fleming 		features |= SUPPORTED_Autoneg;
3875f184715SAndy Fleming 
3885f184715SAndy Fleming 	if (val & BMSR_100FULL)
3895f184715SAndy Fleming 		features |= SUPPORTED_100baseT_Full;
3905f184715SAndy Fleming 	if (val & BMSR_100HALF)
3915f184715SAndy Fleming 		features |= SUPPORTED_100baseT_Half;
3925f184715SAndy Fleming 	if (val & BMSR_10FULL)
3935f184715SAndy Fleming 		features |= SUPPORTED_10baseT_Full;
3945f184715SAndy Fleming 	if (val & BMSR_10HALF)
3955f184715SAndy Fleming 		features |= SUPPORTED_10baseT_Half;
3965f184715SAndy Fleming 
3975f184715SAndy Fleming 	if (val & BMSR_ESTATEN) {
3985f184715SAndy Fleming 		val = phy_read(phydev, MDIO_DEVAD_NONE, MII_ESTATUS);
3995f184715SAndy Fleming 
4005f184715SAndy Fleming 		if (val < 0)
4015f184715SAndy Fleming 			return val;
4025f184715SAndy Fleming 
4035f184715SAndy Fleming 		if (val & ESTATUS_1000_TFULL)
4045f184715SAndy Fleming 			features |= SUPPORTED_1000baseT_Full;
4055f184715SAndy Fleming 		if (val & ESTATUS_1000_THALF)
4065f184715SAndy Fleming 			features |= SUPPORTED_1000baseT_Half;
407de1d786eSCharles Coldwell 		if (val & ESTATUS_1000_XFULL)
408de1d786eSCharles Coldwell 			features |= SUPPORTED_1000baseX_Full;
409de1d786eSCharles Coldwell 		if (val & ESTATUS_1000_XHALF)
4109a5dad23SFabio Estevam 			features |= SUPPORTED_1000baseX_Half;
4115f184715SAndy Fleming 	}
4125f184715SAndy Fleming 
4135f184715SAndy Fleming 	phydev->supported = features;
4145f184715SAndy Fleming 	phydev->advertising = features;
4155f184715SAndy Fleming 
4165f184715SAndy Fleming 	genphy_config_aneg(phydev);
4175f184715SAndy Fleming 
4185f184715SAndy Fleming 	return 0;
4195f184715SAndy Fleming }
4205f184715SAndy Fleming 
4215f184715SAndy Fleming int genphy_startup(struct phy_device *phydev)
4225f184715SAndy Fleming {
4235f184715SAndy Fleming 	genphy_update_link(phydev);
4245f184715SAndy Fleming 	genphy_parse_link(phydev);
4255f184715SAndy Fleming 
4265f184715SAndy Fleming 	return 0;
4275f184715SAndy Fleming }
4285f184715SAndy Fleming 
4295f184715SAndy Fleming int genphy_shutdown(struct phy_device *phydev)
4305f184715SAndy Fleming {
4315f184715SAndy Fleming 	return 0;
4325f184715SAndy Fleming }
4335f184715SAndy Fleming 
4345f184715SAndy Fleming static struct phy_driver genphy_driver = {
4355f184715SAndy Fleming 	.uid		= 0xffffffff,
4365f184715SAndy Fleming 	.mask		= 0xffffffff,
4375f184715SAndy Fleming 	.name		= "Generic PHY",
4385f184715SAndy Fleming 	.features	= 0,
4395f184715SAndy Fleming 	.config		= genphy_config,
4405f184715SAndy Fleming 	.startup	= genphy_startup,
4415f184715SAndy Fleming 	.shutdown	= genphy_shutdown,
4425f184715SAndy Fleming };
4435f184715SAndy Fleming 
4445f184715SAndy Fleming static LIST_HEAD(phy_drivers);
4455f184715SAndy Fleming 
4465f184715SAndy Fleming int phy_init(void)
4475f184715SAndy Fleming {
448f7c38cf8SShaohui Xie #ifdef CONFIG_PHY_AQUANTIA
449f7c38cf8SShaohui Xie 	phy_aquantia_init();
450f7c38cf8SShaohui Xie #endif
4519082eeacSAndy Fleming #ifdef CONFIG_PHY_ATHEROS
4529082eeacSAndy Fleming 	phy_atheros_init();
4539082eeacSAndy Fleming #endif
4549082eeacSAndy Fleming #ifdef CONFIG_PHY_BROADCOM
4559082eeacSAndy Fleming 	phy_broadcom_init();
4569082eeacSAndy Fleming #endif
4579b18e519SShengzhou Liu #ifdef CONFIG_PHY_CORTINA
4589b18e519SShengzhou Liu 	phy_cortina_init();
4599b18e519SShengzhou Liu #endif
4609082eeacSAndy Fleming #ifdef CONFIG_PHY_DAVICOM
4619082eeacSAndy Fleming 	phy_davicom_init();
4629082eeacSAndy Fleming #endif
463f485c8a3SMatt Porter #ifdef CONFIG_PHY_ET1011C
464f485c8a3SMatt Porter 	phy_et1011c_init();
465f485c8a3SMatt Porter #endif
4669082eeacSAndy Fleming #ifdef CONFIG_PHY_LXT
4679082eeacSAndy Fleming 	phy_lxt_init();
4689082eeacSAndy Fleming #endif
4699082eeacSAndy Fleming #ifdef CONFIG_PHY_MARVELL
4709082eeacSAndy Fleming 	phy_marvell_init();
4719082eeacSAndy Fleming #endif
4729082eeacSAndy Fleming #ifdef CONFIG_PHY_MICREL
4739082eeacSAndy Fleming 	phy_micrel_init();
4749082eeacSAndy Fleming #endif
4759082eeacSAndy Fleming #ifdef CONFIG_PHY_NATSEMI
4769082eeacSAndy Fleming 	phy_natsemi_init();
4779082eeacSAndy Fleming #endif
4789082eeacSAndy Fleming #ifdef CONFIG_PHY_REALTEK
4799082eeacSAndy Fleming 	phy_realtek_init();
4809082eeacSAndy Fleming #endif
4815751aa2fSNobuhiro Iwamatsu #ifdef CONFIG_PHY_SMSC
4825751aa2fSNobuhiro Iwamatsu 	phy_smsc_init();
4835751aa2fSNobuhiro Iwamatsu #endif
4849082eeacSAndy Fleming #ifdef CONFIG_PHY_TERANETICS
4859082eeacSAndy Fleming 	phy_teranetics_init();
4869082eeacSAndy Fleming #endif
4879082eeacSAndy Fleming #ifdef CONFIG_PHY_VITESSE
4889082eeacSAndy Fleming 	phy_vitesse_init();
4899082eeacSAndy Fleming #endif
4909082eeacSAndy Fleming 
4915f184715SAndy Fleming 	return 0;
4925f184715SAndy Fleming }
4935f184715SAndy Fleming 
4945f184715SAndy Fleming int phy_register(struct phy_driver *drv)
4955f184715SAndy Fleming {
4965f184715SAndy Fleming 	INIT_LIST_HEAD(&drv->list);
4975f184715SAndy Fleming 	list_add_tail(&drv->list, &phy_drivers);
4985f184715SAndy Fleming 
499abbfcbe5SMichal Simek #ifdef CONFIG_NEEDS_MANUAL_RELOC
500abbfcbe5SMichal Simek 	if (drv->probe)
501abbfcbe5SMichal Simek 		drv->probe += gd->reloc_off;
502abbfcbe5SMichal Simek 	if (drv->config)
503abbfcbe5SMichal Simek 		drv->config += gd->reloc_off;
504abbfcbe5SMichal Simek 	if (drv->startup)
505abbfcbe5SMichal Simek 		drv->startup += gd->reloc_off;
506abbfcbe5SMichal Simek 	if (drv->shutdown)
507abbfcbe5SMichal Simek 		drv->shutdown += gd->reloc_off;
508abbfcbe5SMichal Simek 	if (drv->readext)
509abbfcbe5SMichal Simek 		drv->readext += gd->reloc_off;
510abbfcbe5SMichal Simek 	if (drv->writeext)
511abbfcbe5SMichal Simek 		drv->writeext += gd->reloc_off;
512abbfcbe5SMichal Simek #endif
5135f184715SAndy Fleming 	return 0;
5145f184715SAndy Fleming }
5155f184715SAndy Fleming 
516960d70c6SKim Phillips static int phy_probe(struct phy_device *phydev)
5175f184715SAndy Fleming {
5185f184715SAndy Fleming 	int err = 0;
5195f184715SAndy Fleming 
5205f184715SAndy Fleming 	phydev->advertising = phydev->supported = phydev->drv->features;
5215f184715SAndy Fleming 	phydev->mmds = phydev->drv->mmds;
5225f184715SAndy Fleming 
5235f184715SAndy Fleming 	if (phydev->drv->probe)
5245f184715SAndy Fleming 		err = phydev->drv->probe(phydev);
5255f184715SAndy Fleming 
5265f184715SAndy Fleming 	return err;
5275f184715SAndy Fleming }
5285f184715SAndy Fleming 
5295f184715SAndy Fleming static struct phy_driver *generic_for_interface(phy_interface_t interface)
5305f184715SAndy Fleming {
5315f184715SAndy Fleming #ifdef CONFIG_PHYLIB_10G
5325f184715SAndy Fleming 	if (is_10g_interface(interface))
5335f184715SAndy Fleming 		return &gen10g_driver;
5345f184715SAndy Fleming #endif
5355f184715SAndy Fleming 
5365f184715SAndy Fleming 	return &genphy_driver;
5375f184715SAndy Fleming }
5385f184715SAndy Fleming 
539960d70c6SKim Phillips static struct phy_driver *get_phy_driver(struct phy_device *phydev,
5405f184715SAndy Fleming 				phy_interface_t interface)
5415f184715SAndy Fleming {
5425f184715SAndy Fleming 	struct list_head *entry;
5435f184715SAndy Fleming 	int phy_id = phydev->phy_id;
5445f184715SAndy Fleming 	struct phy_driver *drv = NULL;
5455f184715SAndy Fleming 
5465f184715SAndy Fleming 	list_for_each(entry, &phy_drivers) {
5475f184715SAndy Fleming 		drv = list_entry(entry, struct phy_driver, list);
5485f184715SAndy Fleming 		if ((drv->uid & drv->mask) == (phy_id & drv->mask))
5495f184715SAndy Fleming 			return drv;
5505f184715SAndy Fleming 	}
5515f184715SAndy Fleming 
5525f184715SAndy Fleming 	/* If we made it here, there's no driver for this PHY */
5535f184715SAndy Fleming 	return generic_for_interface(interface);
5545f184715SAndy Fleming }
5555f184715SAndy Fleming 
556960d70c6SKim Phillips static struct phy_device *phy_device_create(struct mii_dev *bus, int addr,
5572c171a2aSJörg Krause 					    u32 phy_id,
5585f184715SAndy Fleming 					    phy_interface_t interface)
5595f184715SAndy Fleming {
5605f184715SAndy Fleming 	struct phy_device *dev;
5615f184715SAndy Fleming 
5625f184715SAndy Fleming 	/* We allocate the device, and initialize the
5635f184715SAndy Fleming 	 * default values */
5645f184715SAndy Fleming 	dev = malloc(sizeof(*dev));
5655f184715SAndy Fleming 	if (!dev) {
5665f184715SAndy Fleming 		printf("Failed to allocate PHY device for %s:%d\n",
5675f184715SAndy Fleming 			bus->name, addr);
5685f184715SAndy Fleming 		return NULL;
5695f184715SAndy Fleming 	}
5705f184715SAndy Fleming 
5715f184715SAndy Fleming 	memset(dev, 0, sizeof(*dev));
5725f184715SAndy Fleming 
5735f184715SAndy Fleming 	dev->duplex = -1;
57426d3acdaSMugunthan V N 	dev->link = 0;
5755f184715SAndy Fleming 	dev->interface = interface;
5765f184715SAndy Fleming 
5775f184715SAndy Fleming 	dev->autoneg = AUTONEG_ENABLE;
5785f184715SAndy Fleming 
5795f184715SAndy Fleming 	dev->addr = addr;
5805f184715SAndy Fleming 	dev->phy_id = phy_id;
5815f184715SAndy Fleming 	dev->bus = bus;
5825f184715SAndy Fleming 
5835f184715SAndy Fleming 	dev->drv = get_phy_driver(dev, interface);
5845f184715SAndy Fleming 
5855f184715SAndy Fleming 	phy_probe(dev);
5865f184715SAndy Fleming 
5875f184715SAndy Fleming 	bus->phymap[addr] = dev;
5885f184715SAndy Fleming 
5895f184715SAndy Fleming 	return dev;
5905f184715SAndy Fleming }
5915f184715SAndy Fleming 
5925f184715SAndy Fleming /**
5935f184715SAndy Fleming  * get_phy_id - reads the specified addr for its ID.
5945f184715SAndy Fleming  * @bus: the target MII bus
5955f184715SAndy Fleming  * @addr: PHY address on the MII bus
5965f184715SAndy Fleming  * @phy_id: where to store the ID retrieved.
5975f184715SAndy Fleming  *
5985f184715SAndy Fleming  * Description: Reads the ID registers of the PHY at @addr on the
5995f184715SAndy Fleming  *   @bus, stores it in @phy_id and returns zero on success.
6005f184715SAndy Fleming  */
6015707d5ffSShengzhou Liu int __weak get_phy_id(struct mii_dev *bus, int addr, int devad, u32 *phy_id)
6025f184715SAndy Fleming {
6035f184715SAndy Fleming 	int phy_reg;
6045f184715SAndy Fleming 
6055f184715SAndy Fleming 	/* Grab the bits from PHYIR1, and put them
6065f184715SAndy Fleming 	 * in the upper half */
6075f184715SAndy Fleming 	phy_reg = bus->read(bus, addr, devad, MII_PHYSID1);
6085f184715SAndy Fleming 
6095f184715SAndy Fleming 	if (phy_reg < 0)
6105f184715SAndy Fleming 		return -EIO;
6115f184715SAndy Fleming 
6125f184715SAndy Fleming 	*phy_id = (phy_reg & 0xffff) << 16;
6135f184715SAndy Fleming 
6145f184715SAndy Fleming 	/* Grab the bits from PHYIR2, and put them in the lower half */
6155f184715SAndy Fleming 	phy_reg = bus->read(bus, addr, devad, MII_PHYSID2);
6165f184715SAndy Fleming 
6175f184715SAndy Fleming 	if (phy_reg < 0)
6185f184715SAndy Fleming 		return -EIO;
6195f184715SAndy Fleming 
6205f184715SAndy Fleming 	*phy_id |= (phy_reg & 0xffff);
6215f184715SAndy Fleming 
6225f184715SAndy Fleming 	return 0;
6235f184715SAndy Fleming }
6245f184715SAndy Fleming 
6251adb406bSTroy Kisky static struct phy_device *create_phy_by_mask(struct mii_dev *bus,
6261adb406bSTroy Kisky 		unsigned phy_mask, int devad, phy_interface_t interface)
6271adb406bSTroy Kisky {
6281adb406bSTroy Kisky 	u32 phy_id = 0xffffffff;
6291adb406bSTroy Kisky 	while (phy_mask) {
6301adb406bSTroy Kisky 		int addr = ffs(phy_mask) - 1;
6311adb406bSTroy Kisky 		int r = get_phy_id(bus, addr, devad, &phy_id);
6321adb406bSTroy Kisky 		/* If the PHY ID is mostly f's, we didn't find anything */
63308be2836SCormier, Jonathan 		if (r == 0 && (phy_id & 0x1fffffff) != 0x1fffffff)
6341adb406bSTroy Kisky 			return phy_device_create(bus, addr, phy_id, interface);
6351adb406bSTroy Kisky 		phy_mask &= ~(1 << addr);
6361adb406bSTroy Kisky 	}
6371adb406bSTroy Kisky 	return NULL;
6381adb406bSTroy Kisky }
6391adb406bSTroy Kisky 
6401adb406bSTroy Kisky static struct phy_device *search_for_existing_phy(struct mii_dev *bus,
6411adb406bSTroy Kisky 		unsigned phy_mask, phy_interface_t interface)
6421adb406bSTroy Kisky {
6431adb406bSTroy Kisky 	/* If we have one, return the existing device, with new interface */
6441adb406bSTroy Kisky 	while (phy_mask) {
6451adb406bSTroy Kisky 		int addr = ffs(phy_mask) - 1;
6461adb406bSTroy Kisky 		if (bus->phymap[addr]) {
6471adb406bSTroy Kisky 			bus->phymap[addr]->interface = interface;
6481adb406bSTroy Kisky 			return bus->phymap[addr];
6491adb406bSTroy Kisky 		}
6501adb406bSTroy Kisky 		phy_mask &= ~(1 << addr);
6511adb406bSTroy Kisky 	}
6521adb406bSTroy Kisky 	return NULL;
6531adb406bSTroy Kisky }
6541adb406bSTroy Kisky 
6551adb406bSTroy Kisky static struct phy_device *get_phy_device_by_mask(struct mii_dev *bus,
6561adb406bSTroy Kisky 		unsigned phy_mask, phy_interface_t interface)
6571adb406bSTroy Kisky {
6581adb406bSTroy Kisky 	int i;
6591adb406bSTroy Kisky 	struct phy_device *phydev;
6601adb406bSTroy Kisky 
6611adb406bSTroy Kisky 	phydev = search_for_existing_phy(bus, phy_mask, interface);
6621adb406bSTroy Kisky 	if (phydev)
6631adb406bSTroy Kisky 		return phydev;
6641adb406bSTroy Kisky 	/* Try Standard (ie Clause 22) access */
6651adb406bSTroy Kisky 	/* Otherwise we have to try Clause 45 */
6661adb406bSTroy Kisky 	for (i = 0; i < 5; i++) {
6671adb406bSTroy Kisky 		phydev = create_phy_by_mask(bus, phy_mask,
6681adb406bSTroy Kisky 				i ? i : MDIO_DEVAD_NONE, interface);
6691adb406bSTroy Kisky 		if (IS_ERR(phydev))
6701adb406bSTroy Kisky 			return NULL;
6711adb406bSTroy Kisky 		if (phydev)
6721adb406bSTroy Kisky 			return phydev;
6731adb406bSTroy Kisky 	}
6743e1949d7SBin Meng 
6753e1949d7SBin Meng 	debug("\n%s PHY: ", bus->name);
6763e1949d7SBin Meng 	while (phy_mask) {
6773e1949d7SBin Meng 		int addr = ffs(phy_mask) - 1;
6783e1949d7SBin Meng 		debug("%d ", addr);
6793e1949d7SBin Meng 		phy_mask &= ~(1 << addr);
6803e1949d7SBin Meng 	}
6813e1949d7SBin Meng 	debug("not found\n");
6820132b9abSBin Meng 
6830132b9abSBin Meng 	return NULL;
6841adb406bSTroy Kisky }
6851adb406bSTroy Kisky 
6865f184715SAndy Fleming /**
6875f184715SAndy Fleming  * get_phy_device - reads the specified PHY device and returns its @phy_device struct
6885f184715SAndy Fleming  * @bus: the target MII bus
6895f184715SAndy Fleming  * @addr: PHY address on the MII bus
6905f184715SAndy Fleming  *
6915f184715SAndy Fleming  * Description: Reads the ID registers of the PHY at @addr on the
6925f184715SAndy Fleming  *   @bus, then allocates and returns the phy_device to represent it.
6935f184715SAndy Fleming  */
694960d70c6SKim Phillips static struct phy_device *get_phy_device(struct mii_dev *bus, int addr,
6955f184715SAndy Fleming 					 phy_interface_t interface)
6965f184715SAndy Fleming {
6971adb406bSTroy Kisky 	return get_phy_device_by_mask(bus, 1 << addr, interface);
6985f184715SAndy Fleming }
6995f184715SAndy Fleming 
7005f184715SAndy Fleming int phy_reset(struct phy_device *phydev)
7015f184715SAndy Fleming {
7025f184715SAndy Fleming 	int reg;
7035f184715SAndy Fleming 	int timeout = 500;
7045f184715SAndy Fleming 	int devad = MDIO_DEVAD_NONE;
7055f184715SAndy Fleming 
7065f184715SAndy Fleming #ifdef CONFIG_PHYLIB_10G
7075f184715SAndy Fleming 	/* If it's 10G, we need to issue reset through one of the MMDs */
7085f184715SAndy Fleming 	if (is_10g_interface(phydev->interface)) {
7095f184715SAndy Fleming 		if (!phydev->mmds)
7105f184715SAndy Fleming 			gen10g_discover_mmds(phydev);
7115f184715SAndy Fleming 
7125f184715SAndy Fleming 		devad = ffs(phydev->mmds) - 1;
7135f184715SAndy Fleming 	}
7145f184715SAndy Fleming #endif
7155f184715SAndy Fleming 
7165f184715SAndy Fleming 	reg = phy_read(phydev, devad, MII_BMCR);
7175f184715SAndy Fleming 	if (reg < 0) {
7185f184715SAndy Fleming 		debug("PHY status read failed\n");
7195f184715SAndy Fleming 		return -1;
7205f184715SAndy Fleming 	}
7215f184715SAndy Fleming 
7225f184715SAndy Fleming 	reg |= BMCR_RESET;
7235f184715SAndy Fleming 
7245f184715SAndy Fleming 	if (phy_write(phydev, devad, MII_BMCR, reg) < 0) {
7255f184715SAndy Fleming 		debug("PHY reset failed\n");
7265f184715SAndy Fleming 		return -1;
7275f184715SAndy Fleming 	}
7285f184715SAndy Fleming 
7295f184715SAndy Fleming #ifdef CONFIG_PHY_RESET_DELAY
7305f184715SAndy Fleming 	udelay(CONFIG_PHY_RESET_DELAY);	/* Intel LXT971A needs this */
7315f184715SAndy Fleming #endif
7325f184715SAndy Fleming 	/*
7335f184715SAndy Fleming 	 * Poll the control register for the reset bit to go to 0 (it is
7345f184715SAndy Fleming 	 * auto-clearing).  This should happen within 0.5 seconds per the
7355f184715SAndy Fleming 	 * IEEE spec.
7365f184715SAndy Fleming 	 */
7375f184715SAndy Fleming 	while ((reg & BMCR_RESET) && timeout--) {
7385f184715SAndy Fleming 		reg = phy_read(phydev, devad, MII_BMCR);
7395f184715SAndy Fleming 
7405f184715SAndy Fleming 		if (reg < 0) {
7415f184715SAndy Fleming 			debug("PHY status read failed\n");
7425f184715SAndy Fleming 			return -1;
7435f184715SAndy Fleming 		}
7445f184715SAndy Fleming 		udelay(1000);
7455f184715SAndy Fleming 	}
7465f184715SAndy Fleming 
7475f184715SAndy Fleming 	if (reg & BMCR_RESET) {
7485f184715SAndy Fleming 		puts("PHY reset timed out\n");
7495f184715SAndy Fleming 		return -1;
7505f184715SAndy Fleming 	}
7515f184715SAndy Fleming 
7525f184715SAndy Fleming 	return 0;
7535f184715SAndy Fleming }
7545f184715SAndy Fleming 
7555f184715SAndy Fleming int miiphy_reset(const char *devname, unsigned char addr)
7565f184715SAndy Fleming {
7575f184715SAndy Fleming 	struct mii_dev *bus = miiphy_get_dev_by_name(devname);
7585f184715SAndy Fleming 	struct phy_device *phydev;
7595f184715SAndy Fleming 
7605f184715SAndy Fleming 	/*
7615f184715SAndy Fleming 	 * miiphy_reset was only used on standard PHYs, so we'll fake it here.
7625f184715SAndy Fleming 	 * If later code tries to connect with the right interface, this will
7635f184715SAndy Fleming 	 * be corrected by get_phy_device in phy_connect()
7645f184715SAndy Fleming 	 */
7655f184715SAndy Fleming 	phydev = get_phy_device(bus, addr, PHY_INTERFACE_MODE_MII);
7665f184715SAndy Fleming 
7675f184715SAndy Fleming 	return phy_reset(phydev);
7685f184715SAndy Fleming }
7695f184715SAndy Fleming 
7701adb406bSTroy Kisky struct phy_device *phy_find_by_mask(struct mii_dev *bus, unsigned phy_mask,
7715f184715SAndy Fleming 		phy_interface_t interface)
7725f184715SAndy Fleming {
7735f184715SAndy Fleming 	/* Reset the bus */
77459370f3fSJörg Krause 	if (bus->reset) {
7755f184715SAndy Fleming 		bus->reset(bus);
7765f184715SAndy Fleming 
7775f184715SAndy Fleming 		/* Wait 15ms to make sure the PHY has come out of hard reset */
7785f184715SAndy Fleming 		udelay(15000);
77959370f3fSJörg Krause 	}
78059370f3fSJörg Krause 
7811adb406bSTroy Kisky 	return get_phy_device_by_mask(bus, phy_mask, interface);
7825f184715SAndy Fleming }
7835f184715SAndy Fleming 
784c74c8e66SSimon Glass #ifdef CONFIG_DM_ETH
785c74c8e66SSimon Glass void phy_connect_dev(struct phy_device *phydev, struct udevice *dev)
786c74c8e66SSimon Glass #else
7871adb406bSTroy Kisky void phy_connect_dev(struct phy_device *phydev, struct eth_device *dev)
788c74c8e66SSimon Glass #endif
7891adb406bSTroy Kisky {
7905f184715SAndy Fleming 	/* Soft Reset the PHY */
7915f184715SAndy Fleming 	phy_reset(phydev);
792*17ecfa9bSBin Meng 	if (phydev->dev && phydev->dev != dev) {
7935f184715SAndy Fleming 		printf("%s:%d is connected to %s.  Reconnecting to %s\n",
7941adb406bSTroy Kisky 				phydev->bus->name, phydev->addr,
7951adb406bSTroy Kisky 				phydev->dev->name, dev->name);
7961adb406bSTroy Kisky 	}
7975f184715SAndy Fleming 	phydev->dev = dev;
798b91a9d9dSWolfgang Denk 	debug("%s connected to %s\n", dev->name, phydev->drv->name);
7991adb406bSTroy Kisky }
8005f184715SAndy Fleming 
801c74c8e66SSimon Glass #ifdef CONFIG_DM_ETH
802c74c8e66SSimon Glass struct phy_device *phy_connect(struct mii_dev *bus, int addr,
803c74c8e66SSimon Glass 		struct udevice *dev, phy_interface_t interface)
804c74c8e66SSimon Glass #else
8051adb406bSTroy Kisky struct phy_device *phy_connect(struct mii_dev *bus, int addr,
8061adb406bSTroy Kisky 		struct eth_device *dev, phy_interface_t interface)
807c74c8e66SSimon Glass #endif
8081adb406bSTroy Kisky {
8091adb406bSTroy Kisky 	struct phy_device *phydev;
8101adb406bSTroy Kisky 
8111adb406bSTroy Kisky 	phydev = phy_find_by_mask(bus, 1 << addr, interface);
8121adb406bSTroy Kisky 	if (phydev)
8131adb406bSTroy Kisky 		phy_connect_dev(phydev, dev);
8141adb406bSTroy Kisky 	else
8151adb406bSTroy Kisky 		printf("Could not get PHY for %s: addr %d\n", bus->name, addr);
8165f184715SAndy Fleming 	return phydev;
8175f184715SAndy Fleming }
8185f184715SAndy Fleming 
8196e5b9ac0STimur Tabi /*
8206e5b9ac0STimur Tabi  * Start the PHY.  Returns 0 on success, or a negative error code.
8216e5b9ac0STimur Tabi  */
8225f184715SAndy Fleming int phy_startup(struct phy_device *phydev)
8235f184715SAndy Fleming {
8245f184715SAndy Fleming 	if (phydev->drv->startup)
8256e5b9ac0STimur Tabi 		return phydev->drv->startup(phydev);
8265f184715SAndy Fleming 
8275f184715SAndy Fleming 	return 0;
8285f184715SAndy Fleming }
8295f184715SAndy Fleming 
8303c6928fdSJeroen Hofstee __weak int board_phy_config(struct phy_device *phydev)
8315f184715SAndy Fleming {
8329fafe7daSTroy Kisky 	if (phydev->drv->config)
8339fafe7daSTroy Kisky 		return phydev->drv->config(phydev);
8345f184715SAndy Fleming 	return 0;
8355f184715SAndy Fleming }
8365f184715SAndy Fleming 
8375f184715SAndy Fleming int phy_config(struct phy_device *phydev)
8385f184715SAndy Fleming {
8395f184715SAndy Fleming 	/* Invoke an optional board-specific helper */
8405f184715SAndy Fleming 	board_phy_config(phydev);
8415f184715SAndy Fleming 
8425f184715SAndy Fleming 	return 0;
8435f184715SAndy Fleming }
8445f184715SAndy Fleming 
8455f184715SAndy Fleming int phy_shutdown(struct phy_device *phydev)
8465f184715SAndy Fleming {
8475f184715SAndy Fleming 	if (phydev->drv->shutdown)
8485f184715SAndy Fleming 		phydev->drv->shutdown(phydev);
8495f184715SAndy Fleming 
8505f184715SAndy Fleming 	return 0;
8515f184715SAndy Fleming }
852c74c8e66SSimon Glass 
853c74c8e66SSimon Glass int phy_get_interface_by_name(const char *str)
854c74c8e66SSimon Glass {
855c74c8e66SSimon Glass 	int i;
856c74c8e66SSimon Glass 
857c74c8e66SSimon Glass 	for (i = 0; i < PHY_INTERFACE_MODE_COUNT; i++) {
858c74c8e66SSimon Glass 		if (!strcmp(str, phy_interface_strings[i]))
859c74c8e66SSimon Glass 			return i;
860c74c8e66SSimon Glass 	}
861c74c8e66SSimon Glass 
862c74c8e66SSimon Glass 	return -1;
863c74c8e66SSimon Glass }
864