MV88X3120_phy_Linux.c

#include "tn40.h"

int MV88X3120_set_speed(struct bdx_priv *priv, s32 speed);

#define MV88X3120_EEE_10G			(0x0008)	/*Support EEE for 10GBASE-T */
#define MV88X3120_EEE_1G			(0x0004)	/*Support EEE for 1GBASE-T */
#define MV88X3120_EEE_100M			(0x0002)	/*Support EEE for 100MBASE-T */

#define MV88X3120_ALL_SPEEDS	(__ETHTOOL_LINK_MODE_MASK_NBITS)

static void MV88X3120_set_link_mode(unsigned long *bits, u32 speed)
{
	bitmap_zero(bits, __ETHTOOL_LINK_MODE_MASK_NBITS);
	__set_bit(ETHTOOL_LINK_MODE_Pause_BIT, bits);
	__set_bit(ETHTOOL_LINK_MODE_TP_BIT, bits);;
	if (speed == MV88X3120_ALL_SPEEDS) {
		__set_bit(ETHTOOL_LINK_MODE_10000baseT_Full_BIT, bits);
		__set_bit(ETHTOOL_LINK_MODE_1000baseT_Full_BIT, bits);
		__set_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT, bits);
		__set_bit(ETHTOOL_LINK_MODE_Autoneg_BIT, bits);
	} else {
		__set_bit(speed, bits);
	}
}

int MV88X3120_get_link_ksettings(struct net_device *netdev,
				 struct ethtool_link_ksettings *cmd)
{
	struct bdx_priv *priv = netdev_priv(netdev);

	cmd->base.speed = priv->link_speed;
	cmd->base.port = PORT_TP;
	cmd->base.autoneg = AUTONEG_ENABLE;
	cmd->base.duplex = DUPLEX_FULL;

#if defined(ETH_TP_MDI_AUTO)
	cmd->base.eth_tp_mdix = ETH_TP_MDI_AUTO;
	cmd->base.eth_tp_mdix_ctrl = ETH_TP_MDI_AUTO;
#else
	cmd->base.eth_tp_mdix = ETH_TP_MDI | ETH_TP_MDI_X;
	cmd->base.eth_tp_mdix_ctrl = ETH_TP_MDI | ETH_TP_MDI_X;
#endif
	MV88X3120_set_link_mode(cmd->link_modes.supported,
				MV88X3120_ALL_SPEEDS);
	if (priv->autoneg == AUTONEG_ENABLE) {
		memcpy(priv->link_advertising, cmd->link_modes.supported,
		       sizeof(priv->link_advertising));
	}
	memcpy(cmd->link_modes.advertising, priv->link_advertising,
	       sizeof(cmd->link_modes.advertising));

	return 0;
}

int MV88X3120_set_link_ksettings(struct net_device *netdev,
				 const struct ethtool_link_ksettings *cmd)
{
	struct bdx_priv *priv = netdev_priv(netdev);
	int rVal = 0;

	priv->autoneg = cmd->base.autoneg;
	if (priv->autoneg == AUTONEG_ENABLE) {
		MV88X3120_set_link_mode(priv->link_advertising,
					MV88X3120_ALL_SPEEDS);
	} else {
		switch (cmd->base.speed) {
		case 10000:	/*10G */
			MV88X3120_set_link_mode(priv->link_advertising,
						ETHTOOL_LINK_MODE_10000baseT_Full_BIT);
			break;

		case 1000:	/*1G */
			MV88X3120_set_link_mode(priv->link_advertising,
						ETHTOOL_LINK_MODE_1000baseT_Full_BIT);
			break;

		case 100:	/*100m */
			MV88X3120_set_link_mode(priv->link_advertising,
						ETHTOOL_LINK_MODE_100baseT_Full_BIT);
			break;

		default:
			pr_err("does not support speed %u\n", cmd->base.speed);
			rVal = -EINVAL;
			break;
		}
	}
	if (rVal == 0) {
		rVal = MV88X3120_set_speed(priv, cmd->base.speed);
	}

	return 0;
}

/* EEE - IEEEaz */
#ifdef _EEE_
#ifdef ETHTOOL_GEEE

int MV88X3120_get_eee(struct net_device *netdev, struct ethtool_eee *edata)
{
	struct bdx_priv *priv = netdev_priv(netdev);
	u32 val;

	/* EEE Capability */
	edata->supported = (SUPPORTED_10000baseT_Full);	/*  | SUPPORTED_1000baseT_Full  | SUPPORTED_100baseT_Full); */
	/* EEE Advertised */
	val = bdx_mdio_read(priv, 7, priv->phy_mdio_port, 60);
	edata->advertised = 0;
	if (val & MV88X3120_EEE_10G)
		edata->advertised |= SUPPORTED_10000baseT_Full;
	/*if(val & MV88X3120_EEE_1G)    edata->advertised |= SUPPORTED_1000baseT_Full;
	   if(val & MV88X3120_EEE_100M)         edata->advertised |= SUPPORTED_100baseT_Full; */

	/* EEE Link Partner Advertised */
	val = bdx_mdio_read(priv, 7, priv->phy_mdio_port, 61);
	edata->lp_advertised = 0;
	if (val & MV88X3120_EEE_10G)
		edata->lp_advertised |= SUPPORTED_10000baseT_Full;

	/* EEE Status */

	val = bdx_mdio_read(priv, 1, priv->phy_mdio_port, 49192);
	if (val & 0x40)
		edata->eee_active = true;	/*still need to check that link is up. */

	edata->eee_enabled = true;

	return 0;
}
#endif

