MV88X3310_phy.c

#include "tn40.h"
#ifdef PHY_MV88X3310
#include "MV88X3310_phy.h"
#endif
#ifdef PHY_MV88E2010
#include "MV88E2010_phy.h"
#endif
#define MACTYPE (0x1)
#define	MV88X3310_FILE_OFFSET	(16)
#define MANUF_MODEL_NUM_MASK        (0x3F)
#define MANUF_MODEL_NUM_BIT_POS     (4)
#define MV88X3120_FILE_OFFSET  (16)
/*#define SPEED_RES_10M                         (0x0000)                // Not supported */
#define SPEED_RES_100M 				(0x0001)
#define SPEED_RES_1GIG 				(0x0002)
#define SPEED_RES_NBASE   			(0x0003)
#define SPEED_RES_10GIG 			(0x0000)
#define SPEED_RES_5GIG 				(0x0002)
#define SPEED_RES_2P5GIG 			(0x0001)
#define	MV88X3310_10M_MASK			((1 << 5) | (1 << 6))	/* reg7_0010 */
#define	MV88X3310_100M_MASK			(1 << 8)	/*              " */
#define	MV88X3310_1G_MASK			(1 << 9)	/* reg7_8000 */
#define	MV88X3310_2_5G_MASK			((1 << 5) | (1 << 7))	/* reg7_0020 */
#define	MV88X3310_5G_MASK			((1 << 6) | (1 << 8))	/*              " */
#define	MV88X3310_10G_MASK			(1 << 12)	/*              " */
#define MV88X3310_LED_0				(0xf020)
#define MV88X3310_LED_1				(0xf021)
#define MV88X3310_LED_2				(0xf022)
#define MV88X3310_LED_3				(0xf023)

#define SW_RESET_COUNT				(100)
#define LINK_LOOP_MAX   			(25)
#define PHY_NAME					((priv->deviceId == 0x4027) ? "MV88X3310" : "MV88E2010")
enum PHY_LED_COLOR {
	PHY_LED_OFF,
	PHY_LED_GREEN,
	PHY_LED_AMBER,
};
enum PHY_SPEED {
	PHY_SPEED_LOW,
	PHY_SPEED_NBASET,
	PHY_SPEED_HIGH,
};

void MV88X3310_register_settings(struct bdx_priv *priv);
int MV88X3310_mdio_reset(struct bdx_priv *priv, int port, unsigned short phy);
u32 MV88X3310_link_changed(struct bdx_priv *priv);
void MV88X3310_leds(struct bdx_priv *priv, enum PHY_LEDS_OP op);

