root/drivers/net/ethernet/chelsio/cxgb3/vsc8211.c
/*
 * Copyright (c) 2005-2008 Chelsio, Inc. All rights reserved.
 *
 * This software is available to you under a choice of one of two
 * licenses.  You may choose to be licensed under the terms of the GNU
 * General Public License (GPL) Version 2, available from the file
 * COPYING in the main directory of this source tree, or the
 * OpenIB.org BSD license below:
 *
 *     Redistribution and use in source and binary forms, with or
 *     without modification, are permitted provided that the following
 *     conditions are met:
 *
 *      - Redistributions of source code must retain the above
 *        copyright notice, this list of conditions and the following
 *        disclaimer.
 *
 *      - Redistributions in binary form must reproduce the above
 *        copyright notice, this list of conditions and the following
 *        disclaimer in the documentation and/or other materials
 *        provided with the distribution.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
 * SOFTWARE.
 */
#include "common.h"

/* 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_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)

/* PHY specific auxiliary control & status register fields */
#define S_ACSR_ACTIPHY_TMR    0
#define M_ACSR_ACTIPHY_TMR    0x3
#define V_ACSR_ACTIPHY_TMR(x) ((x) << S_ACSR_ACTIPHY_TMR)

#define S_ACSR_SPEED    3
#define M_ACSR_SPEED    0x3
#define G_ACSR_SPEED(x) (((x) >> S_ACSR_SPEED) & M_ACSR_SPEED)

#define S_ACSR_DUPLEX 5
#define F_ACSR_DUPLEX (1 << S_ACSR_DUPLEX)

#define S_ACSR_ACTIPHY 6
#define F_ACSR_ACTIPHY (1 << S_ACSR_ACTIPHY)

/*
 * Reset the PHY.  This PHY completes reset immediately so we never wait.
 */
static int vsc8211_reset(struct cphy *cphy, int wait)
{
        return t3_phy_reset(cphy, MDIO_DEVAD_NONE, 0);
}

static int vsc8211_intr_enable(struct cphy *cphy)
{
        return t3_mdio_write(cphy, MDIO_DEVAD_NONE, VSC8211_INTR_ENABLE,
                             INTR_MASK);
}

static int vsc8211_intr_disable(struct cphy *cphy)
{
        return t3_mdio_write(cphy, MDIO_DEVAD_NONE, VSC8211_INTR_ENABLE, 0);
}

static int vsc8211_intr_clear(struct cphy *cphy)
{
        u32 val;

        /* Clear PHY interrupts by reading the register. */
        return t3_mdio_read(cphy, MDIO_DEVAD_NONE, VSC8211_INTR_STATUS, &val);
}

static int vsc8211_autoneg_enable(struct cphy *cphy)
{
        return t3_mdio_change_bits(cphy, MDIO_DEVAD_NONE, MII_BMCR,
                                   BMCR_PDOWN | BMCR_ISOLATE,
                                   BMCR_ANENABLE | BMCR_ANRESTART);
}

static int vsc8211_autoneg_restart(struct cphy *cphy)
{
        return t3_mdio_change_bits(cphy, MDIO_DEVAD_NONE, MII_BMCR,
                                   BMCR_PDOWN | BMCR_ISOLATE,
                                   BMCR_ANRESTART);
}

