[net-next-2.6.git] / drivers / net / mii.c

/*

	mii.c: MII interface library

	Maintained by Jeff Garzik <jgarzik@pobox.com>
	Copyright 2001,2002 Jeff Garzik

	Various code came from myson803.c and other files by
	Donald Becker.  Copyright:

		Written 1998-2002 by Donald Becker.

		This software may be used and distributed according
		to the terms of the GNU General Public License (GPL),
		incorporated herein by reference.  Drivers based on
		or derived from this code fall under the GPL and must
		retain the authorship, copyright and license notice.
		This file is not a complete program and may only be
		used when the entire operating system is licensed
		under the GPL.

		The author may be reached as becker@scyld.com, or C/O
		Scyld Computing Corporation
		410 Severn Ave., Suite 210
		Annapolis MD 21403


 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/netdevice.h>
#include <linux/ethtool.h>
#include <linux/mdio.h>

static u32 mii_get_an(struct mii_if_info *mii, u16 addr)
{
	u32 result = 0;
	int advert;

	advert = mii->mdio_read(mii->dev, mii->phy_id, addr);
	if (advert & LPA_LPACK)
		result |= ADVERTISED_Autoneg;
	if (advert & ADVERTISE_10HALF)
		result |= ADVERTISED_10baseT_Half;
	if (advert & ADVERTISE_10FULL)
		result |= ADVERTISED_10baseT_Full;
	if (advert & ADVERTISE_100HALF)
		result |= ADVERTISED_100baseT_Half;
	if (advert & ADVERTISE_100FULL)
		result |= ADVERTISED_100baseT_Full;

	return result;
}

/**
 * mii_ethtool_gset - get settings that are specified in @ecmd
 * @mii: MII interface
 * @ecmd: requested ethtool_cmd
 *
 * Returns 0 for success, negative on error.
 */
int mii_ethtool_gset(struct mii_if_info *mii, struct ethtool_cmd *ecmd)
{
	struct net_device *dev = mii->dev;
	u16 bmcr, bmsr, ctrl1000 = 0, stat1000 = 0;
	u32 nego;

	ecmd->supported =
	    (SUPPORTED_10baseT_Half | SUPPORTED_10baseT_Full |
	     SUPPORTED_100baseT_Half | SUPPORTED_100baseT_Full |
	     SUPPORTED_Autoneg | SUPPORTED_TP | SUPPORTED_MII);
	if (mii->supports_gmii)
		ecmd->supported |= SUPPORTED_1000baseT_Half |
			SUPPORTED_1000baseT_Full;

	/* only supports twisted-pair */
	ecmd->port = PORT_MII;

	/* only supports internal transceiver */
	ecmd->transceiver = XCVR_INTERNAL;

	/* this isn't fully supported at higher layers */
	ecmd->phy_address = mii->phy_id;
	ecmd->mdio_support = MDIO_SUPPORTS_C22;

	ecmd->advertising = ADVERTISED_TP | ADVERTISED_MII;

	bmcr = mii->mdio_read(dev, mii->phy_id, MII_BMCR);
	bmsr = mii->mdio_read(dev, mii->phy_id, MII_BMSR);
	if (mii->supports_gmii) {
 		ctrl1000 = mii->mdio_read(dev, mii->phy_id, MII_CTRL1000);
		stat1000 = mii->mdio_read(dev, mii->phy_id, MII_STAT1000);
	}
	if (bmcr & BMCR_ANENABLE) {
		ecmd->advertising |= ADVERTISED_Autoneg;
		ecmd->autoneg = AUTONEG_ENABLE;

		ecmd->advertising |= mii_get_an(mii, MII_ADVERTISE);
		if (ctrl1000 & ADVERTISE_1000HALF)
			ecmd->advertising |= ADVERTISED_1000baseT_Half;
		if (ctrl1000 & ADVERTISE_1000FULL)
			ecmd->advertising |= ADVERTISED_1000baseT_Full;

		if (bmsr & BMSR_ANEGCOMPLETE) {
			ecmd->lp_advertising = mii_get_an(mii, MII_LPA);
			if (stat1000 & LPA_1000HALF)
				ecmd->lp_advertising |=
					ADVERTISED_1000baseT_Half;
			if (stat1000 & LPA_1000FULL)
				ecmd->lp_advertising |=
					ADVERTISED_1000baseT_Full;
		} else {
			ecmd->lp_advertising = 0;
		}

		nego = ecmd->advertising & ecmd->lp_advertising;

		if (nego & (ADVERTISED_1000baseT_Full |
			    ADVERTISED_1000baseT_Half)) {
			ecmd->speed = SPEED_1000;
			ecmd->duplex = !!(nego & ADVERTISED_1000baseT_Full);
		} else if (nego & (ADVERTISED_100baseT_Full |
				   ADVERTISED_100baseT_Half)) {
			ecmd->speed = SPEED_100;
			ecmd->duplex = !!(nego & ADVERTISED_100baseT_Full);
		} else {
			ecmd->speed = SPEED_10;
			ecmd->duplex = !!(nego & ADVERTISED_10baseT_Full);
		}
	} else {
		ecmd->autoneg = AUTONEG_DISABLE;

		ecmd->speed = ((bmcr & BMCR_SPEED1000 &&
				(bmcr & BMCR_SPEED100) == 0) ? SPEED_1000 :
			       (bmcr & BMCR_SPEED100) ? SPEED_100 : SPEED_10);
		ecmd->duplex = (bmcr & BMCR_FULLDPLX) ? DUPLEX_FULL : DUPLEX_HALF;
	}

	mii->full_duplex = ecmd->duplex;

	/* ignore maxtxpkt, maxrxpkt for now */

	return 0;
}