int MV88X3310_set_speed(struct bdx_priv *priv, signed int speed)
{

	u16 val, port = priv->phy_mdio_port;
	u16 reg7_0010 = PHY_MDIO_READ(priv, 7, 0x0010);
	u16 reg7_0020 = PHY_MDIO_READ(priv, 7, 0x0020);
	u16 reg7_8000 = PHY_MDIO_READ(priv, 7, 0x8000);
	int rVal = 0;

	if (priv->autoneg == AUTONEG_ENABLE) {
		pr_debug("MV88X3310 speed 10G/1G/100m Autoneg\n");
		reg7_0010 =
		    (reg7_0010 & ~MV88X3310_10M_MASK) | MV88X3310_100M_MASK;
		reg7_0020 =
		    reg7_0020 | MV88X3310_2_5G_MASK | MV88X3310_5G_MASK |
		    MV88X3310_10G_MASK;
		reg7_8000 = reg7_8000 | MV88X3310_1G_MASK;
	} else {
		switch (speed) {
		case 10000:	/*10G */
			pr_debug("MV88X3310 speed 10G\n");
			reg7_0010 =
			    reg7_0010 & ~MV88X3310_10M_MASK &
			    ~MV88X3310_100M_MASK;
			reg7_0020 =
			    (reg7_0020 & ~MV88X3310_2_5G_MASK &
			     ~MV88X3310_5G_MASK) | MV88X3310_10G_MASK;
			reg7_8000 = reg7_8000 & ~MV88X3310_1G_MASK;
			break;

		case 5000:	/*5G */
			pr_debug("MV88X3310 speed 5G\n");
			reg7_0010 =
			    reg7_0010 & ~MV88X3310_10M_MASK &
			    ~MV88X3310_100M_MASK;
			reg7_0020 =
			    (reg7_0020 & ~MV88X3310_2_5G_MASK &
			     ~MV88X3310_10G_MASK) | MV88X3310_5G_MASK;
			reg7_8000 = reg7_8000 & ~MV88X3310_1G_MASK;
			break;

		case 2500:	/*2.5G */
			pr_debug("MV88X3310 speed 2.5G\n");
			reg7_0010 =
			    reg7_0010 & ~MV88X3310_10M_MASK &
			    ~MV88X3310_100M_MASK;
			reg7_0020 =
			    (reg7_0020 & ~MV88X3310_5G_MASK &
			     ~MV88X3310_10G_MASK) | MV88X3310_2_5G_MASK;
			reg7_8000 = reg7_0020 & ~MV88X3310_1G_MASK;
			break;

		case 1000:	/*1G */
			pr_debug("MV88X3310 speed 1G\n");
			reg7_0010 =
			    reg7_0010 & ~MV88X3310_10M_MASK &
			    ~MV88X3310_100M_MASK;
			reg7_0020 =
			    reg7_0020 & ~MV88X3310_2_5G_MASK &
			    ~MV88X3310_10G_MASK & ~MV88X3310_5G_MASK;
			reg7_8000 = reg7_8000 | MV88X3310_1G_MASK;
			break;

		case 100:	/*100m */
			pr_debug("MV88X3310 speed 100m\n");
			reg7_0010 =
			    (reg7_0010 & ~MV88X3310_10M_MASK) |
			    MV88X3310_100M_MASK;
			reg7_0020 =
			    reg7_0020 & ~MV88X3310_2_5G_MASK &
			    ~MV88X3310_10G_MASK & ~MV88X3310_5G_MASK;
			reg7_8000 = reg7_8000 & ~MV88X3310_1G_MASK;
			break;

		default:
			pr_err("does not support speed %u\n", speed);
			rVal = -1;
			break;
		}
	}
	if (rVal == 0) {
		/* set speed */
		pr_debug
		    ("writing 7,0x0010 0x%04x 7,0x0020 0x%04x 7,0x8000 0x%04x\n",
		     (u32) reg7_0010, (u32) reg7_0020, (u32) reg7_8000);
		BDX_MDIO_WRITE(priv, 7, 0x0010, reg7_0010);
		BDX_MDIO_WRITE(priv, 7, 0x0020, reg7_0020);
		BDX_MDIO_WRITE(priv, 7, 0x8000, reg7_8000);
		/* restart autoneg */
		val = PHY_MDIO_READ(priv, 7, 0);
		val = val | 0x1200;
		BDX_MDIO_WRITE(priv, 0x07, 0x0, val);
	}

	return rVal;

}