static int vsc8211_get_link_status(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 = t3_mdio_read(cphy, MDIO_DEVAD_NONE, MII_BMCR, &bmcr);
        if (!err)
                err = t3_mdio_read(cphy, MDIO_DEVAD_NONE, 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 = t3_mdio_read(cphy, MDIO_DEVAD_NONE, 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 = t3_mdio_read(cphy, MDIO_DEVAD_NONE, VSC8211_AUX_CTRL_STAT,
                                   &status);
                if (err)
                        return err;

                dplx = (status & F_ACSR_DUPLEX) ? DUPLEX_FULL : DUPLEX_HALF;
                sp = G_ACSR_SPEED(status);
                if (sp == 0)
                        sp = SPEED_10;
                else if (sp == 1)
                        sp = SPEED_100;
                else
                        sp = SPEED_1000;

                if (fc && dplx == DUPLEX_FULL) {
                        err = t3_mdio_read(cphy, MDIO_DEVAD_NONE, MII_LPA,
                                           &lpa);
                        if (!err)
                                err = t3_mdio_read(cphy, MDIO_DEVAD_NONE,
                                                   MII_ADVERTISE, &adv);
                        if (err)
                                return err;

                        if (lpa & adv & ADVERTISE_PAUSE_CAP)
                                pause = PAUSE_RX | PAUSE_TX;
                        else if ((lpa & ADVERTISE_PAUSE_CAP) &&
                                 (lpa & ADVERTISE_PAUSE_ASYM) &&
                                 (adv & ADVERTISE_PAUSE_ASYM))
                                pause = PAUSE_TX;
                        else if ((lpa & ADVERTISE_PAUSE_ASYM) &&
                                 (adv & ADVERTISE_PAUSE_CAP))
                                pause = PAUSE_RX;
                }
        }
        if (speed)
                *speed = sp;
        if (duplex)
                *duplex = dplx;
        if (fc)
                *fc = pause;
        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 = t3_mdio_read(cphy, MDIO_DEVAD_NONE, MII_BMCR, &bmcr);
        if (!err)
                err = t3_mdio_read(cphy, MDIO_DEVAD_NONE, 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 = t3_mdio_read(cphy, MDIO_DEVAD_NONE, 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 = t3_mdio_read(cphy, MDIO_DEVAD_NONE, MII_LPA, &lpa);
                if (!err)
                        err = t3_mdio_read(cphy, MDIO_DEVAD_NONE, 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;
}

#ifdef UNUSED
/*
 * Enable/disable auto MDI/MDI-X in forced link speed mode.
 */
static int vsc8211_set_automdi(struct cphy *phy, int enable)
{
        int err;

        err = t3_mdio_write(phy, MDIO_DEVAD_NONE, VSC8211_EXT_PAGE_AXS, 0x52b5);
        if (err)
                return err;

        err = t3_mdio_write(phy, MDIO_DEVAD_NONE, 18, 0x12);
        if (err)
                return err;

        err = t3_mdio_write(phy, MDIO_DEVAD_NONE, 17, enable ? 0x2803 : 0x3003);
        if (err)
                return err;

        err = t3_mdio_write(phy, MDIO_DEVAD_NONE, 16, 0x87fa);
        if (err)
                return err;

        err = t3_mdio_write(phy, MDIO_DEVAD_NONE, 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;
}
#endif /* UNUSED */

static int vsc8211_power_down(struct cphy *cphy, int enable)
{
        return t3_mdio_change_bits(cphy, 0, MII_BMCR, BMCR_PDOWN,
                                   enable ? BMCR_PDOWN : 0);
}

static int vsc8211_intr_handler(struct cphy *cphy)
{
        unsigned int cause;
        int err, cphy_cause = 0;

        err = t3_mdio_read(cphy, MDIO_DEVAD_NONE, VSC8211_INTR_STATUS, &cause);
        if (err)
                return err;

        cause &= INTR_MASK;
        if (cause & CFG_CHG_INTR_MASK)
                cphy_cause |= cphy_cause_link_change;
        if (cause & (VSC_INTR_RX_FIFO | VSC_INTR_TX_FIFO))
                cphy_cause |= cphy_cause_fifo_error;
        return cphy_cause;
}

static const struct cphy_ops vsc8211_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,
        .set_speed_duplex = t3_set_phy_speed_duplex,
        .get_link_status = vsc8211_get_link_status,
        .power_down = vsc8211_power_down,
};

static const 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 = t3_mdio_read(phy, MDIO_DEVAD_NONE, VSC8211_EXT_CTRL, &val);
        if (err)
                return err;
        if (val & VSC_CTRL_MEDIA_MODE_HI) {
                /* copper interface, just need to configure the LEDs */
                return t3_mdio_write(phy, MDIO_DEVAD_NONE, 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 = t3_mdio_write(phy, MDIO_DEVAD_NONE, VSC8211_EXT_PAGE_AXS, 1);
        if (err)
                return err;

        err = t3_mdio_write(phy, MDIO_DEVAD_NONE, VSC8211_SIGDET_CTRL, 1);
        if (err)
                return err;

        err = t3_mdio_write(phy, MDIO_DEVAD_NONE, VSC8211_EXT_PAGE_AXS, 0);
        if (err)
                return err;

        err = t3_mdio_write(phy, MDIO_DEVAD_NONE, 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;
}