#ifdef ETHTOOL_SEEE
int MV88X3120_set_eee(struct bdx_priv *priv)
{
	u16 val, port = priv->phy_mdio_port;

	/*EEE LPI Buffer Enable */
	BDX_MDIO_WRITE(priv, 1, 49230, 0x0900);
	BDX_MDIO_WRITE(priv, 1, 49221, 0x1);
	BDX_MDIO_WRITE(priv, 7, 60, 0x8);
	/*val  = bdx_mdio_read(priv, 3, priv->phy_mdio_port, 20);
	   val  = bdx_mdio_read(priv, 4, priv->phy_mdio_port, 20);
	   val  = bdx_mdio_read(priv, 7, priv->phy_mdio_port, 61); */
	/* restart autoneg */
	val = (1 << 12) | (1 << 9) | (1 << 13);
	BDX_MDIO_WRITE(priv, 0x07, 0x0, val);
	val = bdx_mdio_read(priv, 7, priv->phy_mdio_port, 1);
	val = bdx_mdio_read(priv, 7, priv->phy_mdio_port, 1);
	val = bdx_mdio_read(priv, 7, priv->phy_mdio_port, 60);
	pr_err("DBG_EEE 7.60=0x%x \n", val);
	val = bdx_mdio_read(priv, 7, priv->phy_mdio_port, 61);
	pr_err("DBG_EEE 7.61=0x%x \n", val);
	val = bdx_mdio_read(priv, 1, priv->phy_mdio_port, 49230);
	pr_err("DBG_EEE 1.49230=0x%x\n", val);
	priv->eee_enabled = true;

	return 0;
}

#endif

void MV88X3120_enable_eee(struct bdx_priv *priv)
{
	pr_debug("EEE enabled=%d\n", priv->eee_enabled);
	if (priv->eee_enabled) {
		pr_debug("EEE MTU=%d\n", priv->ndev->mtu);
		bdx_mdio_write(priv, 9, priv->phy_mdio_port, 0x809C, 0xFF1);
		bdx_mdio_write(priv, 9, priv->phy_mdio_port, 0x809D, 0x0);
		bdx_mdio_write(priv, 9, priv->phy_mdio_port, 0x809E, 0x4B);
		bdx_mdio_write(priv, 9, priv->phy_mdio_port, 0x809F, 0x0);
		bdx_mdio_write(priv, 9, priv->phy_mdio_port, 0x8C02,
			       (priv->ndev->mtu * 2));
		bdx_mdio_write(priv, 9, priv->phy_mdio_port, 0x8C03, 0x0);
		bdx_mdio_write(priv, 9, priv->phy_mdio_port, 0x8E02,
			       (priv->ndev->mtu * 2));
		bdx_mdio_write(priv, 9, priv->phy_mdio_port, 0x8E03, 0x0);
		bdx_mdio_write(priv, 9, priv->phy_mdio_port, 0x8000, 0x3);
		bdx_mdio_write(priv, 9, priv->phy_mdio_port, 0x8001, 0x7E50);
	} else {
#if defined(_EEE_) && defined(ETHTOOL_SEEE)
		MV88X3120_set_eee(priv /*, edata */ );
#endif
	}
}

int MV88X3120_reset_eee(struct bdx_priv *priv)
{

	bdx_mdio_write(priv, 1, priv->phy_mdio_port, 49230, 0);
	bdx_mdio_write(priv, 1, priv->phy_mdio_port, 49221, 0);
	bdx_mdio_write(priv, 7, priv->phy_mdio_port, 60, 0);
	priv->eee_enabled = false;

	return 0;
}

#endif

__init void MV88X3120_register_settings(struct bdx_priv *priv)
{
	priv->phy_ops.get_link_ksettings = MV88X3120_get_link_ksettings;
	priv->phy_ops.set_link_ksettings = MV88X3120_set_link_ksettings;
	priv->autoneg = AUTONEG_ENABLE;
#ifdef _EEE_
#ifdef ETHTOOL_GEEE
	priv->phy_ops.get_eee = MV88X3120_get_eee;
#endif
#ifdef ETHTOOL_SEEE
	priv->phy_ops.set_eee = MV88X3120_set_eee;
#endif
	priv->phy_ops.reset_eee = MV88X3120_reset_eee;
#endif
}