static int MV88X3310_set_Reset_values(struct bdx_priv *priv)
{
	u16 val;
	u16 port = priv->phy_mdio_port;
	u16 port_ctrl = PHY_MDIO_READ(priv, 31, 0xF001);
	u16 reg7_0010 = PHY_MDIO_READ(priv, 7, 0x0010);
	u16 reg7_0020 = PHY_MDIO_READ(priv, 7, 0x0020);
	u16 reg7_8000 = PHY_MDIO_READ(priv, 7, 0x8000);

	reg7_0010 = (reg7_0010 & ~MV88X3310_10M_MASK) | MV88X3310_100M_MASK;
	reg7_0020 =
	    reg7_0020 | MV88X3310_2_5G_MASK | MV88X3310_5G_MASK |
	    MV88X3310_10G_MASK;
	reg7_8000 = reg7_8000 | MV88X3310_1G_MASK;

	pr_debug("writing 7,0x0010 0x%04x 7,0x0020 0x%04x 7,0x8000 0x%04x\n",
		 (u32) reg7_0010, (u32) reg7_0020, (u32) reg7_8000);
	BDX_MDIO_WRITE(priv, 7, 0x0010, reg7_0010);
	BDX_MDIO_WRITE(priv, 7, 0x0020, reg7_0020);
	BDX_MDIO_WRITE(priv, 7, 0x8000, reg7_8000);

	port_ctrl |= MACTYPE;
	port_ctrl |= (1 << 15);
	BDX_MDIO_WRITE(priv, 31, 0xF001, port_ctrl);

	val = PHY_MDIO_READ(priv, 7, 0);
	val |= ((1 << 9) | (1 << 12));
	BDX_MDIO_WRITE(priv, 7, 0, val);
	pr_debug("MACTYPE = 0x%x\n",
		 bdx_mdio_read(priv, 31, port, 0xF001) & 0x0007);

	BDX_MDIO_WRITE(priv, 1, 0xC034, 0x0017);

	return 0;

}

static int MV88X3310_set_rate_adapt(struct bdx_priv *priv,
				    enum PHY_SPEED phy_speed)
{
	u16 port = priv->phy_mdio_port;

	if (phy_speed == PHY_SPEED_HIGH) {
		pr_debug("Rate Adapt: off\n");

		BDX_MDIO_WRITE(priv, 31, 0xF000, 0x10C8);
		bdx_mdio_read(priv, 31, port, 0xF001);
		bdx_mdio_read(priv, 31, port, 0xF001);
		BDX_MDIO_WRITE(priv, 31, 0xF000, 0x20C8);
		bdx_mdio_read(priv, 31, port, 0xF001);
		bdx_mdio_read(priv, 31, port, 0xF001);
	} else {
		pr_debug("Rate Adapt: on\n");
		BDX_MDIO_WRITE(priv, 31, 0xF000, 0x30C8);
		bdx_mdio_read(priv, 31, port, 0xF001);
		bdx_mdio_read(priv, 31, port, 0xF001);

		BDX_MDIO_WRITE(priv, 31, 0x8000, 0x0F3F);
		BDX_MDIO_WRITE(priv, 31, 0x8001, 0x41D0);
		bdx_mdio_read(priv, 31, port, 0xF001);
		bdx_mdio_read(priv, 31, port, 0xF001);
		bdx_mdio_read(priv, 31, port, 0xF001);
		bdx_mdio_read(priv, 31, port, 0xF001);
		bdx_mdio_read(priv, 31, port, 0xF001);

		BDX_MDIO_WRITE(priv, 31, 0x8C04, 0x1C00);
		BDX_MDIO_WRITE(priv, 31, 0x8C05, 0x0000);
		BDX_MDIO_WRITE(priv, 31, 0x800E, 0x1B0A);
		BDX_MDIO_WRITE(priv, 31, 0x800F, 0x0000);

		if (phy_speed == PHY_SPEED_NBASET) {
			pr_debug("Rate Adapt: nbaset_speeds\n");

			BDX_MDIO_WRITE(priv, 31, 0x8C00, 0x1383);
			BDX_MDIO_WRITE(priv, 31, 0x8C01, 0x0000);
			BDX_MDIO_WRITE(priv, 31, 0x8E00, 0x1383);
			BDX_MDIO_WRITE(priv, 31, 0x8E01, 0x0000);
			BDX_MDIO_WRITE(priv, 31, 0x8C02, 0x1FFF);
			BDX_MDIO_WRITE(priv, 31, 0x8C03, 0x0000);
			BDX_MDIO_WRITE(priv, 31, 0x8E02, 0x1FFF);
			BDX_MDIO_WRITE(priv, 31, 0x8E03, 0x0000);

			BDX_MDIO_WRITE(priv, 31, 0x80A2, 0x0001);
			BDX_MDIO_WRITE(priv, 31, 0x80A3, 0x0000);
		} else {
			pr_debug("Rate Adapt: lower Speeds\n");

			BDX_MDIO_WRITE(priv, 31, 0x8C00, 0xFFFF);
			BDX_MDIO_WRITE(priv, 31, 0x8E01, 0x0000);
			BDX_MDIO_WRITE(priv, 31, 0x8E00, 0xFFFF);
			BDX_MDIO_WRITE(priv, 31, 0x8E01, 0x0000);
			BDX_MDIO_WRITE(priv, 31, 0x8C06, 0x0189);
			BDX_MDIO_WRITE(priv, 31, 0x8C07, 0x0000);
			BDX_MDIO_WRITE(priv, 31, 0x8E06, 0xB1E8);
			BDX_MDIO_WRITE(priv, 31, 0x8E07, 0x0000);

			BDX_MDIO_WRITE(priv, 31, 0x80A2, 0x0000);
			BDX_MDIO_WRITE(priv, 31, 0x80A3, 0x0000);
		}
	}

