508 lines
		
	
	
		
			14 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			508 lines
		
	
	
		
			14 KiB
		
	
	
	
		
			C
		
	
	
	
// SPDX-License-Identifier: GPL-2.0
 | 
						|
/*
 | 
						|
 * TI PHY drivers
 | 
						|
 *
 | 
						|
 */
 | 
						|
 | 
						|
#include <common.h>
 | 
						|
#include <phy.h>
 | 
						|
#include <linux/compat.h>
 | 
						|
#include <malloc.h>
 | 
						|
 | 
						|
#include <dm.h>
 | 
						|
#include <dt-bindings/net/ti-dp83869.h>
 | 
						|
 | 
						|
/* TI DP83869 */
 | 
						|
#define DP83869_DEVADDR		0x1f
 | 
						|
 | 
						|
#define MII_DP83869_PHYCTRL	0x10
 | 
						|
#define MII_DP83869_MICR	0x12
 | 
						|
#define MII_DP83869_CFG2	0x14
 | 
						|
#define MII_DP83869_BISCR	0x16
 | 
						|
#define DP83869_CTRL		0x1f
 | 
						|
#define DP83869_CFG4		0x1e
 | 
						|
 | 
						|
/* Extended Registers */
 | 
						|
#define DP83869_GEN_CFG3	0x0031
 | 
						|
#define DP83869_RGMIICTL	0x0032
 | 
						|
#define DP83869_STRAP_STS1	0x006E
 | 
						|
#define DP83869_RGMIIDCTL	0x0086
 | 
						|
#define DP83869_IO_MUX_CFG	0x0170
 | 
						|
#define DP83869_OP_MODE		0x01df
 | 
						|
#define DP83869_FX_CTRL		0x0c00
 | 
						|
 | 
						|
#define DP83869_SW_RESET	BIT(15)
 | 
						|
#define DP83869_SW_RESTART	BIT(14)
 | 
						|
 | 
						|
/* MICR Interrupt bits */
 | 
						|
#define MII_DP83869_MICR_AN_ERR_INT_EN		BIT(15)
 | 
						|
#define MII_DP83869_MICR_SPEED_CHNG_INT_EN	BIT(14)
 | 
						|
#define MII_DP83869_MICR_DUP_MODE_CHNG_INT_EN	BIT(13)
 | 
						|
#define MII_DP83869_MICR_PAGE_RXD_INT_EN	BIT(12)
 | 
						|
#define MII_DP83869_MICR_AUTONEG_COMP_INT_EN	BIT(11)
 | 
						|
#define MII_DP83869_MICR_LINK_STS_CHNG_INT_EN	BIT(10)
 | 
						|
#define MII_DP83869_MICR_FALSE_CARRIER_INT_EN	BIT(8)
 | 
						|
#define MII_DP83869_MICR_SLEEP_MODE_CHNG_INT_EN	BIT(4)
 | 
						|
#define MII_DP83869_MICR_WOL_INT_EN		BIT(3)
 | 
						|
#define MII_DP83869_MICR_XGMII_ERR_INT_EN	BIT(2)
 | 
						|
#define MII_DP83869_MICR_POL_CHNG_INT_EN	BIT(1)
 | 
						|
#define MII_DP83869_MICR_JABBER_INT_EN		BIT(0)
 | 
						|
 | 
						|
#define MII_DP83869_BMCR_DEFAULT		(BMCR_ANENABLE | \
 | 
						|
						 BMCR_FULLDPLX | \
 | 
						|
						 BMCR_SPEED1000)
 | 
						|
 | 
						|
/* This is the same bit mask as the BMCR so re-use the BMCR default */
 | 
						|
#define DP83869_FX_CTRL_DEFAULT MII_DP83869_BMCR_DEFAULT
 | 
						|
 | 
						|
/* CFG1 bits */
 | 
						|
#define DP83869_CFG1_DEFAULT			(ADVERTISE_1000HALF | \
 | 
						|
						 ADVERTISE_1000FULL | \
 | 
						|
						 CTL1000_AS_MASTER)
 | 
						|
 | 
						|
/* RGMIICTL bits */
 | 
						|
#define DP83869_RGMII_TX_CLK_DELAY_EN		BIT(1)
 | 
						|
