drivers/net/phy/micrel.c - platform/external/u-boot - Gitiles

 /*
  * Micrel PHY drivers
  *
  * SPDX-License-Identifier:	GPL-2.0+
  *
  * Copyright 2010-2011 Freescale Semiconductor, Inc.
  * author Andy Fleming
  * (C) 2012 NetModule AG, David Andrey, added KSZ9031
  */
 #include <config.h>
 #include <common.h>
 #include <dm.h>
 #include <errno.h>
 #include <fdtdec.h>
 #include <micrel.h>
 #include <phy.h>

 DECLARE_GLOBAL_DATA_PTR;

 static struct phy_driver KSZ804_driver = {
 	.name = "Micrel KSZ804",
 	.uid = 0x221510,
 	.mask = 0xfffff0,
 	.features = PHY_BASIC_FEATURES,
 	.config = &genphy_config,
 	.startup = &genphy_startup,
 	.shutdown = &genphy_shutdown,
 };

 #define MII_KSZPHY_OMSO		0x16
 #define KSZPHY_OMSO_B_CAST_OFF	(1 << 9)

 static int ksz_genconfig_bcastoff(struct phy_device *phydev)
 {
 	int ret;

 	ret = phy_read(phydev, MDIO_DEVAD_NONE, MII_KSZPHY_OMSO);
 	if (ret < 0)
 		return ret;

 	ret = phy_write(phydev, MDIO_DEVAD_NONE, MII_KSZPHY_OMSO,
 			ret | KSZPHY_OMSO_B_CAST_OFF);
 	if (ret < 0)
 		return ret;

 	return genphy_config(phydev);
 }

 static struct phy_driver KSZ8031_driver = {
 	.name = "Micrel KSZ8021/KSZ8031",
 	.uid = 0x221550,
 	.mask = 0xfffff0,
 	.features = PHY_BASIC_FEATURES,
 	.config = &ksz_genconfig_bcastoff,
 	.startup = &genphy_startup,
 	.shutdown = &genphy_shutdown,
 };

 /**
  * KSZ8051
  */
 #define MII_KSZ8051_PHY_OMSO			0x16
 #define MII_KSZ8051_PHY_OMSO_NAND_TREE_ON	(1 << 5)

 static int ksz8051_config(struct phy_device *phydev)
 {
 	unsigned val;

 	/* Disable NAND-tree */
 	val = phy_read(phydev, MDIO_DEVAD_NONE, MII_KSZ8051_PHY_OMSO);
 	val &= ~MII_KSZ8051_PHY_OMSO_NAND_TREE_ON;
 	phy_write(phydev, MDIO_DEVAD_NONE, MII_KSZ8051_PHY_OMSO, val);

 	return genphy_config(phydev);
 }

 static struct phy_driver KSZ8051_driver = {
 	.name = "Micrel KSZ8051",
 	.uid = 0x221550,
 	.mask = 0xfffff0,
 	.features = PHY_BASIC_FEATURES,
 	.config = &ksz8051_config,
 	.startup = &genphy_startup,
 	.shutdown = &genphy_shutdown,
 };

 static struct phy_driver KSZ8081_driver = {
 	.name = "Micrel KSZ8081",
 	.uid = 0x221560,
 	.mask = 0xfffff0,
 	.features = PHY_BASIC_FEATURES,
 	.config = &ksz_genconfig_bcastoff,
 	.startup = &genphy_startup,
 	.shutdown = &genphy_shutdown,
 };

 /**
  * KSZ8895
  */

 static unsigned short smireg_to_phy(unsigned short reg)
 {
 	return ((reg & 0xc0) >> 3) + 0x06 + ((reg & 0x20) >> 5);
 }

 static unsigned short smireg_to_reg(unsigned short reg)
 {
 	return reg & 0x1F;
 }

 static void ksz8895_write_smireg(struct phy_device *phydev, int smireg, int val)
 {
 	phydev->bus->write(phydev->bus, smireg_to_phy(smireg), MDIO_DEVAD_NONE,
 						smireg_to_reg(smireg), val);
 }

 #if 0
 static int ksz8895_read_smireg(struct phy_device *phydev, int smireg)
 {
 	return phydev->bus->read(phydev->bus, smireg_to_phy(smireg),
 					MDIO_DEVAD_NONE, smireg_to_reg(smireg));
 }
 #endif

 int ksz8895_config(struct phy_device *phydev)
 {
 	/* we are connected directly to the switch without
 	 * dedicated PHY. SCONF1 == 001 */
 	phydev->link = 1;
 	phydev->duplex = DUPLEX_FULL;
 	phydev->speed = SPEED_100;

 	/* Force the switch to start */
 	ksz8895_write_smireg(phydev, 1, 1);

 	return 0;
 }

 static int ksz8895_startup(struct phy_device *phydev)
 {
 	return 0;
 }

 static struct phy_driver ksz8895_driver = {
 	.name = "Micrel KSZ8895/KSZ8864",
 	.uid  = 0x221450,
 	.mask = 0xffffe1,
 	.features = PHY_BASIC_FEATURES,
 	.config   = &ksz8895_config,
 	.startup  = &ksz8895_startup,
 	.shutdown = &genphy_shutdown,
 };

 #ifndef CONFIG_PHY_MICREL_KSZ9021
 /*
  * I can't believe Micrel used the exact same part number
  * for the KSZ9021. Shame Micrel, Shame!
  */
 static struct phy_driver KS8721_driver = {
 	.name = "Micrel KS8721BL",
 	.uid = 0x221610,
 	.mask = 0xfffff0,
 	.features = PHY_BASIC_FEATURES,
 	.config = &genphy_config,
 	.startup = &genphy_startup,
 	.shutdown = &genphy_shutdown,
 };
 #endif


 /*
  * KSZ9021 - KSZ9031 common
  */

 #define MII_KSZ90xx_PHY_CTL		0x1f
 #define MIIM_KSZ90xx_PHYCTL_1000	(1 << 6)
 #define MIIM_KSZ90xx_PHYCTL_100		(1 << 5)
 #define MIIM_KSZ90xx_PHYCTL_10		(1 << 4)
 #define MIIM_KSZ90xx_PHYCTL_DUPLEX	(1 << 3)

 static int ksz90xx_startup(struct phy_device *phydev)
 {
 	unsigned phy_ctl;
 	int ret;

 	ret = genphy_update_link(phydev);
 	if (ret)
 		return ret;

 	phy_ctl = phy_read(phydev, MDIO_DEVAD_NONE, MII_KSZ90xx_PHY_CTL);

 	if (phy_ctl & MIIM_KSZ90xx_PHYCTL_DUPLEX)
 		phydev->duplex = DUPLEX_FULL;
 	else
 		phydev->duplex = DUPLEX_HALF;

 	if (phy_ctl & MIIM_KSZ90xx_PHYCTL_1000)
 		phydev->speed = SPEED_1000;
 	else if (phy_ctl & MIIM_KSZ90xx_PHYCTL_100)
 		phydev->speed = SPEED_100;
 	else if (phy_ctl & MIIM_KSZ90xx_PHYCTL_10)
 		phydev->speed = SPEED_10;
 	return 0;
 }

 /* Common OF config bits for KSZ9021 and KSZ9031 */
 #if defined(CONFIG_PHY_MICREL_KSZ9021) || defined(CONFIG_PHY_MICREL_KSZ9031)
 #ifdef CONFIG_DM_ETH
 struct ksz90x1_reg_field {
 	const char	*name;
 	const u8	size;	/* Size of the bitfield, in bits */
 	const u8	off;	/* Offset from bit 0 */
 	const u8	dflt;	/* Default value */
 };

 struct ksz90x1_ofcfg {
 	const u16			reg;
 	const u16			devad;
 	const struct ksz90x1_reg_field	*grp;
 	const u16			grpsz;
 };

 static const struct ksz90x1_reg_field ksz90x1_rxd_grp[] = {
 	{ "rxd0-skew-ps", 4, 0, 0x7 }, { "rxd1-skew-ps", 4, 4, 0x7 },
 	{ "rxd2-skew-ps", 4, 8, 0x7 }, { "rxd3-skew-ps", 4, 12, 0x7 }
 };

 static const struct ksz90x1_reg_field ksz90x1_txd_grp[] = {
 	{ "txd0-skew-ps", 4, 0, 0x7 }, { "txd1-skew-ps", 4, 4, 0x7 },
 	{ "txd2-skew-ps", 4, 8, 0x7 }, { "txd3-skew-ps", 4, 12, 0x7 },
 };

 static int ksz90x1_of_config_group(struct phy_device *phydev,
 				   struct ksz90x1_ofcfg *ofcfg)
 {
 	struct udevice *dev = phydev->dev;
 	struct phy_driver *drv = phydev->drv;
 	const int ps_to_regval = 60;
 	int val[4];
 	int i, changed = 0, offset, max;
 	u16 regval = 0;

 	if (!drv || !drv->writeext)
 		return -EOPNOTSUPP;

 	for (i = 0; i < ofcfg->grpsz; i++) {
 		val[i] = fdtdec_get_uint(gd->fdt_blob, dev_of_offset(dev),
 					 ofcfg->grp[i].name, -1);
 		offset = ofcfg->grp[i].off;
 		if (val[i] == -1) {
 			/* Default register value for KSZ9021 */
 			regval |= ofcfg->grp[i].dflt << offset;
 		} else {
 			changed = 1;	/* Value was changed in OF */
 			/* Calculate the register value and fix corner cases */
 			if (val[i] > ps_to_regval * 0xf) {
 				max = (1 << ofcfg->grp[i].size) - 1;
 				regval |= max << offset;
 			} else {
 				regval |= (val[i] / ps_to_regval) << offset;
 			}
 		}
 	}

 	if (!changed)
 		return 0;

 	return drv->writeext(phydev, 0, ofcfg->devad, ofcfg->reg, regval);
 }
 #endif
 #endif

 #ifdef CONFIG_PHY_MICREL_KSZ9021
 /*
  * KSZ9021
  */

 /* PHY Registers */
 #define MII_KSZ9021_EXTENDED_CTRL	0x0b
 #define MII_KSZ9021_EXTENDED_DATAW	0x0c
 #define MII_KSZ9021_EXTENDED_DATAR	0x0d

 #define CTRL1000_PREFER_MASTER		(1 << 10)
 #define CTRL1000_CONFIG_MASTER		(1 << 11)
 #define CTRL1000_MANUAL_CONFIG		(1 << 12)

 #if defined(CONFIG_DM_ETH) && (defined(CONFIG_PHY_MICREL_KSZ9021) || \
 			       defined(CONFIG_PHY_MICREL_KSZ9031))
 static const struct ksz90x1_reg_field ksz9021_clk_grp[] = {
 	{ "txen-skew-ps", 4, 0, 0x7 }, { "txc-skew-ps", 4, 4, 0x7 },
 	{ "rxdv-skew-ps", 4, 8, 0x7 }, { "rxc-skew-ps", 4, 12, 0x7 },
 };

 static int ksz9021_of_config(struct phy_device *phydev)
 {
 	struct ksz90x1_ofcfg ofcfg[] = {
 		{ MII_KSZ9021_EXT_RGMII_RX_DATA_SKEW, 0, ksz90x1_rxd_grp, 4 },
 		{ MII_KSZ9021_EXT_RGMII_TX_DATA_SKEW, 0, ksz90x1_txd_grp, 4 },
 		{ MII_KSZ9021_EXT_RGMII_CLOCK_SKEW, 0, ksz9021_clk_grp, 4 },
 	};
 	int i, ret = 0;

 	for (i = 0; i < ARRAY_SIZE(ofcfg); i++) {
 		ret = ksz90x1_of_config_group(phydev, &(ofcfg[i]));
 		if (ret)
 			return ret;
 	}

 	return 0;
 }
 #else
 static int ksz9021_of_config(struct phy_device *phydev)
 {
 	return 0;
 }
 #endif

 int ksz9021_phy_extended_write(struct phy_device *phydev, int regnum, u16 val)
 {
 	/* extended registers */
 	phy_write(phydev, MDIO_DEVAD_NONE,
 		MII_KSZ9021_EXTENDED_CTRL, regnum | 0x8000);
 	return phy_write(phydev, MDIO_DEVAD_NONE,
 		MII_KSZ9021_EXTENDED_DATAW, val);
 }

 int ksz9021_phy_extended_read(struct phy_device *phydev, int regnum)
 {
 	/* extended registers */
 	phy_write(phydev, MDIO_DEVAD_NONE, MII_KSZ9021_EXTENDED_CTRL, regnum);
 	return phy_read(phydev, MDIO_DEVAD_NONE, MII_KSZ9021_EXTENDED_DATAR);
 }


 static int ksz9021_phy_extread(struct phy_device *phydev, int addr, int devaddr,
 			      int regnum)
 {
 	return ksz9021_phy_extended_read(phydev, regnum);
 }

 static int ksz9021_phy_extwrite(struct phy_device *phydev, int addr,
 			       int devaddr, int regnum, u16 val)
 {
 	return ksz9021_phy_extended_write(phydev, regnum, val);
 }

 /* Micrel ksz9021 */
 static int ksz9021_config(struct phy_device *phydev)
 {
 	unsigned ctrl1000 = 0;
 	const unsigned master = CTRL1000_PREFER_MASTER |
 			CTRL1000_CONFIG_MASTER | CTRL1000_MANUAL_CONFIG;
 	unsigned features = phydev->drv->features;
 	int ret;

 	ret = ksz9021_of_config(phydev);
 	if (ret)
 		return ret;

 	if (getenv("disable_giga"))
 		features &= ~(SUPPORTED_1000baseT_Half |
 				SUPPORTED_1000baseT_Full);
 	/* force master mode for 1000BaseT due to chip errata */
 	if (features & SUPPORTED_1000baseT_Half)
 		ctrl1000 |= ADVERTISE_1000HALF | master;
 	if (features & SUPPORTED_1000baseT_Full)
 		ctrl1000 |= ADVERTISE_1000FULL | master;
 	phydev->advertising = phydev->supported = features;
 	phy_write(phydev, MDIO_DEVAD_NONE, MII_CTRL1000, ctrl1000);
 	genphy_config_aneg(phydev);
 	genphy_restart_aneg(phydev);
 	return 0;
 }

 static struct phy_driver ksz9021_driver = {
 	.name = "Micrel ksz9021",
 	.uid  = 0x221610,
 	.mask = 0xfffff0,
 	.features = PHY_GBIT_FEATURES,
 	.config = &ksz9021_config,
 	.startup = &ksz90xx_startup,
 	.shutdown = &genphy_shutdown,
 	.writeext = &ksz9021_phy_extwrite,
 	.readext = &ksz9021_phy_extread,
 };
 #endif

 /**
  * KSZ9031
  */
 /* PHY Registers */
 #define MII_KSZ9031_MMD_ACCES_CTRL	0x0d
 #define MII_KSZ9031_MMD_REG_DATA	0x0e

 #if defined(CONFIG_DM_ETH) && (defined(CONFIG_PHY_MICREL_KSZ9021) || \
 			       defined(CONFIG_PHY_MICREL_KSZ9031))
 static const struct ksz90x1_reg_field ksz9031_ctl_grp[] =
 	{ { "txen-skew-ps", 4, 0, 0x7 }, { "rxdv-skew-ps", 4, 4, 0x7 } };
 static const struct ksz90x1_reg_field ksz9031_clk_grp[] =
 	{ { "rxc-skew-ps", 5, 0, 0xf }, { "txc-skew-ps", 5, 5, 0xf } };

 static int ksz9031_of_config(struct phy_device *phydev)
 {
 	struct ksz90x1_ofcfg ofcfg[] = {
 		{ MII_KSZ9031_EXT_RGMII_CTRL_SIG_SKEW, 2, ksz9031_ctl_grp, 2 },
 		{ MII_KSZ9031_EXT_RGMII_RX_DATA_SKEW, 2, ksz90x1_rxd_grp, 4 },
 		{ MII_KSZ9031_EXT_RGMII_TX_DATA_SKEW, 2, ksz90x1_txd_grp, 4 },
 		{ MII_KSZ9031_EXT_RGMII_CLOCK_SKEW, 2, ksz9031_clk_grp, 2 },
 	};
 	int i, ret = 0;

 	for (i = 0; i < ARRAY_SIZE(ofcfg); i++) {
 		ret = ksz90x1_of_config_group(phydev, &(ofcfg[i]));
 		if (ret)
 			return ret;
 	}

 	return 0;
 }

 static int ksz9031_center_flp_timing(struct phy_device *phydev)
 {
 	struct phy_driver *drv = phydev->drv;
 	int ret = 0;

 	if (!drv || !drv->writeext)
 		return -EOPNOTSUPP;

 	ret = drv->writeext(phydev, 0, 0, MII_KSZ9031_FLP_BURST_TX_LO, 0x1A80);
 	if (ret)
 		return ret;

 	ret = drv->writeext(phydev, 0, 0, MII_KSZ9031_FLP_BURST_TX_HI, 0x6);
 	return ret;
 }
 #else
 static int ksz9031_of_config(struct phy_device *phydev)
 {
 	return 0;
 }
 static int ksz9031_center_flp_timing(struct phy_device *phydev)
 {
 	return 0;
 }
 #endif

 /* Accessors to extended registers*/
 int ksz9031_phy_extended_write(struct phy_device *phydev,
 			       int devaddr, int regnum, u16 mode, u16 val)
 {
 	/*select register addr for mmd*/
 	phy_write(phydev, MDIO_DEVAD_NONE,
 		  MII_KSZ9031_MMD_ACCES_CTRL, devaddr);
 	/*select register for mmd*/
 	phy_write(phydev, MDIO_DEVAD_NONE,
 		  MII_KSZ9031_MMD_REG_DATA, regnum);
 	/*setup mode*/
 	phy_write(phydev, MDIO_DEVAD_NONE,
 		  MII_KSZ9031_MMD_ACCES_CTRL, (mode | devaddr));
 	/*write the value*/
 	return	phy_write(phydev, MDIO_DEVAD_NONE,
 		MII_KSZ9031_MMD_REG_DATA, val);
 }

 int ksz9031_phy_extended_read(struct phy_device *phydev, int devaddr,
 			      int regnum, u16 mode)
 {
 	phy_write(phydev, MDIO_DEVAD_NONE,
 		  MII_KSZ9031_MMD_ACCES_CTRL, devaddr);
 	phy_write(phydev, MDIO_DEVAD_NONE,
 		  MII_KSZ9031_MMD_REG_DATA, regnum);
 	phy_write(phydev, MDIO_DEVAD_NONE,
 		  MII_KSZ9031_MMD_ACCES_CTRL, (devaddr | mode));
 	return phy_read(phydev, MDIO_DEVAD_NONE, MII_KSZ9031_MMD_REG_DATA);
 }

 static int ksz9031_phy_extread(struct phy_device *phydev, int addr, int devaddr,
 			       int regnum)
 {
 	return ksz9031_phy_extended_read(phydev, devaddr, regnum,
 					 MII_KSZ9031_MOD_DATA_NO_POST_INC);
 };

 static int ksz9031_phy_extwrite(struct phy_device *phydev, int addr,
 				int devaddr, int regnum, u16 val)
 {
 	return ksz9031_phy_extended_write(phydev, devaddr, regnum,
 					 MII_KSZ9031_MOD_DATA_POST_INC_RW, val);
 };

 static int ksz9031_config(struct phy_device *phydev)
 {
 	int ret;
 	ret = ksz9031_of_config(phydev);
 	if (ret)
 		return ret;
 	ret = ksz9031_center_flp_timing(phydev);
 	if (ret)
 		return ret;
 	return genphy_config(phydev);
 }

 static struct phy_driver ksz9031_driver = {
 	.name = "Micrel ksz9031",
 	.uid  = 0x221620,
 	.mask = 0xfffff0,
 	.features = PHY_GBIT_FEATURES,
 	.config   = &ksz9031_config,
 	.startup  = &ksz90xx_startup,
 	.shutdown = &genphy_shutdown,
 	.writeext = &ksz9031_phy_extwrite,
 	.readext = &ksz9031_phy_extread,
 };

 int ksz886x_config(struct phy_device *phydev)
 {
 	/* we are connected directly to the switch without
 	 * dedicated PHY. */
 	phydev->link = 1;
 	phydev->duplex = DUPLEX_FULL;
 	phydev->speed = SPEED_100;
 	return 0;
 }

 static int ksz886x_startup(struct phy_device *phydev)
 {
 	return 0;
 }

 static struct phy_driver ksz886x_driver = {
 	.name = "Micrel KSZ886x Switch",
 	.uid  = 0x00221430,
 	.mask = 0xfffff0,
 	.features = PHY_BASIC_FEATURES,
 	.config = &ksz886x_config,
 	.startup = &ksz886x_startup,
 	.shutdown = &genphy_shutdown,
 };

 int phy_micrel_init(void)
 {
 	phy_register(&KSZ804_driver);
 	phy_register(&KSZ8031_driver);
 	phy_register(&KSZ8051_driver);
 	phy_register(&KSZ8081_driver);
 #ifdef CONFIG_PHY_MICREL_KSZ9021
 	phy_register(&ksz9021_driver);
 #else
 	phy_register(&KS8721_driver);
 #endif
 	phy_register(&ksz9031_driver);
 	phy_register(&ksz8895_driver);
 	phy_register(&ksz886x_driver);
 	return 0;
 }
	/*
	* Micrel PHY drivers
	*
	* SPDX-License-Identifier: GPL-2.0+
	*
	* Copyright 2010-2011 Freescale Semiconductor, Inc.
	* author Andy Fleming
	* (C) 2012 NetModule AG, David Andrey, added KSZ9031
	*/
	#include <config.h>
	#include <common.h>
	#include <dm.h>
	#include <errno.h>
	#include <fdtdec.h>
	#include <micrel.h>
	#include <phy.h>

	DECLARE_GLOBAL_DATA_PTR;

	static struct phy_driver KSZ804_driver = {
	.name = "Micrel KSZ804",
	.uid = 0x221510,
	.mask = 0xfffff0,
	.features = PHY_BASIC_FEATURES,
	.config = &genphy_config,
	.startup = &genphy_startup,
	.shutdown = &genphy_shutdown,
	};

	#define MII_KSZPHY_OMSO 0x16
	#define KSZPHY_OMSO_B_CAST_OFF (1 << 9)

	static int ksz_genconfig_bcastoff(struct phy_device *phydev)
	{
	int ret;

	ret = phy_read(phydev, MDIO_DEVAD_NONE, MII_KSZPHY_OMSO);
	if (ret < 0)
	return ret;

	ret = phy_write(phydev, MDIO_DEVAD_NONE, MII_KSZPHY_OMSO,
	ret \| KSZPHY_OMSO_B_CAST_OFF);
	if (ret < 0)
	return ret;

	return genphy_config(phydev);
	}

	static struct phy_driver KSZ8031_driver = {
	.name = "Micrel KSZ8021/KSZ8031",
	.uid = 0x221550,
	.mask = 0xfffff0,
	.features = PHY_BASIC_FEATURES,
	.config = &ksz_genconfig_bcastoff,
	.startup = &genphy_startup,
	.shutdown = &genphy_shutdown,
	};

	/**
	* KSZ8051
	*/
	#define MII_KSZ8051_PHY_OMSO 0x16
	#define MII_KSZ8051_PHY_OMSO_NAND_TREE_ON (1 << 5)

	static int ksz8051_config(struct phy_device *phydev)
	{
	unsigned val;

	/* Disable NAND-tree */
	val = phy_read(phydev, MDIO_DEVAD_NONE, MII_KSZ8051_PHY_OMSO);
	val &= ~MII_KSZ8051_PHY_OMSO_NAND_TREE_ON;
	phy_write(phydev, MDIO_DEVAD_NONE, MII_KSZ8051_PHY_OMSO, val);

	return genphy_config(phydev);
	}

	static struct phy_driver KSZ8051_driver = {
	.name = "Micrel KSZ8051",
	.uid = 0x221550,
	.mask = 0xfffff0,
	.features = PHY_BASIC_FEATURES,
	.config = &ksz8051_config,
	.startup = &genphy_startup,
	.shutdown = &genphy_shutdown,
	};

	static struct phy_driver KSZ8081_driver = {
	.name = "Micrel KSZ8081",
	.uid = 0x221560,
	.mask = 0xfffff0,
	.features = PHY_BASIC_FEATURES,
	.config = &ksz_genconfig_bcastoff,
	.startup = &genphy_startup,
	.shutdown = &genphy_shutdown,
	};

	/**
	* KSZ8895
	*/

	static unsigned short smireg_to_phy(unsigned short reg)
	{
	return ((reg & 0xc0) >> 3) + 0x06 + ((reg & 0x20) >> 5);
	}

	static unsigned short smireg_to_reg(unsigned short reg)
	{
	return reg & 0x1F;
	}

	static void ksz8895_write_smireg(struct phy_device *phydev, int smireg, int val)
	{
	phydev->bus->write(phydev->bus, smireg_to_phy(smireg), MDIO_DEVAD_NONE,
	smireg_to_reg(smireg), val);
	}

	#if 0
	static int ksz8895_read_smireg(struct phy_device *phydev, int smireg)
	{
	return phydev->bus->read(phydev->bus, smireg_to_phy(smireg),
	MDIO_DEVAD_NONE, smireg_to_reg(smireg));
	}
	#endif

	int ksz8895_config(struct phy_device *phydev)
	{
	/* we are connected directly to the switch without
	* dedicated PHY. SCONF1 == 001 */
	phydev->link = 1;
	phydev->duplex = DUPLEX_FULL;
	phydev->speed = SPEED_100;

	/* Force the switch to start */
	ksz8895_write_smireg(phydev, 1, 1);

	return 0;
	}

	static int ksz8895_startup(struct phy_device *phydev)
	{
	return 0;
	}

	static struct phy_driver ksz8895_driver = {
	.name = "Micrel KSZ8895/KSZ8864",
	.uid = 0x221450,
	.mask = 0xffffe1,
	.features = PHY_BASIC_FEATURES,
	.config = &ksz8895_config,
	.startup = &ksz8895_startup,
	.shutdown = &genphy_shutdown,
	};

	#ifndef CONFIG_PHY_MICREL_KSZ9021
	/*
	* I can't believe Micrel used the exact same part number
	* for the KSZ9021. Shame Micrel, Shame!
	*/
	static struct phy_driver KS8721_driver = {
	.name = "Micrel KS8721BL",
	.uid = 0x221610,
	.mask = 0xfffff0,
	.features = PHY_BASIC_FEATURES,
	.config = &genphy_config,
	.startup = &genphy_startup,
	.shutdown = &genphy_shutdown,
	};
	#endif


	/*
	* KSZ9021 - KSZ9031 common
	*/

	#define MII_KSZ90xx_PHY_CTL 0x1f
	#define MIIM_KSZ90xx_PHYCTL_1000 (1 << 6)
	#define MIIM_KSZ90xx_PHYCTL_100 (1 << 5)
	#define MIIM_KSZ90xx_PHYCTL_10 (1 << 4)
	#define MIIM_KSZ90xx_PHYCTL_DUPLEX (1 << 3)

	static int ksz90xx_startup(struct phy_device *phydev)
	{
	unsigned phy_ctl;
	int ret;

	ret = genphy_update_link(phydev);
	if (ret)
	return ret;

	phy_ctl = phy_read(phydev, MDIO_DEVAD_NONE, MII_KSZ90xx_PHY_CTL);

	if (phy_ctl & MIIM_KSZ90xx_PHYCTL_DUPLEX)
	phydev->duplex = DUPLEX_FULL;
	else
	phydev->duplex = DUPLEX_HALF;

	if (phy_ctl & MIIM_KSZ90xx_PHYCTL_1000)
	phydev->speed = SPEED_1000;
	else if (phy_ctl & MIIM_KSZ90xx_PHYCTL_100)
	phydev->speed = SPEED_100;
	else if (phy_ctl & MIIM_KSZ90xx_PHYCTL_10)
	phydev->speed = SPEED_10;
	return 0;
	}

	/* Common OF config bits for KSZ9021 and KSZ9031 */
	#if defined(CONFIG_PHY_MICREL_KSZ9021) \|\| defined(CONFIG_PHY_MICREL_KSZ9031)
	#ifdef CONFIG_DM_ETH
	struct ksz90x1_reg_field {
	const char *name;
	const u8 size; /* Size of the bitfield, in bits */
	const u8 off; /* Offset from bit 0 */
	const u8 dflt; /* Default value */
	};

	struct ksz90x1_ofcfg {
	const u16 reg;
	const u16 devad;
	const struct ksz90x1_reg_field *grp;
	const u16 grpsz;
	};

	static const struct ksz90x1_reg_field ksz90x1_rxd_grp[] = {
	{ "rxd0-skew-ps", 4, 0, 0x7 }, { "rxd1-skew-ps", 4, 4, 0x7 },
	{ "rxd2-skew-ps", 4, 8, 0x7 }, { "rxd3-skew-ps", 4, 12, 0x7 }
	};

	static const struct ksz90x1_reg_field ksz90x1_txd_grp[] = {
	{ "txd0-skew-ps", 4, 0, 0x7 }, { "txd1-skew-ps", 4, 4, 0x7 },
	{ "txd2-skew-ps", 4, 8, 0x7 }, { "txd3-skew-ps", 4, 12, 0x7 },
	};

	static int ksz90x1_of_config_group(struct phy_device *phydev,
	struct ksz90x1_ofcfg *ofcfg)
	{
	struct udevice *dev = phydev->dev;
	struct phy_driver *drv = phydev->drv;
	const int ps_to_regval = 60;
	int val[4];
	int i, changed = 0, offset, max;
	u16 regval = 0;

	if (!drv \|\| !drv->writeext)
	return -EOPNOTSUPP;

	for (i = 0; i < ofcfg->grpsz; i++) {
	val[i] = fdtdec_get_uint(gd->fdt_blob, dev_of_offset(dev),
	ofcfg->grp[i].name, -1);
	offset = ofcfg->grp[i].off;
	if (val[i] == -1) {
	/* Default register value for KSZ9021 */
	regval \|= ofcfg->grp[i].dflt << offset;
	} else {
	changed = 1; /* Value was changed in OF */
	/* Calculate the register value and fix corner cases */
	if (val[i] > ps_to_regval * 0xf) {
	max = (1 << ofcfg->grp[i].size) - 1;
	regval \|= max << offset;
	} else {
	regval \|= (val[i] / ps_to_regval) << offset;
	}
	}
	}

	if (!changed)
	return 0;

	return drv->writeext(phydev, 0, ofcfg->devad, ofcfg->reg, regval);
	}
	#endif
	#endif

	#ifdef CONFIG_PHY_MICREL_KSZ9021
	/*
	* KSZ9021
	*/

	/* PHY Registers */
	#define MII_KSZ9021_EXTENDED_CTRL 0x0b
	#define MII_KSZ9021_EXTENDED_DATAW 0x0c
	#define MII_KSZ9021_EXTENDED_DATAR 0x0d

	#define CTRL1000_PREFER_MASTER (1 << 10)
	#define CTRL1000_CONFIG_MASTER (1 << 11)
	#define CTRL1000_MANUAL_CONFIG (1 << 12)

	#if defined(CONFIG_DM_ETH) && (defined(CONFIG_PHY_MICREL_KSZ9021) \|\| \
	defined(CONFIG_PHY_MICREL_KSZ9031))
	static const struct ksz90x1_reg_field ksz9021_clk_grp[] = {
	{ "txen-skew-ps", 4, 0, 0x7 }, { "txc-skew-ps", 4, 4, 0x7 },
	{ "rxdv-skew-ps", 4, 8, 0x7 }, { "rxc-skew-ps", 4, 12, 0x7 },
	};

	static int ksz9021_of_config(struct phy_device *phydev)
	{
	struct ksz90x1_ofcfg ofcfg[] = {
	{ MII_KSZ9021_EXT_RGMII_RX_DATA_SKEW, 0, ksz90x1_rxd_grp, 4 },
	{ MII_KSZ9021_EXT_RGMII_TX_DATA_SKEW, 0, ksz90x1_txd_grp, 4 },
	{ MII_KSZ9021_EXT_RGMII_CLOCK_SKEW, 0, ksz9021_clk_grp, 4 },
	};
	int i, ret = 0;

	for (i = 0; i < ARRAY_SIZE(ofcfg); i++) {
	ret = ksz90x1_of_config_group(phydev, &(ofcfg[i]));
	if (ret)
	return ret;
	}

	return 0;
	}
	#else
	static int ksz9021_of_config(struct phy_device *phydev)
	{
	return 0;
	}
	#endif

	int ksz9021_phy_extended_write(struct phy_device *phydev, int regnum, u16 val)
	{
	/* extended registers */
	phy_write(phydev, MDIO_DEVAD_NONE,
	MII_KSZ9021_EXTENDED_CTRL, regnum \| 0x8000);
	return phy_write(phydev, MDIO_DEVAD_NONE,
	MII_KSZ9021_EXTENDED_DATAW, val);
	}

	int ksz9021_phy_extended_read(struct phy_device *phydev, int regnum)
	{
	/* extended registers */
	phy_write(phydev, MDIO_DEVAD_NONE, MII_KSZ9021_EXTENDED_CTRL, regnum);
	return phy_read(phydev, MDIO_DEVAD_NONE, MII_KSZ9021_EXTENDED_DATAR);
	}


	static int ksz9021_phy_extread(struct phy_device *phydev, int addr, int devaddr,
	int regnum)
	{
	return ksz9021_phy_extended_read(phydev, regnum);
	}

	static int ksz9021_phy_extwrite(struct phy_device *phydev, int addr,
	int devaddr, int regnum, u16 val)
	{
	return ksz9021_phy_extended_write(phydev, regnum, val);
	}

	/* Micrel ksz9021 */
	static int ksz9021_config(struct phy_device *phydev)
	{
	unsigned ctrl1000 = 0;
	const unsigned master = CTRL1000_PREFER_MASTER \|
	CTRL1000_CONFIG_MASTER \| CTRL1000_MANUAL_CONFIG;
	unsigned features = phydev->drv->features;
	int ret;

	ret = ksz9021_of_config(phydev);
	if (ret)
	return ret;

	if (getenv("disable_giga"))
	features &= ~(SUPPORTED_1000baseT_Half \|
	SUPPORTED_1000baseT_Full);
	/* force master mode for 1000BaseT due to chip errata */
	if (features & SUPPORTED_1000baseT_Half)
	ctrl1000 \|= ADVERTISE_1000HALF \| master;
	if (features & SUPPORTED_1000baseT_Full)
	ctrl1000 \|= ADVERTISE_1000FULL \| master;
	phydev->advertising = phydev->supported = features;
	phy_write(phydev, MDIO_DEVAD_NONE, MII_CTRL1000, ctrl1000);
	genphy_config_aneg(phydev);
	genphy_restart_aneg(phydev);
	return 0;
	}

	static struct phy_driver ksz9021_driver = {
	.name = "Micrel ksz9021",
	.uid = 0x221610,
	.mask = 0xfffff0,
	.features = PHY_GBIT_FEATURES,
	.config = &ksz9021_config,
	.startup = &ksz90xx_startup,
	.shutdown = &genphy_shutdown,
	.writeext = &ksz9021_phy_extwrite,
	.readext = &ksz9021_phy_extread,
	};
	#endif

	/**
	* KSZ9031
	*/
	/* PHY Registers */
	#define MII_KSZ9031_MMD_ACCES_CTRL 0x0d
	#define MII_KSZ9031_MMD_REG_DATA 0x0e

	#if defined(CONFIG_DM_ETH) && (defined(CONFIG_PHY_MICREL_KSZ9021) \|\| \
	defined(CONFIG_PHY_MICREL_KSZ9031))
	static const struct ksz90x1_reg_field ksz9031_ctl_grp[] =
	{ { "txen-skew-ps", 4, 0, 0x7 }, { "rxdv-skew-ps", 4, 4, 0x7 } };
	static const struct ksz90x1_reg_field ksz9031_clk_grp[] =
	{ { "rxc-skew-ps", 5, 0, 0xf }, { "txc-skew-ps", 5, 5, 0xf } };

	static int ksz9031_of_config(struct phy_device *phydev)
	{
	struct ksz90x1_ofcfg ofcfg[] = {
	{ MII_KSZ9031_EXT_RGMII_CTRL_SIG_SKEW, 2, ksz9031_ctl_grp, 2 },
	{ MII_KSZ9031_EXT_RGMII_RX_DATA_SKEW, 2, ksz90x1_rxd_grp, 4 },
	{ MII_KSZ9031_EXT_RGMII_TX_DATA_SKEW, 2, ksz90x1_txd_grp, 4 },
	{ MII_KSZ9031_EXT_RGMII_CLOCK_SKEW, 2, ksz9031_clk_grp, 2 },
	};
	int i, ret = 0;

	for (i = 0; i < ARRAY_SIZE(ofcfg); i++) {
	ret = ksz90x1_of_config_group(phydev, &(ofcfg[i]));
	if (ret)
	return ret;
	}

	return 0;
	}

	static int ksz9031_center_flp_timing(struct phy_device *phydev)
	{
	struct phy_driver *drv = phydev->drv;
	int ret = 0;

	if (!drv \|\| !drv->writeext)
	return -EOPNOTSUPP;

	ret = drv->writeext(phydev, 0, 0, MII_KSZ9031_FLP_BURST_TX_LO, 0x1A80);
	if (ret)
	return ret;

	ret = drv->writeext(phydev, 0, 0, MII_KSZ9031_FLP_BURST_TX_HI, 0x6);
	return ret;
	}
	#else
	static int ksz9031_of_config(struct phy_device *phydev)
	{
	return 0;
	}
	static int ksz9031_center_flp_timing(struct phy_device *phydev)
	{
	return 0;
	}
	#endif

	/* Accessors to extended registers*/
	int ksz9031_phy_extended_write(struct phy_device *phydev,
	int devaddr, int regnum, u16 mode, u16 val)
	{
	/select register addr for mmd/
	phy_write(phydev, MDIO_DEVAD_NONE,
	MII_KSZ9031_MMD_ACCES_CTRL, devaddr);
	/select register for mmd/
	phy_write(phydev, MDIO_DEVAD_NONE,
	MII_KSZ9031_MMD_REG_DATA, regnum);
	/setup mode/
	phy_write(phydev, MDIO_DEVAD_NONE,
	MII_KSZ9031_MMD_ACCES_CTRL, (mode \| devaddr));
	/write the value/
	return phy_write(phydev, MDIO_DEVAD_NONE,
	MII_KSZ9031_MMD_REG_DATA, val);
	}

	int ksz9031_phy_extended_read(struct phy_device *phydev, int devaddr,
	int regnum, u16 mode)
	{
	phy_write(phydev, MDIO_DEVAD_NONE,
	MII_KSZ9031_MMD_ACCES_CTRL, devaddr);
	phy_write(phydev, MDIO_DEVAD_NONE,
	MII_KSZ9031_MMD_REG_DATA, regnum);
	phy_write(phydev, MDIO_DEVAD_NONE,
	MII_KSZ9031_MMD_ACCES_CTRL, (devaddr \| mode));
	return phy_read(phydev, MDIO_DEVAD_NONE, MII_KSZ9031_MMD_REG_DATA);
	}

	static int ksz9031_phy_extread(struct phy_device *phydev, int addr, int devaddr,
	int regnum)
	{
	return ksz9031_phy_extended_read(phydev, devaddr, regnum,
	MII_KSZ9031_MOD_DATA_NO_POST_INC);
	};

	static int ksz9031_phy_extwrite(struct phy_device *phydev, int addr,
	int devaddr, int regnum, u16 val)
	{
	return ksz9031_phy_extended_write(phydev, devaddr, regnum,
	MII_KSZ9031_MOD_DATA_POST_INC_RW, val);
	};

	static int ksz9031_config(struct phy_device *phydev)
	{
	int ret;
	ret = ksz9031_of_config(phydev);
	if (ret)
	return ret;
	ret = ksz9031_center_flp_timing(phydev);
	if (ret)
	return ret;
	return genphy_config(phydev);
	}

	static struct phy_driver ksz9031_driver = {
	.name = "Micrel ksz9031",
	.uid = 0x221620,
	.mask = 0xfffff0,
	.features = PHY_GBIT_FEATURES,
	.config = &ksz9031_config,
	.startup = &ksz90xx_startup,
	.shutdown = &genphy_shutdown,
	.writeext = &ksz9031_phy_extwrite,
	.readext = &ksz9031_phy_extread,
	};

	int ksz886x_config(struct phy_device *phydev)
	{
	/* we are connected directly to the switch without
	* dedicated PHY. */
	phydev->link = 1;
	phydev->duplex = DUPLEX_FULL;
	phydev->speed = SPEED_100;
	return 0;
	}

	static int ksz886x_startup(struct phy_device *phydev)
	{
	return 0;
	}

	static struct phy_driver ksz886x_driver = {
	.name = "Micrel KSZ886x Switch",
	.uid = 0x00221430,
	.mask = 0xfffff0,
	.features = PHY_BASIC_FEATURES,
	.config = &ksz886x_config,
	.startup = &ksz886x_startup,
	.shutdown = &genphy_shutdown,
	};

	int phy_micrel_init(void)
	{
	phy_register(&KSZ804_driver);
	phy_register(&KSZ8031_driver);
	phy_register(&KSZ8051_driver);
	phy_register(&KSZ8081_driver);
	#ifdef CONFIG_PHY_MICREL_KSZ9021
	phy_register(&ksz9021_driver);
	#else
	phy_register(&KS8721_driver);
	#endif
	phy_register(&ksz9031_driver);
	phy_register(&ksz8895_driver);
	phy_register(&ksz886x_driver);
	return 0;
	}