	return 0;

}

#ifdef _
#ifdef ETHTOOL_SEEE_
int MV88X3310_set_eee(struct bdx_priv *priv /*, struct ethtool_eee *edata */ );
#endif
#endif
__init int MV88X3310_mdio_reset(struct bdx_priv *priv, int port,
				unsigned short phy)
{
	unsigned short val, val1;
	int rVal = 0;
	u32 j;
	u32 phy_initdata_size = 0;
	u16 *phy_initdata = NULL;
	u16 expected_value = 0;

#ifdef PHY_MV88X3310
	if (priv->deviceId == 0x4027) {
		phy_initdata = MV88X3310_phy_initdata;
		phy_initdata_size =
		    sizeof(MV88X3310_phy_initdata) / sizeof(u16);
	}
#endif
#ifdef PHY_MV88E2010
	if (priv->deviceId == 0x4527) {
		phy_initdata = MV88E2010_phy_initdata;
		phy_initdata_size =
		    sizeof(MV88E2010_phy_initdata) / sizeof(u16);

	}
#endif
	val = bdx_mdio_read(priv, 1, port, 3);
	val1 = val & 0x000F;	/* revNo */
	val = (val & (MANUF_MODEL_NUM_MASK << MANUF_MODEL_NUM_BIT_POS)) >> MANUF_MODEL_NUM_BIT_POS;	/* modelNo */
	pr_debug("%s modelNo = %d revNo %d\n", PHY_NAME, val, val1);
	do {
		val = bdx_mdio_read(priv, 31, port, 0xF008);
		BDX_MDIO_WRITE(priv, 31, 0xF008, (val | 1 << 5));
		val = bdx_mdio_read(priv, 31, port, 0xF001);
		BDX_MDIO_WRITE(priv, 31, 0xF001, (val | 1 << 12));
		msleep(250);
		if ((val = bdx_mdio_read(priv, 1, port, 0xC050)) != 0x000A) {
			pr_err
			    ("%s Initialization Error. Expected 0x000A, read 0x%04X\n",
			     PHY_NAME, (unsigned)val);
			rVal = -1;
			break;
		} else {
			pr_debug("%s Initializing data...\n", PHY_NAME);
		}
		val = bdx_mdio_read(priv, 3, port, 0xD0F3);
		BDX_MDIO_WRITE(priv, 3, 0xD0F0, 0);
		BDX_MDIO_WRITE(priv, 3, 0xD0F1, 0x0010);
		for (j = MV88X3310_FILE_OFFSET; j < phy_initdata_size; j++) {
			val = swab16(phy_initdata[j]);
			expected_value +=
			    (val & 0x00ff) + ((val & 0xff00) >> 8);
			BDX_MDIO_WRITE(priv, 3, 0xD0F2, val);
		}
		pr_debug("%s loaded %d 16bit words\n", PHY_NAME,
			 phy_initdata_size);
		val = bdx_mdio_read(priv, 1, port, 0xC050);
		BDX_MDIO_WRITE(priv, 1, 0xC050, (val | (1 << 6)));
		msleep(500);
		if (!((val = bdx_mdio_read(priv, 1, port, 0xC050)) & (1 << 4))) {
			pr_err
			    ("%s initdata not applied. Expected bit 4 to be 1, read 0x%04X\n",
			     PHY_NAME, (unsigned)val);
			rVal = -1;
			break;
		} else {
			pr_info("%s initdata applied\n", PHY_NAME);
		}
		val = bdx_mdio_read(priv, 3, port, 0xD0F3);
		if ((phy_initdata[4] != swab16(~expected_value))
		    || (swab16(~val) != swab16(~expected_value))) {
			pr_err
			    ("Initdata error ! file value is 0x%04x , I/D value is 0x%04x , expected value is 0x%04x\n",
			     phy_initdata[4], swab16(~val),
			     swab16(~expected_value));
			rVal = -1;
			break;
		}
		val = bdx_mdio_read(priv, 1, port, 0xc011);
		val1 = bdx_mdio_read(priv, 1, port, 0xc012);
		pr_info("%s I/D version is %d.%d.%d.%d\n", PHY_NAME,
			((val & 0xff00) >> 8), (val & 0x00ff),
			((val1 & 0xff00) >> 8), (val1 & 0x00ff));
		val = bdx_mdio_read(priv, 1, port, 0);
		BDX_MDIO_WRITE(priv, 1, 0, val | (1 << 15));
		/* verify reset complete */
		for (j = 0; j < SW_RESET_COUNT; j++) {
			if (!
			    ((val =
			      bdx_mdio_read(priv, 1, port, 0)) & (1 << 15))) {
				break;
			}
			pr_debug("%s waiting for reset complete 0x%x\n",
				 PHY_NAME, val);
			msleep(10);
		}
		if (j == SW_RESET_COUNT) {
			pr_err("%s SW reset was not completed 0x%x\n",
			       PHY_NAME, val);
		}
		MV88X3310_set_Reset_values(priv);
		BDX_MDIO_WRITE(priv, 3, 0x8010, (1 << 10) | (1 << 11));	/* Enable LASI auto negotiation complete */

	} while (0);

	return rVal;

}