/**
 * mii_ethtool_sset - set settings that are specified in @ecmd
 * @mii: MII interface
 * @ecmd: requested ethtool_cmd
 *
 * Returns 0 for success, negative on error.
 */
int mii_ethtool_sset(struct mii_if_info *mii, struct ethtool_cmd *ecmd)
{
	struct net_device *dev = mii->dev;

	if (ecmd->speed != SPEED_10 &&
	    ecmd->speed != SPEED_100 &&
	    ecmd->speed != SPEED_1000)
		return -EINVAL;
	if (ecmd->duplex != DUPLEX_HALF && ecmd->duplex != DUPLEX_FULL)
		return -EINVAL;
	if (ecmd->port != PORT_MII)
		return -EINVAL;
	if (ecmd->transceiver != XCVR_INTERNAL)
		return -EINVAL;
	if (ecmd->phy_address != mii->phy_id)
		return -EINVAL;
	if (ecmd->autoneg != AUTONEG_DISABLE && ecmd->autoneg != AUTONEG_ENABLE)
		return -EINVAL;
	if ((ecmd->speed == SPEED_1000) && (!mii->supports_gmii))
		return -EINVAL;

	/* ignore supported, maxtxpkt, maxrxpkt */

	if (ecmd->autoneg == AUTONEG_ENABLE) {
		u32 bmcr, advert, tmp;
		u32 advert2 = 0, tmp2 = 0;

		if ((ecmd->advertising & (ADVERTISED_10baseT_Half |
					  ADVERTISED_10baseT_Full |
					  ADVERTISED_100baseT_Half |
					  ADVERTISED_100baseT_Full |
					  ADVERTISED_1000baseT_Half |
					  ADVERTISED_1000baseT_Full)) == 0)
			return -EINVAL;

		/* advertise only what has been requested */
		advert = mii->mdio_read(dev, mii->phy_id, MII_ADVERTISE);
		tmp = advert & ~(ADVERTISE_ALL | ADVERTISE_100BASE4);
		if (mii->supports_gmii) {
			advert2 = mii->mdio_read(dev, mii->phy_id, MII_CTRL1000);
			tmp2 = advert2 & ~(ADVERTISE_1000HALF | ADVERTISE_1000FULL);
		}
		if (ecmd->advertising & ADVERTISED_10baseT_Half)
			tmp |= ADVERTISE_10HALF;
		if (ecmd->advertising & ADVERTISED_10baseT_Full)
			tmp |= ADVERTISE_10FULL;
		if (ecmd->advertising & ADVERTISED_100baseT_Half)
			tmp |= ADVERTISE_100HALF;
		if (ecmd->advertising & ADVERTISED_100baseT_Full)
			tmp |= ADVERTISE_100FULL;
		if (mii->supports_gmii) {
			if (ecmd->advertising & ADVERTISED_1000baseT_Half)
				tmp2 |= ADVERTISE_1000HALF;
			if (ecmd->advertising & ADVERTISED_1000baseT_Full)
				tmp2 |= ADVERTISE_1000FULL;
		}
		if (advert != tmp) {
			mii->mdio_write(dev, mii->phy_id, MII_ADVERTISE, tmp);
			mii->advertising = tmp;
		}
		if ((mii->supports_gmii) && (advert2 != tmp2))
			mii->mdio_write(dev, mii->phy_id, MII_CTRL1000, tmp2);

		/* turn on autonegotiation, and force a renegotiate */
		bmcr = mii->mdio_read(dev, mii->phy_id, MII_BMCR);
		bmcr |= (BMCR_ANENABLE | BMCR_ANRESTART);
		mii->mdio_write(dev, mii->phy_id, MII_BMCR, bmcr);

		mii->force_media = 0;
	} else {
		u32 bmcr, tmp;

		/* turn off auto negotiation, set speed and duplexity */
		bmcr = mii->mdio_read(dev, mii->phy_id, MII_BMCR);
		tmp = bmcr & ~(BMCR_ANENABLE | BMCR_SPEED100 |
			       BMCR_SPEED1000 | BMCR_FULLDPLX);
		if (ecmd->speed == SPEED_1000)
			tmp |= BMCR_SPEED1000;
		else if (ecmd->speed == SPEED_100)
			tmp |= BMCR_SPEED100;
		if (ecmd->duplex == DUPLEX_FULL) {
			tmp |= BMCR_FULLDPLX;
			mii->full_duplex = 1;
		} else
			mii->full_duplex = 0;
		if (bmcr != tmp)
			mii->mdio_write(dev, mii->phy_id, MII_BMCR, tmp);

		mii->force_media = 1;
	}
	return 0;
}