#define DP83869_RGMII_RX_CLK_DELAY_EN		BIT(0)
 | 
						|
 | 
						|
/* STRAP_STS1 bits */
 | 
						|
#define DP83869_STRAP_OP_MODE_MASK		GENMASK(2, 0)
 | 
						|
#define DP83869_STRAP_STS1_RESERVED		BIT(11)
 | 
						|
#define DP83869_STRAP_MIRROR_ENABLED		BIT(12)
 | 
						|
 | 
						|
/* PHY CTRL bits */
 | 
						|
#define DP83869_PHYCR_RX_FIFO_DEPTH_SHIFT		12
 | 
						|
#define DP83869_PHYCR_RX_FIFO_DEPTH_MASK		GENMASK(13, 12)
 | 
						|
#define DP83869_PHYCR_TX_FIFO_DEPTH_SHIFT		14
 | 
						|
#define DP83869_PHYCR_TX_FIFO_DEPTH_MASK		GENMASK(15, 14)
 | 
						|
#define DP83869_PHYCR_RESERVED_MASK			BIT(11)
 | 
						|
#define DP83869_PHYCR_MDI_CROSSOVER_SHIFT		5
 | 
						|
#define DP83869_PHYCR_MDI_CROSSOVER_MDIX		2
 | 
						|
#define DP83869_PHY_CTRL_DEFAULT			0x48
 | 
						|
 | 
						|
/* RGMIIDCTL bits */
 | 
						|
#define DP83869_RGMII_TX_CLK_DELAY_SHIFT	4
 | 
						|
#define DP83869_CLK_DELAY_DEF				7
 | 
						|
 | 
						|
/* CFG2 bits */
 | 
						|
#define MII_DP83869_CFG2_SPEEDOPT_10EN		0x0040
 | 
						|
#define MII_DP83869_CFG2_SGMII_AUTONEGEN	0x0080
 | 
						|
#define MII_DP83869_CFG2_SPEEDOPT_ENH		0x0100
 | 
						|
#define MII_DP83869_CFG2_SPEEDOPT_CNT		0x0800
 | 
						|
#define MII_DP83869_CFG2_SPEEDOPT_INTLOW	0x2000
 | 
						|
#define MII_DP83869_CFG2_MASK			0x003F
 | 
						|
 | 
						|
/* User setting - can be taken from DTS */
 | 
						|
#define DEFAULT_FIFO_DEPTH	DP83869_PHYCR_FIFO_DEPTH_4_B_NIB
 | 
						|
 | 
						|
/* IO_MUX_CFG bits */
 | 
						|
#define DP83869_IO_MUX_CFG_IO_IMPEDANCE_CTRL	0x1f
 | 
						|
 | 
						|
#define DP83869_IO_MUX_CFG_IO_IMPEDANCE_MAX	0x0
 | 
						|
#define DP83869_IO_MUX_CFG_IO_IMPEDANCE_MIN	0x1f
 | 
						|
#define DP83869_IO_MUX_CFG_CLK_O_DISABLE	BIT(6)
 | 
						|
#define DP83869_IO_MUX_CFG_CLK_O_SEL_SHIFT	8
 | 
						|
#define DP83869_IO_MUX_CFG_CLK_O_SEL_MASK	\
 | 
						|
		GENMASK(0x1f, DP83869_IO_MUX_CFG_CLK_O_SEL_SHIFT)
 | 
						|
 | 
						|
/* CFG3 bits */
 | 
						|
#define DP83869_CFG3_PORT_MIRROR_EN		BIT(0)
 | 
						|
 | 
						|
/* OP MODE bits */
 | 
						|
#define DP83869_OP_MODE_MII			BIT(5)
 | 
						|
#define DP83869_SGMII_RGMII_BRIDGE		BIT(6)
 | 
						|
 | 
						|
enum {
 | 
						|
	DP83869_PORT_MIRRORING_KEEP,
 | 
						|
	DP83869_PORT_MIRRORING_EN,
 | 
						|
	DP83869_PORT_MIRRORING_DIS,
 | 
						|
};
 | 
						|
 | 
						|