static void MV88X3310_led(struct bdx_priv *priv, enum PHY_LED_COLOR color)
{
	u16 led1val, led2val;

	if (color == PHY_LED_GREEN) {
		led1val = 0;
		led2val = 0xb8;
	} else if (color == PHY_LED_AMBER) {
		led1val = 0xb8;
		led2val = 0;
	} else {
		led1val = led2val = 0;
	}
	bdx_mdio_write(priv, 31, priv->phy_mdio_port, MV88X3310_LED_1, led1val);
	bdx_mdio_write(priv, 31, priv->phy_mdio_port, MV88X3310_LED_2, led2val);

}

static int MV88X3310_get_link_speed(struct bdx_priv *priv)
{
	unsigned short status;
	int resolved, duplex, speed, link = 0;
	u16 sd, sv;
	int qnap_led = 0;

	status = bdx_mdio_read(priv, 7, priv->phy_mdio_port, 1);
	pr_debug("%s 7.1 = 0x%x\n", PHY_NAME, status);

	sv = priv->subsystem_vendor;
	sd = priv->subsystem_device;
	if ((sv == 0x1BAA) && (sd == 0x3310))
		qnap_led = 1;

	PHY_MDIO_READ(priv, 3, 0x8011);
	PHY_MDIO_READ(priv, 3, 0x8011);

	if (status & (1 << 2)) {	/* Link up */
		status = bdx_mdio_read(priv, 3, priv->phy_mdio_port, 0x8008);
		resolved = status & (1 << 11);
		duplex = status & (1 << 13);
		speed = (status & 0xc000) >> 14;
		if (resolved) {
			pr_debug("%s speed %d %s duplex\n",
				 PHY_NAME, speed, duplex ? "full" : "half");
			switch (speed) {
			case SPEED_RES_NBASE:
				speed = (status & 0x000c) >> 2;
				switch (speed) {
				case SPEED_RES_10GIG:
					link = SPEED_10000;
					MV88X3310_set_rate_adapt(priv,
								 PHY_SPEED_HIGH);
					if (qnap_led == 1)
						MV88X3310_led(priv,
							      PHY_LED_GREEN);
					else
						MV88X3310_led(priv,
							      PHY_LED_AMBER);
					pr_debug("%s 10G link detected\n",
						 PHY_NAME);
					break;

				case SPEED_RES_5GIG:
					link = SPEED_5000;
					MV88X3310_set_rate_adapt(priv,
								 PHY_SPEED_NBASET);
					if (qnap_led == 1)
						MV88X3310_led(priv,
							      PHY_LED_AMBER);
					else
						MV88X3310_led(priv,
							      PHY_LED_GREEN);
					pr_debug("%s 5G link detected\n",
						 PHY_NAME);
					break;

				case SPEED_RES_2P5GIG:
					link = SPEED_2500;
					MV88X3310_set_rate_adapt(priv,
								 PHY_SPEED_NBASET);
					if (qnap_led == 1)
						MV88X3310_led(priv,
							      PHY_LED_AMBER);
					else
						MV88X3310_led(priv,
							      PHY_LED_GREEN);
					pr_debug("%s 2.5G link detected\n",
						 PHY_NAME);
					break;

				default:
					pr_debug
					    ("%s internal error - unknown link speed value (0x%x) !\n",
					     PHY_NAME, status);
					break;
				}
				break;

			case SPEED_RES_1GIG:
				link = SPEED_1000X;
				MV88X3310_set_rate_adapt(priv, PHY_SPEED_LOW);
				if (qnap_led == 1)
					MV88X3310_led(priv, PHY_LED_AMBER);
				else
					MV88X3310_led(priv, PHY_LED_GREEN);
				pr_debug("%s 1G link detected\n", PHY_NAME);
				break;

			case SPEED_RES_100M:
				link = SPEED_100X;
				MV88X3310_set_rate_adapt(priv, PHY_SPEED_LOW);
				if (qnap_led == 1)
					MV88X3310_led(priv, PHY_LED_AMBER);
				else
					MV88X3310_led(priv, PHY_LED_OFF);
				pr_debug("%s 100M link detected\n", PHY_NAME);
				break;

			default:
				pr_debug
				    ("%s internal error - unknown link speed value (0x%x) !\n",
				     PHY_NAME, status);
				MV88X3310_led(priv, PHY_LED_OFF);
				break;
			}
		} else {
			pr_debug("%s auto negotiation in progress...\n",
				 PHY_NAME);
			MV88X3310_led(priv, PHY_LED_OFF);

		}
		priv->errmsg_count = 0;
	} else {
		if (++priv->errmsg_count < MAX_ERRMSGS) {
			MV88X3310_led(priv, PHY_LED_OFF);
			pr_debug("%s link down.\n", PHY_NAME);
		}
	}

	return link;

}