/**
 * mii_check_gmii_support - check if the MII supports Gb interfaces
 * @mii: the MII interface
 */
int mii_check_gmii_support(struct mii_if_info *mii)
{
	int reg;

	reg = mii->mdio_read(mii->dev, mii->phy_id, MII_BMSR);
	if (reg & BMSR_ESTATEN) {
		reg = mii->mdio_read(mii->dev, mii->phy_id, MII_ESTATUS);
		if (reg & (ESTATUS_1000_TFULL | ESTATUS_1000_THALF))
			return 1;
	}

	return 0;
}

/**
 * mii_link_ok - is link status up/ok
 * @mii: the MII interface
 *
 * Returns 1 if the MII reports link status up/ok, 0 otherwise.
 */
int mii_link_ok (struct mii_if_info *mii)
{
	/* first, a dummy read, needed to latch some MII phys */
	mii->mdio_read(mii->dev, mii->phy_id, MII_BMSR);
	if (mii->mdio_read(mii->dev, mii->phy_id, MII_BMSR) & BMSR_LSTATUS)
		return 1;
	return 0;
}

/**
 * mii_nway_restart - restart NWay (autonegotiation) for this interface
 * @mii: the MII interface
 *
 * Returns 0 on success, negative on error.
 */
int mii_nway_restart (struct mii_if_info *mii)
{
	int bmcr;
	int r = -EINVAL;

	/* if autoneg is off, it's an error */
	bmcr = mii->mdio_read(mii->dev, mii->phy_id, MII_BMCR);

	if (bmcr & BMCR_ANENABLE) {
		bmcr |= BMCR_ANRESTART;
		mii->mdio_write(mii->dev, mii->phy_id, MII_BMCR, bmcr);
		r = 0;
	}

	return r;
}

/**
 * mii_check_link - check MII link status
 * @mii: MII interface
 *
 * If the link status changed (previous != current), call
 * netif_carrier_on() if current link status is Up or call
 * netif_carrier_off() if current link status is Down.
 */
void mii_check_link (struct mii_if_info *mii)
{
	int cur_link = mii_link_ok(mii);
	int prev_link = netif_carrier_ok(mii->dev);

	if (cur_link && !prev_link)
		netif_carrier_on(mii->dev);
	else if (prev_link && !cur_link)
		netif_carrier_off(mii->dev);
}

/**
 * mii_check_media - check the MII interface for a duplex change
 * @mii: the MII interface
 * @ok_to_print: OK to print link up/down messages
 * @init_media: OK to save duplex mode in @mii
 *
 * Returns 1 if the duplex mode changed, 0 if not.
 * If the media type is forced, always returns 0.
 */
unsigned int mii_check_media (struct mii_if_info *mii,
			      unsigned int ok_to_print,
			      unsigned int init_media)
{
	unsigned int old_carrier, new_carrier;
	int advertise, lpa, media, duplex;
	int lpa2 = 0;

	/* if forced media, go no further */
	if (mii->force_media)
		return 0; /* duplex did not change */

	/* check current and old link status */
	old_carrier = netif_carrier_ok(mii->dev) ? 1 : 0;
	new_carrier = (unsigned int) mii_link_ok(mii);

	/* if carrier state did not change, this is a "bounce",
	 * just exit as everything is already set correctly
	 */
	if ((!init_media) && (old_carrier == new_carrier))
		return 0; /* duplex did not change */

	/* no carrier, nothing much to do */
	if (!new_carrier) {
		netif_carrier_off(mii->dev);
		if (ok_to_print)
			printk(KERN_INFO "%s: link down\n", mii->dev->name);
		return 0; /* duplex did not change */
	}

	/*
	 * we have carrier, see who's on the other end
	 */
	netif_carrier_on(mii->dev);

	/* get MII advertise and LPA values */
	if ((!init_media) && (mii->advertising))
		advertise = mii->advertising;
	else {
		advertise = mii->mdio_read(mii->dev, mii->phy_id, MII_ADVERTISE);
		mii->advertising = advertise;
	}
	lpa = mii->mdio_read(mii->dev, mii->phy_id, MII_LPA);
	if (mii->supports_gmii)
		lpa2 = mii->mdio_read(mii->dev, mii->phy_id, MII_STAT1000);

	/* figure out media and duplex from advertise and LPA values */
	media = mii_nway_result(lpa & advertise);
	duplex = (media & ADVERTISE_FULL) ? 1 : 0;
	if (lpa2 & LPA_1000FULL)
		duplex = 1;

	if (ok_to_print)
		printk(KERN_INFO "%s: link up, %sMbps, %s-duplex, lpa 0x%04X\n",
		       mii->dev->name,
		       lpa2 & (LPA_1000FULL | LPA_1000HALF) ? "1000" :
		       media & (ADVERTISE_100FULL | ADVERTISE_100HALF) ? "100" : "10",
		       duplex ? "full" : "half",
		       lpa);

	if ((init_media) || (mii->full_duplex != duplex)) {
		mii->full_duplex = duplex;
		return 1; /* duplex changed */
	}

	return 0; /* duplex did not change */
}