struct dp83869_private {
 | 
						|
	int tx_fifo_depth;
 | 
						|
	int rx_fifo_depth;
 | 
						|
	s32 rx_int_delay;
 | 
						|
	s32 tx_int_delay;
 | 
						|
	int io_impedance;
 | 
						|
	int port_mirroring;
 | 
						|
	bool set_clk_output;
 | 
						|
	int clk_output_sel;
 | 
						|
	int mode;
 | 
						|
};
 | 
						|
 | 
						|
static int dp83869_readext(struct phy_device *phydev, int addr, int devad, int reg)
 | 
						|
{
 | 
						|
	return phy_read_mmd(phydev, devad, reg);
 | 
						|
}
 | 
						|
 | 
						|
static int dp83869_writeext(struct phy_device *phydev, int addr, int devad, int reg, u16 val)
 | 
						|
{
 | 
						|
	return phy_write_mmd(phydev, devad, reg, val);
 | 
						|
}
 | 
						|
 | 
						|
static int dp83869_config_port_mirroring(struct phy_device *phydev)
 | 
						|
{
 | 
						|
	struct dp83869_private *dp83869 =
 | 
						|
		(struct dp83869_private *)phydev->priv;
 | 
						|
	u16 val;
 | 
						|
 | 
						|
	val = phy_read_mmd(phydev, DP83869_DEVADDR, DP83869_CFG4);
 | 
						|
 | 
						|
	if (dp83869->port_mirroring == DP83869_PORT_MIRRORING_EN)
 | 
						|
		val |= DP83869_CFG3_PORT_MIRROR_EN;
 | 
						|
	else
 | 
						|
		val &= ~DP83869_CFG3_PORT_MIRROR_EN;
 | 
						|
 | 
						|
	phy_write_mmd(phydev, DP83869_DEVADDR, DP83869_CFG4, val);
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
#ifdef CONFIG_DM_ETH
 | 
						|
static const int dp83869_internal_delay[] = {250, 500, 750, 1000, 1250, 1500,
 | 
						|
					     1750, 2000, 2250, 2500, 2750, 3000,
 | 
						|
					     3250, 3500, 3750, 4000};
 | 
						|
 | 
						|
static int dp83869_set_strapped_mode(struct phy_device *phydev)
 | 
						|
{
 | 
						|
	struct dp83869_private *dp83869 = phydev->priv;
 | 
						|
	int val;
 | 
						|
 | 
						|
	val = phy_read_mmd(phydev, DP83869_DEVADDR, DP83869_STRAP_STS1);
 | 
						|
	if (val < 0)
 | 
						|
		return val;
 | 
						|
 | 
						|
	dp83869->mode = val & DP83869_STRAP_OP_MODE_MASK;
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
/**
 | 
						|
 * dp83869_data_init - Convenience function for setting PHY specific data
 | 
						|
 *
 | 
						|
 * @phydev: the phy_device struct
 | 
						|
 */
 | 
						|
static int dp83869_of_init(struct phy_device *phydev)
 | 
						|
{
 | 
						|
	struct dp83869_private * const dp83869 = phydev->priv;
 | 
						|
	const int delay_entries = ARRAY_SIZE(dp83869_internal_delay);
 | 
						|
	int ret;
 | 
						|
	ofnode node;
 | 
						|
 | 
						|
	node = phy_get_ofnode(phydev);
 | 
						|
	if (!ofnode_valid(node))
 | 
						|
		return -EINVAL;
 | 
						|
 | 
						|
	dp83869->io_impedance = -EINVAL;
 | 
						|
 | 
						|
	/* Optional configuration, set to default if required */
 | 
						|
	dp83869->clk_output_sel = ofnode_read_u32_default(node, "ti,clk-output-sel",
 | 
						|
							  DP83869_CLK_O_SEL_CHN_A_RCLK);
 | 
						|
 | 
						|
	if (dp83869->clk_output_sel > DP83869_CLK_O_SEL_REF_CLK &&
 | 
						|
	    dp83869->clk_output_sel != DP83869_CLK_O_SEL_OFF)
 | 
						|
		dp83869->clk_output_sel = DP83869_CLK_O_SEL_REF_CLK;
 | 
						|
 | 
						|
	/* If operation mode is not set use setting from straps */
 | 
						|
	ret = ofnode_read_s32(node, "ti,op-mode", &dp83869->mode);
 | 
						|
	if (ret == 0) {
 | 
						|
		if (dp83869->mode < DP83869_RGMII_COPPER_ETHERNET ||
 | 
						|
		    dp83869->mode > DP83869_SGMII_COPPER_ETHERNET)
 | 
						|
			return -EINVAL;
 | 
						|
	} else {
 | 
						|
		ret = dp83869_set_strapped_mode(phydev);
 | 
						|
		if (ret)
 | 
						|
			return ret;
 | 
						|
	}
 | 
						|
 | 
						|
	if (ofnode_read_bool(node, "ti,max-output-impedance"))
 | 
						|
		dp83869->io_impedance = DP83869_IO_MUX_CFG_IO_IMPEDANCE_MAX;
 | 
						|
	else if (ofnode_read_bool(node, "ti,min-output-impedance"))
 | 
						|
		dp83869->io_impedance = DP83869_IO_MUX_CFG_IO_IMPEDANCE_MIN;
 | 
						|
 | 
						|
	if (ofnode_read_bool(node, "enet-phy-lane-swap")) {
 | 
						|
		dp83869->port_mirroring = DP83869_PORT_MIRRORING_EN;
 | 
						|
	} else {
 | 
						|
		ret = phy_read_mmd(phydev, DP83869_DEVADDR, DP83869_STRAP_STS1);
 | 
						|
 | 
						|
		if (ret < 0)
 | 
						|
			return ret;
 | 
						|
 | 
						|
		if (ret & DP83869_STRAP_MIRROR_ENABLED)
 | 
						|
			dp83869->port_mirroring = DP83869_PORT_MIRRORING_EN;
 | 
						|
		else
 | 
						|
			dp83869->port_mirroring = DP83869_PORT_MIRRORING_DIS;
 | 
						|
	}
 | 
						|
 | 
						|
	dp83869->rx_fifo_depth = ofnode_read_s32_default(node, "rx-fifo-depth",
 | 
						|
							 DP83869_PHYCR_FIFO_DEPTH_4_B_NIB);
 | 
						|
 | 
						|
	dp83869->tx_fifo_depth = ofnode_read_s32_default(node, "tx-fifo-depth",
 | 
						|
							 DP83869_PHYCR_FIFO_DEPTH_4_B_NIB);
 | 
						|
 | 
						|
	/* RX delay *must* be specified if internal delay of RX is used. */
 | 
						|
	if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID ||
 | 
						|
	    phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) {
 | 
						|
		dp83869->rx_int_delay = ofnode_read_u32_default(node, "rx-internal-delay-ps",
 | 
						|
								DP83869_CLK_DELAY_DEF);
 | 
						|
		if (dp83869->rx_int_delay > delay_entries) {
 | 
						|
			dp83869->rx_int_delay = DP83869_CLK_DELAY_DEF;
 | 
						|
			pr_debug("rx-internal-delay-ps not set/invalid, default to %ups\n",
 | 
						|
				 dp83869_internal_delay[dp83869->rx_int_delay]);
 | 
						|
		}
 | 
						|
 | 
						|
		dp83869->rx_int_delay = dp83869_internal_delay[dp83869->rx_int_delay];
 | 
						|
	}
 | 
						|
 | 
						|
	/* TX delay *must* be specified if internal delay of RX is used. */
 | 
						|
	if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID ||
 | 
						|
	    phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID) {
 | 
						|
		dp83869->tx_int_delay = ofnode_read_u32_default(node, "tx-internal-delay-ps",
 | 
						|
								DP83869_CLK_DELAY_DEF);
 | 
						|
		if (dp83869->tx_int_delay > delay_entries) {
 | 
						|
			dp83869->tx_int_delay = DP83869_CLK_DELAY_DEF;
 | 
						|
			pr_debug("tx-internal-delay-ps not set/invalid, default to %ups\n",
 | 
						|
				 dp83869_internal_delay[dp83869->tx_int_delay]);
 | 
						|
		}
 | 
						|
 | 
						|
		dp83869->tx_int_delay = dp83869_internal_delay[dp83869->tx_int_delay];
 | 
						|
	}
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
#else
 | 
						|
static int dp83869_of_init(struct phy_device *phydev)
 | 
						|
{
 | 
						|
	struct dp83869_private *dp83869 = phydev->priv;
 | 
						|
 | 
						|
	dp83869->rx_int_delay = DP83869_RGMIIDCTL_2_25_NS;
 | 
						|
	dp83869->tx_int_delay = DP83869_RGMIIDCTL_2_75_NS;
 | 
						|
	dp83869->fifo_depth = DEFAULT_FIFO_DEPTH;
 | 
						|
	dp83869->io_impedance = -EINVAL;
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
#endif /* CONFIG_OF_MDIO */
 | 
						|
 | 
						|
static int dp83869_configure_rgmii(struct phy_device *phydev,
 | 
						|
				   struct dp83869_private *dp83869)
 | 
						|
{
 | 
						|
	int ret = 0, val;
 | 
						|
 | 
						|
	if (phy_interface_is_rgmii(phydev)) {
 | 
						|
		val = phy_read(phydev, MDIO_DEVAD_NONE, MII_DP83869_PHYCTRL);
 | 
						|
		if (val < 0)
 | 
						|
			return val;
 | 
						|
 | 
						|
		val &= ~(DP83869_PHYCR_TX_FIFO_DEPTH_MASK | DP83869_PHYCR_RX_FIFO_DEPTH_MASK);
 | 
						|
		val |= (dp83869->tx_fifo_depth << DP83869_PHYCR_TX_FIFO_DEPTH_SHIFT);
 | 
						|
		val |= (dp83869->rx_fifo_depth << DP83869_PHYCR_RX_FIFO_DEPTH_SHIFT);
 | 
						|
 | 
						|
		ret = phy_write(phydev, MDIO_DEVAD_NONE, MII_DP83869_PHYCTRL, val);
 | 
						|
		if (ret)
 | 
						|
			return ret;
 | 
						|
	}
 | 
						|
 | 
						|
	if (dp83869->io_impedance >= 0) {
 | 
						|
		val = phy_read_mmd(phydev, DP83869_DEVADDR, DP83869_IO_MUX_CFG);
 | 
						|
 | 
						|
		val &= ~DP83869_IO_MUX_CFG_IO_IMPEDANCE_CTRL;
 | 
						|
		val |= dp83869->io_impedance & DP83869_IO_MUX_CFG_IO_IMPEDANCE_CTRL;
 | 
						|
 | 
						|
		ret = phy_write_mmd(phydev, DP83869_DEVADDR, DP83869_IO_MUX_CFG, val);
 | 
						|
 | 
						|
		if (ret)
 | 
						|
			return ret;
 | 
						|
	}
 | 
						|
 | 
						|
	return ret;
 | 
						|
}
 | 
						|
 | 
						|
static int dp83869_configure_mode(struct phy_device *phydev,
 | 
						|
				  struct dp83869_private *dp83869)
 | 
						|
{
 | 
						|
	int phy_ctrl_val;
 | 
						|
	int ret, val;
 | 
						|
 | 
						|
	if (dp83869->mode < DP83869_RGMII_COPPER_ETHERNET ||
 | 
						|
	    dp83869->mode > DP83869_SGMII_COPPER_ETHERNET)
 | 
						|
		return -EINVAL;
 | 
						|
 | 
						|
	/* Below init sequence for each operational mode is defined in
 | 
						|
	 * section 9.4.8 of the datasheet.
 | 
						|
	 */
 | 
						|
	ret = phy_write_mmd(phydev, DP83869_DEVADDR, DP83869_OP_MODE,
 | 
						|
			    dp83869->mode);
 | 
						|
	if (ret)
 | 
						|
		return ret;
 | 
						|
 | 
						|
	ret = phy_write(phydev, MDIO_DEVAD_NONE, MII_BMCR, MII_DP83869_BMCR_DEFAULT);
 | 
						|
	if (ret)
 | 
						|
		return ret;
 | 
						|
 | 
						|
	phy_ctrl_val = (dp83869->rx_fifo_depth << DP83869_PHYCR_RX_FIFO_DEPTH_SHIFT |
 | 
						|
			dp83869->tx_fifo_depth << DP83869_PHYCR_TX_FIFO_DEPTH_SHIFT |
 | 
						|
			DP83869_PHY_CTRL_DEFAULT);
 | 
						|
 | 
						|
	switch (dp83869->mode) {
 | 
						|
	case DP83869_RGMII_COPPER_ETHERNET:
 | 
						|
		ret = phy_write(phydev, MDIO_DEVAD_NONE, MII_DP83869_PHYCTRL,
 | 
						|
				phy_ctrl_val);
 | 
						|
		if (ret)
 | 
						|
			return ret;
 | 
						|
 | 
						|
		ret = phy_write(phydev, MDIO_DEVAD_NONE, MII_CTRL1000, DP83869_CFG1_DEFAULT);
 | 
						|
		if (ret)
 | 
						|
			return ret;
 | 
						|
 | 
						|
		ret = dp83869_configure_rgmii(phydev, dp83869);
 | 
						|
		if (ret)
 | 
						|
			return ret;
 | 
						|
		break;
 | 
						|
	case DP83869_RGMII_SGMII_BRIDGE:
 | 
						|
		val = phy_read_mmd(phydev, DP83869_DEVADDR, DP83869_OP_MODE);
 | 
						|
 | 
						|
		val |= DP83869_SGMII_RGMII_BRIDGE;
 | 
						|
 | 
						|
		ret = phy_write_mmd(phydev, DP83869_DEVADDR, DP83869_OP_MODE, val);
 | 
						|
 | 
						|
		if (ret)
 | 
						|
			return ret;
 | 
						|
 | 
						|
		ret = phy_write_mmd(phydev, DP83869_DEVADDR,
 | 
						|
				    DP83869_FX_CTRL, DP83869_FX_CTRL_DEFAULT);
 | 
						|
		if (ret)
 | 
						|
			return ret;
 | 
						|
 | 
						|
		break;
 | 
						|
	case DP83869_1000M_MEDIA_CONVERT:
 | 
						|
		ret = phy_write(phydev, MDIO_DEVAD_NONE, MII_DP83869_PHYCTRL,
 | 
						|
				phy_ctrl_val);
 | 
						|
		if (ret)
 | 
						|
			return ret;
 | 
						|
 | 
						|
		ret = phy_write_mmd(phydev, DP83869_DEVADDR,
 | 
						|
				    DP83869_FX_CTRL, DP83869_FX_CTRL_DEFAULT);
 | 
						|
		if (ret)
 | 
						|
			return ret;
 | 
						|
		break;
 | 
						|
	case DP83869_100M_MEDIA_CONVERT:
 | 
						|
		ret = phy_write(phydev, MDIO_DEVAD_NONE, MII_DP83869_PHYCTRL,
 | 
						|
				phy_ctrl_val);
 | 
						|
		if (ret)
 | 
						|
			return ret;
 | 
						|
		break;
 | 
						|
	case DP83869_SGMII_COPPER_ETHERNET:
 | 
						|
		ret = phy_write(phydev, MDIO_DEVAD_NONE, MII_DP83869_PHYCTRL,
 | 
						|
				phy_ctrl_val);
 | 
						|
		if (ret)
 | 
						|
			return ret;
 | 
						|
 | 
						|
		ret = phy_write(phydev, MDIO_DEVAD_NONE, MII_CTRL1000, DP83869_CFG1_DEFAULT);
 | 
						|
		if (ret)
 | 
						|
			return ret;
 | 
						|
 | 
						|
		ret = phy_write_mmd(phydev, DP83869_DEVADDR,
 | 
						|
				    DP83869_FX_CTRL, DP83869_FX_CTRL_DEFAULT);
 | 
						|
		if (ret)
 | 
						|
			return ret;
 | 
						|
 | 
						|
		break;
 | 
						|
	default:
 | 
						|
		return -EINVAL;
 | 
						|
	}
 | 
						|
 | 
						|
	return ret;
 | 
						|
}
 | 
						|
 | 
						|
static int dp83869_config(struct phy_device *phydev)
 | 
						|
{
 | 
						|
	struct dp83869_private *dp83869;
 | 
						|
	unsigned int val;
 | 
						|
	int ret;
 | 
						|
 | 
						|
	dp83869 = (struct dp83869_private *)phydev->priv;
 | 
						|
 | 
						|
	ret = dp83869_of_init(phydev);
 | 
						|
	if (ret)
 | 
						|
		return ret;
 | 
						|
 | 
						|
	ret = dp83869_configure_mode(phydev, dp83869);
 | 
						|
	if (ret)
 | 
						|
		return ret;
 | 
						|
 | 
						|
	if (dp83869->port_mirroring != DP83869_PORT_MIRRORING_KEEP)
 | 
						|
		dp83869_config_port_mirroring(phydev);
 | 
						|
 | 
						|
	/* Clock output selection if muxing property is set */
 | 
						|
	if (dp83869->clk_output_sel != DP83869_CLK_O_SEL_REF_CLK) {
 | 
						|
		val = phy_read_mmd(phydev, DP83869_DEVADDR, DP83869_IO_MUX_CFG);
 | 
						|
 | 
						|
		val &= ~DP83869_IO_MUX_CFG_CLK_O_SEL_MASK;
 | 
						|
		val |= dp83869->clk_output_sel << DP83869_IO_MUX_CFG_CLK_O_SEL_SHIFT;
 | 
						|
 | 
						|
		ret = phy_write_mmd(phydev, DP83869_DEVADDR, DP83869_IO_MUX_CFG, val);
 | 
						|
 | 
						|
		if (ret)
 | 
						|
			return ret;
 | 
						|
	}
 | 
						|
 | 
						|
	if (phy_interface_is_rgmii(phydev)) {
 | 
						|
		ret = phy_write_mmd(phydev, DP83869_DEVADDR, DP83869_RGMIIDCTL,
 | 
						|
				    dp83869->rx_int_delay |
 | 
						|
			dp83869->tx_int_delay << DP83869_RGMII_TX_CLK_DELAY_SHIFT);
 | 
						|
		if (ret)
 | 
						|
			return ret;
 | 
						|
 | 
						|
		val = phy_read_mmd(phydev, DP83869_DEVADDR, DP83869_RGMIICTL);
 | 
						|
		val |= (DP83869_RGMII_TX_CLK_DELAY_EN |
 | 
						|
			DP83869_RGMII_RX_CLK_DELAY_EN);
 | 
						|
 | 
						|
		if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID)
 | 
						|
			val &= ~(DP83869_RGMII_TX_CLK_DELAY_EN |
 | 
						|
				 DP83869_RGMII_RX_CLK_DELAY_EN);
 | 
						|
 | 
						|
		if (phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID)
 | 
						|
			val &= ~DP83869_RGMII_TX_CLK_DELAY_EN;
 | 
						|
 | 
						|
		if (phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID)
 | 
						|
			val &= ~DP83869_RGMII_RX_CLK_DELAY_EN;
 | 
						|
 | 
						|
		ret = phy_write_mmd(phydev, DP83869_DEVADDR, DP83869_RGMIICTL,
 | 
						|
				    val);
 | 
						|
	}
 | 
						|
 | 
						|
	genphy_config_aneg(phydev);
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static int dp83869_probe(struct phy_device *phydev)
 | 
						|
{
 | 
						|
	struct dp83869_private *dp83869;
 | 
						|
 | 
						|
	dp83869 = kzalloc(sizeof(*dp83869), GFP_KERNEL);
 | 
						|
	if (!dp83869)
 | 
						|
		return -ENOMEM;
 | 
						|
 | 
						|
	phydev->priv = dp83869;
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static struct phy_driver DP83869_driver = {
 | 
						|
	.name = "TI DP83869",
 | 
						|
	.uid = 0x2000a0f1,
 | 
						|
	.mask = 0xfffffff0,
 | 
						|
	.features = PHY_GBIT_FEATURES,
 | 
						|
	.probe = dp83869_probe,
 | 
						|
	.config = &dp83869_config,
 | 
						|
	.startup = &genphy_startup,
 | 
						|
	.shutdown = &genphy_shutdown,
 | 
						|
	.readext = dp83869_readext,
 | 
						|
	.writeext = dp83869_writeext
 | 
						|
};
 | 
						|
 | 
						|
int phy_dp83869_init(void)
 | 
						|
{
 | 
						|
	phy_register(&DP83869_driver);
 | 
						|
	return 0;
 | 
						|
}
 |