u32 MV88X3310_link_changed(struct bdx_priv *priv)
{
	u32 link, speed;

	speed = MV88X3310_get_link_speed(priv);
	pr_debug("speed %d priv->link_speed %d\n", speed, priv->link_speed);
	if (speed != (u32) priv->link_speed) {
		switch (speed) {
		case SPEED_10000:
			pr_debug("%s 10G link detected\n", PHY_NAME);
#ifdef _EEE_
			pr_err("DBG_EEE eee_enabled=%d\n", priv->eee_enabled);
			if (priv->eee_enabled) {
			}

			else {
#if defined(_EEE) && defined(ETHTOOL_SEEE)
				MV88X3310_set_eee(priv /*, edata */ );
#endif
			}
#endif
			break;
		case SPEED_1000:
			pr_debug("%s 1G link detected\n", PHY_NAME);
			break;
		case SPEED_1000X:
			pr_debug("%s 1GX link detected\n", PHY_NAME);
			break;
		case SPEED_5000:
			pr_debug("%s 5G link detected\n", PHY_NAME);
			break;
		case SPEED_2500:
			pr_debug("%s 2.5G link detected\n", PHY_NAME);
			break;
		case SPEED_100:
			pr_debug("%s 100M link detected\n", PHY_NAME);
			break;
		case SPEED_100X:
			pr_debug("%s 100MX link detected\n", PHY_NAME);
			break;
		default:
			pr_debug("%s link down.\n", PHY_NAME);
			break;
		}
		bdx_speed_changed(priv, speed);
	}
	link = 0;
	if ((!speed)
	    || (!(link = (READ_REG(priv, regMAC_LNK_STAT) & MAC_LINK_STAT)))) {
		u32 timeout;
		if (speed) {
			timeout = 1000000;	/* 1/5 sec */
			if (priv->link_loop_cnt++ > LINK_LOOP_MAX) {
				bdx_speed_changed(priv, 0);
				priv->link_loop_cnt = 0;
				pr_debug
				    ("%s trying to recover link after %d tries\n",
				     PHY_NAME, LINK_LOOP_MAX);
			}
		} else {
			timeout = 5000000;	/* 1 sec */
		}
		pr_debug("%s link = 0x%x speed = 0x%x setting %d timer\n",
			 PHY_NAME, link, speed, timeout);
		WRITE_REG(priv, 0x5150, timeout);
	}

	return link;

}