/**
 * generic_mii_ioctl - main MII ioctl interface
 * @mii_if: the MII interface
 * @mii_data: MII ioctl data structure
 * @cmd: MII ioctl command
 * @duplex_chg_out: pointer to @duplex_changed status if there was no
 *	ioctl error
 *
 * Returns 0 on success, negative on error.
 */
int generic_mii_ioctl(struct mii_if_info *mii_if,
		      struct mii_ioctl_data *mii_data, int cmd,
		      unsigned int *duplex_chg_out)
{
	int rc = 0;
	unsigned int duplex_changed = 0;

	if (duplex_chg_out)
		*duplex_chg_out = 0;

	mii_data->phy_id &= mii_if->phy_id_mask;
	mii_data->reg_num &= mii_if->reg_num_mask;

	switch(cmd) {
	case SIOCGMIIPHY:
		mii_data->phy_id = mii_if->phy_id;
		/* fall through */

	case SIOCGMIIREG:
		mii_data->val_out =
			mii_if->mdio_read(mii_if->dev, mii_data->phy_id,
					  mii_data->reg_num);
		break;

	case SIOCSMIIREG: {
		u16 val = mii_data->val_in;

		if (mii_data->phy_id == mii_if->phy_id) {
			switch(mii_data->reg_num) {
			case MII_BMCR: {
				unsigned int new_duplex = 0;
				if (val & (BMCR_RESET|BMCR_ANENABLE))
					mii_if->force_media = 0;
				else
					mii_if->force_media = 1;
				if (mii_if->force_media &&
				    (val & BMCR_FULLDPLX))
					new_duplex = 1;
				if (mii_if->full_duplex != new_duplex) {
					duplex_changed = 1;
					mii_if->full_duplex = new_duplex;
				}
				break;
			}
			case MII_ADVERTISE:
				mii_if->advertising = val;
				break;
			default:
				/* do nothing */
				break;
			}
		}

		mii_if->mdio_write(mii_if->dev, mii_data->phy_id,
				   mii_data->reg_num, val);
		break;
	}

	default:
		rc = -EOPNOTSUPP;
		break;
	}

	if ((rc == 0) && (duplex_chg_out) && (duplex_changed))
		*duplex_chg_out = 1;

	return rc;
}

MODULE_AUTHOR ("Jeff Garzik <jgarzik@pobox.com>");
MODULE_DESCRIPTION ("MII hardware support library");
MODULE_LICENSE("GPL");

EXPORT_SYMBOL(mii_link_ok);
EXPORT_SYMBOL(mii_nway_restart);
EXPORT_SYMBOL(mii_ethtool_gset);
EXPORT_SYMBOL(mii_ethtool_sset);
EXPORT_SYMBOL(mii_check_link);
EXPORT_SYMBOL(mii_check_media);
EXPORT_SYMBOL(mii_check_gmii_support);
EXPORT_SYMBOL(generic_mii_ioctl);
Commit	Line	Data
1da177e4 LT	1	/*
	2
	3	mii.c: MII interface library
	4
	5	Maintained by Jeff Garzik <jgarzik@pobox.com>
	6	Copyright 2001,2002 Jeff Garzik
	7
	8	Various code came from myson803.c and other files by
	9	Donald Becker. Copyright:
	10
	11	Written 1998-2002 by Donald Becker.
	12
	13	This software may be used and distributed according
	14	to the terms of the GNU General Public License (GPL),
	15	incorporated herein by reference. Drivers based on
	16	or derived from this code fall under the GPL and must
	17	retain the authorship, copyright and license notice.
	18	This file is not a complete program and may only be
	19	used when the entire operating system is licensed
	20	under the GPL.
	21
	22	The author may be reached as becker@scyld.com, or C/O
	23	Scyld Computing Corporation
	24	410 Severn Ave., Suite 210
	25	Annapolis MD 21403
	26
	27
	28	*/
	29
	30	#include <linux/kernel.h>
	31	#include <linux/module.h>
	32	#include <linux/netdevice.h>
	33	#include <linux/ethtool.h>
5974700c BH	34	#include <linux/mdio.h>
	35
	36	static u32 mii_get_an(struct mii_if_info *mii, u16 addr)
	37	{
	38	u32 result = 0;
	39	int advert;
	40
	41	advert = mii->mdio_read(mii->dev, mii->phy_id, addr);
	42	if (advert & LPA_LPACK)
	43	result \|= ADVERTISED_Autoneg;
	44	if (advert & ADVERTISE_10HALF)
	45	result \|= ADVERTISED_10baseT_Half;
	46	if (advert & ADVERTISE_10FULL)
	47	result \|= ADVERTISED_10baseT_Full;
	48	if (advert & ADVERTISE_100HALF)
	49	result \|= ADVERTISED_100baseT_Half;
	50	if (advert & ADVERTISE_100FULL)
	51	result \|= ADVERTISED_100baseT_Full;
	52
	53	return result;
	54	}
