+++ /dev/null
-Commit-Id: 0ce2f03bade2046d6eb6184d52d065688382d7bd
-From: Divy Le Ray <divy@chelsio.com>
-Date: Wed, 8 Oct 2008 17:40:28 -0700
-Acked-by: Karsten Keil <kkeil@novell.com>
-Subject: [PATCH] cxgb3: Add 1G fiber support
-Reference: bnc#446739
-
-
-Add support for 1G optical Vitesse PHY.
-
-Signed-off-by: Divy Le Ray <divy@chelsio.com>
-Signed-off-by: David S. Miller <davem@davemloft.net>
-
-Index: linux-2.6.27/drivers/net/cxgb3/common.h
-===================================================================
---- linux-2.6.27.orig/drivers/net/cxgb3/common.h
-+++ linux-2.6.27/drivers/net/cxgb3/common.h
-@@ -691,6 +691,7 @@ int t3_mdio_change_bits(struct cphy *phy
- unsigned int set);
- int t3_phy_reset(struct cphy *phy, int mmd, int wait);
- int t3_phy_advertise(struct cphy *phy, unsigned int advert);
-+int t3_phy_advertise_fiber(struct cphy *phy, unsigned int advert);
- int t3_set_phy_speed_duplex(struct cphy *phy, int speed, int duplex);
- int t3_phy_lasi_intr_enable(struct cphy *phy);
- int t3_phy_lasi_intr_disable(struct cphy *phy);
-Index: linux-2.6.27/drivers/net/cxgb3/t3_hw.c
-===================================================================
---- linux-2.6.27.orig/drivers/net/cxgb3/t3_hw.c
-+++ linux-2.6.27/drivers/net/cxgb3/t3_hw.c
-@@ -408,6 +408,29 @@ int t3_phy_advertise(struct cphy *phy, u
- }
-
- /**
-+ * t3_phy_advertise_fiber - set fiber PHY advertisement register
-+ * @phy: the PHY to operate on
-+ * @advert: bitmap of capabilities the PHY should advertise
-+ *
-+ * Sets a fiber PHY's advertisement register to advertise the
-+ * requested capabilities.
-+ */
-+int t3_phy_advertise_fiber(struct cphy *phy, unsigned int advert)
-+{
-+ unsigned int val = 0;
-+
-+ if (advert & ADVERTISED_1000baseT_Half)
-+ val |= ADVERTISE_1000XHALF;
-+ if (advert & ADVERTISED_1000baseT_Full)
-+ val |= ADVERTISE_1000XFULL;
-+ if (advert & ADVERTISED_Pause)
-+ val |= ADVERTISE_1000XPAUSE;
-+ if (advert & ADVERTISED_Asym_Pause)
-+ val |= ADVERTISE_1000XPSE_ASYM;
-+ return mdio_write(phy, 0, MII_ADVERTISE, val);
-+}
-+
-+/**
- * t3_set_phy_speed_duplex - force PHY speed and duplex
- * @phy: the PHY to operate on
- * @speed: requested PHY speed
-Index: linux-2.6.27/drivers/net/cxgb3/vsc8211.c
-===================================================================
---- linux-2.6.27.orig/drivers/net/cxgb3/vsc8211.c
-+++ linux-2.6.27/drivers/net/cxgb3/vsc8211.c
-@@ -33,28 +33,40 @@
-
- /* VSC8211 PHY specific registers. */
- enum {
-+ VSC8211_SIGDET_CTRL = 19,
-+ VSC8211_EXT_CTRL = 23,
- VSC8211_INTR_ENABLE = 25,
- VSC8211_INTR_STATUS = 26,
-+ VSC8211_LED_CTRL = 27,
- VSC8211_AUX_CTRL_STAT = 28,
-+ VSC8211_EXT_PAGE_AXS = 31,
- };
-
- enum {
- VSC_INTR_RX_ERR = 1 << 0,
-- VSC_INTR_MS_ERR = 1 << 1, /* master/slave resolution error */
-- VSC_INTR_CABLE = 1 << 2, /* cable impairment */
-- VSC_INTR_FALSE_CARR = 1 << 3, /* false carrier */
-- VSC_INTR_MEDIA_CHG = 1 << 4, /* AMS media change */
-- VSC_INTR_RX_FIFO = 1 << 5, /* Rx FIFO over/underflow */
-- VSC_INTR_TX_FIFO = 1 << 6, /* Tx FIFO over/underflow */
-- VSC_INTR_DESCRAMBL = 1 << 7, /* descrambler lock-lost */
-- VSC_INTR_SYMBOL_ERR = 1 << 8, /* symbol error */
-- VSC_INTR_NEG_DONE = 1 << 10, /* autoneg done */
-- VSC_INTR_NEG_ERR = 1 << 11, /* autoneg error */
-- VSC_INTR_LINK_CHG = 1 << 13, /* link change */
-- VSC_INTR_ENABLE = 1 << 15, /* interrupt enable */
-+ VSC_INTR_MS_ERR = 1 << 1, /* master/slave resolution error */
-+ VSC_INTR_CABLE = 1 << 2, /* cable impairment */
-+ VSC_INTR_FALSE_CARR = 1 << 3, /* false carrier */
-+ VSC_INTR_MEDIA_CHG = 1 << 4, /* AMS media change */
-+ VSC_INTR_RX_FIFO = 1 << 5, /* Rx FIFO over/underflow */
-+ VSC_INTR_TX_FIFO = 1 << 6, /* Tx FIFO over/underflow */
-+ VSC_INTR_DESCRAMBL = 1 << 7, /* descrambler lock-lost */
-+ VSC_INTR_SYMBOL_ERR = 1 << 8, /* symbol error */
-+ VSC_INTR_NEG_DONE = 1 << 10, /* autoneg done */
-+ VSC_INTR_NEG_ERR = 1 << 11, /* autoneg error */
-+ VSC_INTR_DPLX_CHG = 1 << 12, /* duplex change */
-+ VSC_INTR_LINK_CHG = 1 << 13, /* link change */
-+ VSC_INTR_SPD_CHG = 1 << 14, /* speed change */
-+ VSC_INTR_ENABLE = 1 << 15, /* interrupt enable */
-+};
-+
-+enum {
-+ VSC_CTRL_CLAUSE37_VIEW = 1 << 4, /* Switch to Clause 37 view */
-+ VSC_CTRL_MEDIA_MODE_HI = 0xf000 /* High part of media mode select */
- };
-
- #define CFG_CHG_INTR_MASK (VSC_INTR_LINK_CHG | VSC_INTR_NEG_ERR | \
-+ VSC_INTR_DPLX_CHG | VSC_INTR_SPD_CHG | \
- VSC_INTR_NEG_DONE)
- #define INTR_MASK (CFG_CHG_INTR_MASK | VSC_INTR_TX_FIFO | VSC_INTR_RX_FIFO | \
- VSC_INTR_ENABLE)
-@@ -184,6 +196,112 @@ static int vsc8211_get_link_status(struc
- return 0;
- }
-
-+static int vsc8211_get_link_status_fiber(struct cphy *cphy, int *link_ok,
-+ int *speed, int *duplex, int *fc)
-+{
-+ unsigned int bmcr, status, lpa, adv;
-+ int err, sp = -1, dplx = -1, pause = 0;
-+
-+ err = mdio_read(cphy, 0, MII_BMCR, &bmcr);
-+ if (!err)
-+ err = mdio_read(cphy, 0, MII_BMSR, &status);
-+ if (err)
-+ return err;
-+
-+ if (link_ok) {
-+ /*
-+ * BMSR_LSTATUS is latch-low, so if it is 0 we need to read it
-+ * once more to get the current link state.
-+ */
-+ if (!(status & BMSR_LSTATUS))
-+ err = mdio_read(cphy, 0, MII_BMSR, &status);
-+ if (err)
-+ return err;
-+ *link_ok = (status & BMSR_LSTATUS) != 0;
-+ }
-+ if (!(bmcr & BMCR_ANENABLE)) {
-+ dplx = (bmcr & BMCR_FULLDPLX) ? DUPLEX_FULL : DUPLEX_HALF;
-+ if (bmcr & BMCR_SPEED1000)
-+ sp = SPEED_1000;
-+ else if (bmcr & BMCR_SPEED100)
-+ sp = SPEED_100;
-+ else
-+ sp = SPEED_10;
-+ } else if (status & BMSR_ANEGCOMPLETE) {
-+ err = mdio_read(cphy, 0, MII_LPA, &lpa);
-+ if (!err)
-+ err = mdio_read(cphy, 0, MII_ADVERTISE, &adv);
-+ if (err)
-+ return err;
-+
-+ if (adv & lpa & ADVERTISE_1000XFULL) {
-+ dplx = DUPLEX_FULL;
-+ sp = SPEED_1000;
-+ } else if (adv & lpa & ADVERTISE_1000XHALF) {
-+ dplx = DUPLEX_HALF;
-+ sp = SPEED_1000;
-+ }
-+
-+ if (fc && dplx == DUPLEX_FULL) {
-+ if (lpa & adv & ADVERTISE_1000XPAUSE)
-+ pause = PAUSE_RX | PAUSE_TX;
-+ else if ((lpa & ADVERTISE_1000XPAUSE) &&
-+ (adv & lpa & ADVERTISE_1000XPSE_ASYM))
-+ pause = PAUSE_TX;
-+ else if ((lpa & ADVERTISE_1000XPSE_ASYM) &&
-+ (adv & ADVERTISE_1000XPAUSE))
-+ pause = PAUSE_RX;
-+ }
-+ }
-+ if (speed)
-+ *speed = sp;
-+ if (duplex)
-+ *duplex = dplx;
-+ if (fc)
-+ *fc = pause;
-+ return 0;
-+}
-+
-+/*
-+ * Enable/disable auto MDI/MDI-X in forced link speed mode.
-+ */
-+static int vsc8211_set_automdi(struct cphy *phy, int enable)
-+{
-+ int err;
-+
-+ err = mdio_write(phy, 0, VSC8211_EXT_PAGE_AXS, 0x52b5);
-+ if (err)
-+ return err;
-+
-+ err = mdio_write(phy, 0, 18, 0x12);
-+ if (err)
-+ return err;
-+
-+ err = mdio_write(phy, 0, 17, enable ? 0x2803 : 0x3003);
-+ if (err)
-+ return err;
-+
-+ err = mdio_write(phy, 0, 16, 0x87fa);
-+ if (err)
-+ return err;
-+
-+ err = mdio_write(phy, 0, VSC8211_EXT_PAGE_AXS, 0);
-+ if (err)
-+ return err;
-+
-+ return 0;
-+}
-+
-+int vsc8211_set_speed_duplex(struct cphy *phy, int speed, int duplex)
-+{
-+ int err;
-+
-+ err = t3_set_phy_speed_duplex(phy, speed, duplex);
-+ if (!err)
-+ err = vsc8211_set_automdi(phy, 1);
-+ return err;
-+}
-+
- static int vsc8211_power_down(struct cphy *cphy, int enable)
- {
- return t3_mdio_change_bits(cphy, 0, MII_BMCR, BMCR_PDOWN,
-@@ -221,12 +339,66 @@ static struct cphy_ops vsc8211_ops = {
- .power_down = vsc8211_power_down,
- };
-
-+static struct cphy_ops vsc8211_fiber_ops = {
-+ .reset = vsc8211_reset,
-+ .intr_enable = vsc8211_intr_enable,
-+ .intr_disable = vsc8211_intr_disable,
-+ .intr_clear = vsc8211_intr_clear,
-+ .intr_handler = vsc8211_intr_handler,
-+ .autoneg_enable = vsc8211_autoneg_enable,
-+ .autoneg_restart = vsc8211_autoneg_restart,
-+ .advertise = t3_phy_advertise_fiber,
-+ .set_speed_duplex = t3_set_phy_speed_duplex,
-+ .get_link_status = vsc8211_get_link_status_fiber,
-+ .power_down = vsc8211_power_down,
-+};
-+
- int t3_vsc8211_phy_prep(struct cphy *phy, struct adapter *adapter,
- int phy_addr, const struct mdio_ops *mdio_ops)
- {
-+ int err;
-+ unsigned int val;
-+
- cphy_init(phy, adapter, phy_addr, &vsc8211_ops, mdio_ops,
- SUPPORTED_10baseT_Full | SUPPORTED_100baseT_Full |
- SUPPORTED_1000baseT_Full | SUPPORTED_Autoneg | SUPPORTED_MII |
- SUPPORTED_TP | SUPPORTED_IRQ, "10/100/1000BASE-T");
-+ msleep(20); /* PHY needs ~10ms to start responding to MDIO */
-+
-+ err = mdio_read(phy, 0, VSC8211_EXT_CTRL, &val);
-+ if (err)
-+ return err;
-+ if (val & VSC_CTRL_MEDIA_MODE_HI) {
-+ /* copper interface, just need to configure the LEDs */
-+ return mdio_write(phy, 0, VSC8211_LED_CTRL, 0x100);
-+ }
-+
-+ phy->caps = SUPPORTED_1000baseT_Full | SUPPORTED_Autoneg |
-+ SUPPORTED_MII | SUPPORTED_FIBRE | SUPPORTED_IRQ;
-+ phy->desc = "1000BASE-X";
-+ phy->ops = &vsc8211_fiber_ops;
-+
-+ err = mdio_write(phy, 0, VSC8211_EXT_PAGE_AXS, 1);
-+ if (err)
-+ return err;
-+
-+ err = mdio_write(phy, 0, VSC8211_SIGDET_CTRL, 1);
-+ if (err)
-+ return err;
-+
-+ err = mdio_write(phy, 0, VSC8211_EXT_PAGE_AXS, 0);
-+ if (err)
-+ return err;
-+
-+ err = mdio_write(phy, 0, VSC8211_EXT_CTRL,
-+ val | VSC_CTRL_CLAUSE37_VIEW);
-+ if (err)
-+ return err;
-+
-+ err = vsc8211_reset(phy, 0);
-+ if (err)
-+ return err;
-+
-+ udelay(5); /* delay after reset before next SMI */
- return 0;
- }