void MV88X3310_leds(struct bdx_priv *priv, enum PHY_LEDS_OP op)
{
	switch (op) {
	case PHY_LEDS_SAVE:
		priv->phy_ops.leds[0] =
		    bdx_mdio_read(priv, 31, priv->phy_mdio_port,
				  MV88X3310_LED_0);
		priv->phy_ops.leds[1] =
		    bdx_mdio_read(priv, 31, priv->phy_mdio_port,
				  MV88X3310_LED_1);
		priv->phy_ops.leds[2] =
		    bdx_mdio_read(priv, 31, priv->phy_mdio_port,
				  MV88X3310_LED_2);
		priv->phy_ops.leds[3] =
		    bdx_mdio_read(priv, 31, priv->phy_mdio_port,
				  MV88X3310_LED_3);
		break;

	case PHY_LEDS_RESTORE:
		bdx_mdio_write(priv, 31, priv->phy_mdio_port, MV88X3310_LED_0,
			       priv->phy_ops.leds[0]);
		bdx_mdio_write(priv, 31, priv->phy_mdio_port, MV88X3310_LED_1,
			       priv->phy_ops.leds[1]);
		bdx_mdio_write(priv, 31, priv->phy_mdio_port, MV88X3310_LED_2,
			       priv->phy_ops.leds[2]);
		bdx_mdio_write(priv, 31, priv->phy_mdio_port, MV88X3310_LED_3,
			       priv->phy_ops.leds[3]);
		break;

	case PHY_LEDS_ON:
		bdx_mdio_write(priv, 31, priv->phy_mdio_port, MV88X3310_LED_0,
			       0xb8);

		bdx_mdio_write(priv, 31, priv->phy_mdio_port, MV88X3310_LED_2,
			       0xb8);

		break;

	case PHY_LEDS_OFF:
		bdx_mdio_write(priv, 31, priv->phy_mdio_port, MV88X3310_LED_0,
			       0);

		bdx_mdio_write(priv, 31, priv->phy_mdio_port, MV88X3310_LED_2,
			       0);

		break;

	default:
		pr_debug("unknown op 0x%x\n", op);
		break;

	}

}

__init enum PHY_TYPE MV88X3310_register(struct bdx_priv *priv)
{
	enum PHY_TYPE phyType;

	priv->phy_ops.mdio_reset = MV88X3310_mdio_reset;
	priv->phy_ops.link_changed = MV88X3310_link_changed;
	priv->phy_ops.ledset = MV88X3310_leds;
	priv->phy_ops.mdio_speed = MDIO_SPEED_6MHZ;
	MV88X3310_register_settings(priv);

	phyType =
	    (priv->deviceId ==
	     0x4027) ? PHY_TYPE_MV88X3310 : PHY_TYPE_MV88E2010;

	return phyType;

}