1da177e4	55
32684ec6 RD	56	/**
	57	* mii_ethtool_gset - get settings that are specified in @ecmd
	58	* @mii: MII interface
	59	* @ecmd: requested ethtool_cmd
	60	*
	61	* Returns 0 for success, negative on error.
	62	*/
1da177e4 LT	63	int mii_ethtool_gset(struct mii_if_info mii, struct ethtool_cmd ecmd)
	64	{
	65	struct net_device *dev = mii->dev;
5974700c BH	66	u16 bmcr, bmsr, ctrl1000 = 0, stat1000 = 0;
5974700c BH	67	u32 nego;
1da177e4 LT	68
	69	ecmd->supported =
	70	(SUPPORTED_10baseT_Half \| SUPPORTED_10baseT_Full \|
	71	SUPPORTED_100baseT_Half \| SUPPORTED_100baseT_Full \|
	72	SUPPORTED_Autoneg \| SUPPORTED_TP \| SUPPORTED_MII);
	73	if (mii->supports_gmii)
	74	ecmd->supported \|= SUPPORTED_1000baseT_Half \|
	75	SUPPORTED_1000baseT_Full;
	76
	77	/* only supports twisted-pair */
	78	ecmd->port = PORT_MII;
	79
	80	/* only supports internal transceiver */
	81	ecmd->transceiver = XCVR_INTERNAL;
	82
	83	/* this isn't fully supported at higher layers */
	84	ecmd->phy_address = mii->phy_id;
5974700c	85	ecmd->mdio_support = MDIO_SUPPORTS_C22;
1da177e4 LT	86
1da177e4 LT	87	ecmd->advertising = ADVERTISED_TP \| ADVERTISED_MII;
1da177e4 LT	88
1da177e4 LT	89	bmcr = mii->mdio_read(dev, mii->phy_id, MII_BMCR);
5974700c	90	bmsr = mii->mdio_read(dev, mii->phy_id, MII_BMSR);
1da177e4	91	if (mii->supports_gmii) {
5974700c BH	92	ctrl1000 = mii->mdio_read(dev, mii->phy_id, MII_CTRL1000);
5974700c BH	93	stat1000 = mii->mdio_read(dev, mii->phy_id, MII_STAT1000);
1da177e4 LT	94	}
	95	if (bmcr & BMCR_ANENABLE) {
	96	ecmd->advertising \|= ADVERTISED_Autoneg;
	97	ecmd->autoneg = AUTONEG_ENABLE;
6aa20a22	98
5974700c BH	99	ecmd->advertising \|= mii_get_an(mii, MII_ADVERTISE);
	100	if (ctrl1000 & ADVERTISE_1000HALF)
	101	ecmd->advertising \|= ADVERTISED_1000baseT_Half;
	102	if (ctrl1000 & ADVERTISE_1000FULL)
	103	ecmd->advertising \|= ADVERTISED_1000baseT_Full;
	104
	105	if (bmsr & BMSR_ANEGCOMPLETE) {
	106	ecmd->lp_advertising = mii_get_an(mii, MII_LPA);
	107	if (stat1000 & LPA_1000HALF)
	108	ecmd->lp_advertising \|=
	109	ADVERTISED_1000baseT_Half;
	110	if (stat1000 & LPA_1000FULL)
	111	ecmd->lp_advertising \|=
	112	ADVERTISED_1000baseT_Full;
	113	} else {
	114	ecmd->lp_advertising = 0;
	115	}
	116
	117	nego = ecmd->advertising & ecmd->lp_advertising;
	118
	119	if (nego & (ADVERTISED_1000baseT_Full \|
	120	ADVERTISED_1000baseT_Half)) {
1da177e4	121	ecmd->speed = SPEED_1000;
5974700c BH	122	ecmd->duplex = !!(nego & ADVERTISED_1000baseT_Full);
	123	} else if (nego & (ADVERTISED_100baseT_Full \|
	124	ADVERTISED_100baseT_Half)) {
1da177e4	125	ecmd->speed = SPEED_100;
5974700c	126	ecmd->duplex = !!(nego & ADVERTISED_100baseT_Full);
1da177e4	127	} else {
5974700c BH	128	ecmd->speed = SPEED_10;
5974700c BH	129	ecmd->duplex = !!(nego & ADVERTISED_10baseT_Full);
1da177e4 LT	130	}
	131	} else {
	132	ecmd->autoneg = AUTONEG_DISABLE;
	133
6aa20a22	134	ecmd->speed = ((bmcr & BMCR_SPEED1000 &&
1da177e4 LT	135	(bmcr & BMCR_SPEED100) == 0) ? SPEED_1000 :
	136	(bmcr & BMCR_SPEED100) ? SPEED_100 : SPEED_10);
	137	ecmd->duplex = (bmcr & BMCR_FULLDPLX) ? DUPLEX_FULL : DUPLEX_HALF;
	138	}
	139
5974700c BH	140	mii->full_duplex = ecmd->duplex;
5974700c BH	141
1da177e4 LT	142	/* ignore maxtxpkt, maxrxpkt for now */
	143
	144	return 0;
	145	}
	146
32684ec6 RD	147	/**
	148	* mii_ethtool_sset - set settings that are specified in @ecmd
	149	* @mii: MII interface
	150	* @ecmd: requested ethtool_cmd
	151	*
	152	* Returns 0 for success, negative on error.
	153	*/
1da177e4 LT	154	int mii_ethtool_sset(struct mii_if_info mii, struct ethtool_cmd ecmd)
	155	{
	156	struct net_device *dev = mii->dev;
	157
6aa20a22 JG	158	if (ecmd->speed != SPEED_10 &&
6aa20a22 JG	159	ecmd->speed != SPEED_100 &&
1da177e4 LT	160	ecmd->speed != SPEED_1000)
	161	return -EINVAL;
	162	if (ecmd->duplex != DUPLEX_HALF && ecmd->duplex != DUPLEX_FULL)
	163	return -EINVAL;
	164	if (ecmd->port != PORT_MII)
	165	return -EINVAL;
	166	if (ecmd->transceiver != XCVR_INTERNAL)
	167	return -EINVAL;
	168	if (ecmd->phy_address != mii->phy_id)
	169	return -EINVAL;
	170	if (ecmd->autoneg != AUTONEG_DISABLE && ecmd->autoneg != AUTONEG_ENABLE)
	171	return -EINVAL;
	172	if ((ecmd->speed == SPEED_1000) && (!mii->supports_gmii))
	173	return -EINVAL;
6aa20a22	174
1da177e4	175	/* ignore supported, maxtxpkt, maxrxpkt */
6aa20a22	176
1da177e4 LT	177	if (ecmd->autoneg == AUTONEG_ENABLE) {
	178	u32 bmcr, advert, tmp;
	179	u32 advert2 = 0, tmp2 = 0;
	180
	181	if ((ecmd->advertising & (ADVERTISED_10baseT_Half \|
	182	ADVERTISED_10baseT_Full \|
	183	ADVERTISED_100baseT_Half \|
	184	ADVERTISED_100baseT_Full \|
	185	ADVERTISED_1000baseT_Half \|
	186	ADVERTISED_1000baseT_Full)) == 0)
	187	return -EINVAL;
	188
	189	/* advertise only what has been requested */
	190	advert = mii->mdio_read(dev, mii->phy_id, MII_ADVERTISE);
	191	tmp = advert & ~(ADVERTISE_ALL \| ADVERTISE_100BASE4);
	192	if (mii->supports_gmii) {
	193	advert2 = mii->mdio_read(dev, mii->phy_id, MII_CTRL1000);
	194	tmp2 = advert2 & ~(ADVERTISE_1000HALF \| ADVERTISE_1000FULL);
	195	}
	196	if (ecmd->advertising & ADVERTISED_10baseT_Half)
	197	tmp \|= ADVERTISE_10HALF;
	198	if (ecmd->advertising & ADVERTISED_10baseT_Full)
	199	tmp \|= ADVERTISE_10FULL;
	200	if (ecmd->advertising & ADVERTISED_100baseT_Half)
	201	tmp \|= ADVERTISE_100HALF;
	202	if (ecmd->advertising & ADVERTISED_100baseT_Full)
	203	tmp \|= ADVERTISE_100FULL;
	204	if (mii->supports_gmii) {
	205	if (ecmd->advertising & ADVERTISED_1000baseT_Half)
	206	tmp2 \|= ADVERTISE_1000HALF;
	207	if (ecmd->advertising & ADVERTISED_1000baseT_Full)
	208	tmp2 \|= ADVERTISE_1000FULL;
	209	}
	210	if (advert != tmp) {
	211	mii->mdio_write(dev, mii->phy_id, MII_ADVERTISE, tmp);
	212	mii->advertising = tmp;
	213	}
	214	if ((mii->supports_gmii) && (advert2 != tmp2))
	215	mii->mdio_write(dev, mii->phy_id, MII_CTRL1000, tmp2);
6aa20a22	216
1da177e4 LT	217	/* turn on autonegotiation, and force a renegotiate */
	218	bmcr = mii->mdio_read(dev, mii->phy_id, MII_BMCR);
	219	bmcr \|= (BMCR_ANENABLE \| BMCR_ANRESTART);
	220	mii->mdio_write(dev, mii->phy_id, MII_BMCR, bmcr);
	221
	222	mii->force_media = 0;
	223	} else {
	224	u32 bmcr, tmp;
	225
	226	/* turn off auto negotiation, set speed and duplexity */
	227	bmcr = mii->mdio_read(dev, mii->phy_id, MII_BMCR);
6aa20a22	228	tmp = bmcr & ~(BMCR_ANENABLE \| BMCR_SPEED100 \|
1da177e4 LT	229	BMCR_SPEED1000 \| BMCR_FULLDPLX);
	230	if (ecmd->speed == SPEED_1000)
	231	tmp \|= BMCR_SPEED1000;
	232	else if (ecmd->speed == SPEED_100)
	233	tmp \|= BMCR_SPEED100;
	234	if (ecmd->duplex == DUPLEX_FULL) {
	235	tmp \|= BMCR_FULLDPLX;
	236	mii->full_duplex = 1;
	237	} else
	238	mii->full_duplex = 0;
	239	if (bmcr != tmp)
	240	mii->mdio_write(dev, mii->phy_id, MII_BMCR, tmp);
	241
	242	mii->force_media = 1;
	243	}
	244	return 0;
	245	}
	246
32684ec6 RD	247	/**
	248	* mii_check_gmii_support - check if the MII supports Gb interfaces
	249	* @mii: the MII interface
	250	*/
43ec6e95 DF	251	int mii_check_gmii_support(struct mii_if_info *mii)
	252	{
	253	int reg;
	254
	255	reg = mii->mdio_read(mii->dev, mii->phy_id, MII_BMSR);
	256	if (reg & BMSR_ESTATEN) {
	257	reg = mii->mdio_read(mii->dev, mii->phy_id, MII_ESTATUS);
	258	if (reg & (ESTATUS_1000_TFULL \| ESTATUS_1000_THALF))
	259	return 1;
	260	}
	261
	262	return 0;
	263	}
	264
32684ec6 RD	265	/**
	266	* mii_link_ok - is link status up/ok
	267	* @mii: the MII interface
	268	*
	269	* Returns 1 if the MII reports link status up/ok, 0 otherwise.
	270	*/
1da177e4 LT	271	int mii_link_ok (struct mii_if_info *mii)
	272	{
	273	/* first, a dummy read, needed to latch some MII phys */
	274	mii->mdio_read(mii->dev, mii->phy_id, MII_BMSR);
	275	if (mii->mdio_read(mii->dev, mii->phy_id, MII_BMSR) & BMSR_LSTATUS)
	276	return 1;
	277	return 0;
	278	}
	279
32684ec6 RD	280	/**
	281	* mii_nway_restart - restart NWay (autonegotiation) for this interface
	282	* @mii: the MII interface
	283	*
	284	* Returns 0 on success, negative on error.
	285	*/
1da177e4 LT	286	int mii_nway_restart (struct mii_if_info *mii)
	287	{
	288	int bmcr;
	289	int r = -EINVAL;
	290
	291	/* if autoneg is off, it's an error */
	292	bmcr = mii->mdio_read(mii->dev, mii->phy_id, MII_BMCR);
	293
	294	if (bmcr & BMCR_ANENABLE) {
	295	bmcr \|= BMCR_ANRESTART;
	296	mii->mdio_write(mii->dev, mii->phy_id, MII_BMCR, bmcr);
	297	r = 0;
	298	}
	299
	300	return r;
	301	}
	302
32684ec6 RD	303	/**
	304	* mii_check_link - check MII link status
	305	* @mii: MII interface
	306	*
	307	* If the link status changed (previous != current), call
	308	* netif_carrier_on() if current link status is Up or call
	309	* netif_carrier_off() if current link status is Down.
	310	*/
1da177e4 LT	311	void mii_check_link (struct mii_if_info *mii)
	312	{
	313	int cur_link = mii_link_ok(mii);
	314	int prev_link = netif_carrier_ok(mii->dev);
	315
	316	if (cur_link && !prev_link)
	317	netif_carrier_on(mii->dev);
	318	else if (prev_link && !cur_link)
	319	netif_carrier_off(mii->dev);
	320	}
	321
32684ec6 RD	322	/**
	323	* mii_check_media - check the MII interface for a duplex change
	324	* @mii: the MII interface
	325	* @ok_to_print: OK to print link up/down messages
	326	* @init_media: OK to save duplex mode in @mii
	327	*
	328	* Returns 1 if the duplex mode changed, 0 if not.
	329	* If the media type is forced, always returns 0.
	330	*/
1da177e4 LT	331	unsigned int mii_check_media (struct mii_if_info *mii,
	332	unsigned int ok_to_print,
	333	unsigned int init_media)
	334	{
	335	unsigned int old_carrier, new_carrier;
	336	int advertise, lpa, media, duplex;
	337	int lpa2 = 0;
	338
	339	/* if forced media, go no further */
	340	if (mii->force_media)
	341	return 0; /* duplex did not change */
	342
	343	/* check current and old link status */
	344	old_carrier = netif_carrier_ok(mii->dev) ? 1 : 0;
	345	new_carrier = (unsigned int) mii_link_ok(mii);
	346
	347	/* if carrier state did not change, this is a "bounce",
	348	* just exit as everything is already set correctly
	349	*/
	350	if ((!init_media) && (old_carrier == new_carrier))
	351	return 0; /* duplex did not change */
	352
	353	/* no carrier, nothing much to do */
	354	if (!new_carrier) {
	355	netif_carrier_off(mii->dev);
	356	if (ok_to_print)
	357	printk(KERN_INFO "%s: link down\n", mii->dev->name);
	358	return 0; /* duplex did not change */
	359	}
	360
	361	/*
	362	* we have carrier, see who's on the other end
	363	*/
	364	netif_carrier_on(mii->dev);
	365
	366	/* get MII advertise and LPA values */
	367	if ((!init_media) && (mii->advertising))
	368	advertise = mii->advertising;
	369	else {
	370	advertise = mii->mdio_read(mii->dev, mii->phy_id, MII_ADVERTISE);
	371	mii->advertising = advertise;
	372	}
	373	lpa = mii->mdio_read(mii->dev, mii->phy_id, MII_LPA);
	374	if (mii->supports_gmii)
	375	lpa2 = mii->mdio_read(mii->dev, mii->phy_id, MII_STAT1000);
	376
	377	/* figure out media and duplex from advertise and LPA values */
	378	media = mii_nway_result(lpa & advertise);
	379	duplex = (media & ADVERTISE_FULL) ? 1 : 0;
	380	if (lpa2 & LPA_1000FULL)
	381	duplex = 1;
	382
	383	if (ok_to_print)
	384	printk(KERN_INFO "%s: link up, %sMbps, %s-duplex, lpa 0x%04X\n",
	385	mii->dev->name,
	386	lpa2 & (LPA_1000FULL \| LPA_1000HALF) ? "1000" :
	387	media & (ADVERTISE_100FULL \| ADVERTISE_100HALF) ? "100" : "10",
	388	duplex ? "full" : "half",
	389	lpa);
	390
	391	if ((init_media) \|\| (mii->full_duplex != duplex)) {
	392	mii->full_duplex = duplex;
	393	return 1; /* duplex changed */
	394	}
395
396	return 0; /* duplex did not change */
397	}
398
32684ec6 RD	399	/**
	400	* generic_mii_ioctl - main MII ioctl interface
	401	* @mii_if: the MII interface
	402	* @mii_data: MII ioctl data structure
	403	* @cmd: MII ioctl command
	404	* @duplex_chg_out: pointer to @duplex_changed status if there was no
	405	* ioctl error
	406	*
	407	* Returns 0 on success, negative on error.
	408	*/
1da177e4 LT	409	int generic_mii_ioctl(struct mii_if_info *mii_if,
	410	struct mii_ioctl_data *mii_data, int cmd,
	411	unsigned int *duplex_chg_out)
	412	{
	413	int rc = 0;
	414	unsigned int duplex_changed = 0;
	415
	416	if (duplex_chg_out)
	417	*duplex_chg_out = 0;
	418
	419	mii_data->phy_id &= mii_if->phy_id_mask;
	420	mii_data->reg_num &= mii_if->reg_num_mask;
	421
	422	switch(cmd) {
	423	case SIOCGMIIPHY:
	424	mii_data->phy_id = mii_if->phy_id;
	425	/* fall through */
	426
	427	case SIOCGMIIREG:
	428	mii_data->val_out =
	429	mii_if->mdio_read(mii_if->dev, mii_data->phy_id,
	430	mii_data->reg_num);
	431	break;
	432
	433	case SIOCSMIIREG: {
	434	u16 val = mii_data->val_in;
	435
1da177e4 LT	436	if (mii_data->phy_id == mii_if->phy_id) {
	437	switch(mii_data->reg_num) {
	438	case MII_BMCR: {
	439	unsigned int new_duplex = 0;
	440	if (val & (BMCR_RESET\|BMCR_ANENABLE))
	441	mii_if->force_media = 0;
	442	else
	443	mii_if->force_media = 1;
	444	if (mii_if->force_media &&
	445	(val & BMCR_FULLDPLX))
	446	new_duplex = 1;
	447	if (mii_if->full_duplex != new_duplex) {
	448	duplex_changed = 1;
	449	mii_if->full_duplex = new_duplex;
	450	}
	451	break;
	452	}
	453	case MII_ADVERTISE:
	454	mii_if->advertising = val;
	455	break;
	456	default:
	457	/* do nothing */
	458	break;
	459	}
	460	}
	461
	462	mii_if->mdio_write(mii_if->dev, mii_data->phy_id,
	463	mii_data->reg_num, val);
	464	break;
	465	}
	466
	467	default:
	468	rc = -EOPNOTSUPP;
	469	break;
	470	}
	471
	472	if ((rc == 0) && (duplex_chg_out) && (duplex_changed))
	473	*duplex_chg_out = 1;
	474
	475	return rc;
	476	}
	477
	478	MODULE_AUTHOR ("Jeff Garzik <jgarzik@pobox.com>");
	479	MODULE_DESCRIPTION ("MII hardware support library");
	480	MODULE_LICENSE("GPL");
	481
	482	EXPORT_SYMBOL(mii_link_ok);
	483	EXPORT_SYMBOL(mii_nway_restart);
	484	EXPORT_SYMBOL(mii_ethtool_gset);
	485	EXPORT_SYMBOL(mii_ethtool_sset);
	486	EXPORT_SYMBOL(mii_check_link);
	487	EXPORT_SYMBOL(mii_check_media);
43ec6e95	488	EXPORT_SYMBOL(mii_check_gmii_support);
1da177e4 LT	489	EXPORT_SYMBOL(generic_mii_ioctl);
1da177e4 LT	490