|  | /* | 
|  | * Driver for Vitesse PHYs | 
|  | * | 
|  | * Author: Kriston Carson | 
|  | * | 
|  | * Copyright (c) 2005, 2009, 2011 Freescale Semiconductor, Inc. | 
|  | * | 
|  | * This program is free software; you can redistribute  it and/or modify it | 
|  | * under  the terms of  the GNU General  Public License as published by the | 
|  | * Free Software Foundation;  either version 2 of the  License, or (at your | 
|  | * option) any later version. | 
|  | * | 
|  | */ | 
|  |  | 
|  | #include <linux/kernel.h> | 
|  | #include <linux/module.h> | 
|  | #include <linux/mii.h> | 
|  | #include <linux/ethtool.h> | 
|  | #include <linux/phy.h> | 
|  |  | 
|  | /* Vitesse Extended Page Magic Register(s) */ | 
|  | #define MII_VSC82X4_EXT_PAGE_16E	0x10 | 
|  | #define MII_VSC82X4_EXT_PAGE_17E	0x11 | 
|  | #define MII_VSC82X4_EXT_PAGE_18E	0x12 | 
|  |  | 
|  | /* Vitesse Extended Control Register 1 */ | 
|  | #define MII_VSC8244_EXT_CON1           0x17 | 
|  | #define MII_VSC8244_EXTCON1_INIT       0x0000 | 
|  | #define MII_VSC8244_EXTCON1_TX_SKEW_MASK	0x0c00 | 
|  | #define MII_VSC8244_EXTCON1_RX_SKEW_MASK	0x0300 | 
|  | #define MII_VSC8244_EXTCON1_TX_SKEW	0x0800 | 
|  | #define MII_VSC8244_EXTCON1_RX_SKEW	0x0200 | 
|  |  | 
|  | /* Vitesse Interrupt Mask Register */ | 
|  | #define MII_VSC8244_IMASK		0x19 | 
|  | #define MII_VSC8244_IMASK_IEN		0x8000 | 
|  | #define MII_VSC8244_IMASK_SPEED		0x4000 | 
|  | #define MII_VSC8244_IMASK_LINK		0x2000 | 
|  | #define MII_VSC8244_IMASK_DUPLEX	0x1000 | 
|  | #define MII_VSC8244_IMASK_MASK		0xf000 | 
|  |  | 
|  | #define MII_VSC8221_IMASK_MASK		0xa000 | 
|  |  | 
|  | /* Vitesse Interrupt Status Register */ | 
|  | #define MII_VSC8244_ISTAT		0x1a | 
|  | #define MII_VSC8244_ISTAT_STATUS	0x8000 | 
|  | #define MII_VSC8244_ISTAT_SPEED		0x4000 | 
|  | #define MII_VSC8244_ISTAT_LINK		0x2000 | 
|  | #define MII_VSC8244_ISTAT_DUPLEX	0x1000 | 
|  |  | 
|  | /* Vitesse Auxiliary Control/Status Register */ | 
|  | #define MII_VSC8244_AUX_CONSTAT		0x1c | 
|  | #define MII_VSC8244_AUXCONSTAT_INIT	0x0000 | 
|  | #define MII_VSC8244_AUXCONSTAT_DUPLEX	0x0020 | 
|  | #define MII_VSC8244_AUXCONSTAT_SPEED	0x0018 | 
|  | #define MII_VSC8244_AUXCONSTAT_GBIT	0x0010 | 
|  | #define MII_VSC8244_AUXCONSTAT_100	0x0008 | 
|  |  | 
|  | #define MII_VSC8221_AUXCONSTAT_INIT	0x0004 /* need to set this bit? */ | 
|  | #define MII_VSC8221_AUXCONSTAT_RESERVED	0x0004 | 
|  |  | 
|  | /* Vitesse Extended Page Access Register */ | 
|  | #define MII_VSC82X4_EXT_PAGE_ACCESS	0x1f | 
|  |  | 
|  | #define PHY_ID_VSC8234			0x000fc620 | 
|  | #define PHY_ID_VSC8244			0x000fc6c0 | 
|  | #define PHY_ID_VSC8514			0x00070670 | 
|  | #define PHY_ID_VSC8574			0x000704a0 | 
|  | #define PHY_ID_VSC8601			0x00070420 | 
|  | #define PHY_ID_VSC8662			0x00070660 | 
|  | #define PHY_ID_VSC8221			0x000fc550 | 
|  | #define PHY_ID_VSC8211			0x000fc4b0 | 
|  |  | 
|  | MODULE_DESCRIPTION("Vitesse PHY driver"); | 
|  | MODULE_AUTHOR("Kriston Carson"); | 
|  | MODULE_LICENSE("GPL"); | 
|  |  | 
|  | static int vsc824x_add_skew(struct phy_device *phydev) | 
|  | { | 
|  | int err; | 
|  | int extcon; | 
|  |  | 
|  | extcon = phy_read(phydev, MII_VSC8244_EXT_CON1); | 
|  |  | 
|  | if (extcon < 0) | 
|  | return extcon; | 
|  |  | 
|  | extcon &= ~(MII_VSC8244_EXTCON1_TX_SKEW_MASK | | 
|  | MII_VSC8244_EXTCON1_RX_SKEW_MASK); | 
|  |  | 
|  | extcon |= (MII_VSC8244_EXTCON1_TX_SKEW | | 
|  | MII_VSC8244_EXTCON1_RX_SKEW); | 
|  |  | 
|  | err = phy_write(phydev, MII_VSC8244_EXT_CON1, extcon); | 
|  |  | 
|  | return err; | 
|  | } | 
|  |  | 
|  | static int vsc824x_config_init(struct phy_device *phydev) | 
|  | { | 
|  | int err; | 
|  |  | 
|  | err = phy_write(phydev, MII_VSC8244_AUX_CONSTAT, | 
|  | MII_VSC8244_AUXCONSTAT_INIT); | 
|  | if (err < 0) | 
|  | return err; | 
|  |  | 
|  | if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID) | 
|  | err = vsc824x_add_skew(phydev); | 
|  |  | 
|  | return err; | 
|  | } | 
|  |  | 
|  | static int vsc824x_ack_interrupt(struct phy_device *phydev) | 
|  | { | 
|  | int err = 0; | 
|  |  | 
|  | /* Don't bother to ACK the interrupts if interrupts | 
|  | * are disabled.  The 824x cannot clear the interrupts | 
|  | * if they are disabled. | 
|  | */ | 
|  | if (phydev->interrupts == PHY_INTERRUPT_ENABLED) | 
|  | err = phy_read(phydev, MII_VSC8244_ISTAT); | 
|  |  | 
|  | return (err < 0) ? err : 0; | 
|  | } | 
|  |  | 
|  | static int vsc82xx_config_intr(struct phy_device *phydev) | 
|  | { | 
|  | int err; | 
|  |  | 
|  | if (phydev->interrupts == PHY_INTERRUPT_ENABLED) | 
|  | err = phy_write(phydev, MII_VSC8244_IMASK, | 
|  | (phydev->drv->phy_id == PHY_ID_VSC8234 || | 
|  | phydev->drv->phy_id == PHY_ID_VSC8244 || | 
|  | phydev->drv->phy_id == PHY_ID_VSC8514 || | 
|  | phydev->drv->phy_id == PHY_ID_VSC8574 || | 
|  | phydev->drv->phy_id == PHY_ID_VSC8601) ? | 
|  | MII_VSC8244_IMASK_MASK : | 
|  | MII_VSC8221_IMASK_MASK); | 
|  | else { | 
|  | /* The Vitesse PHY cannot clear the interrupt | 
|  | * once it has disabled them, so we clear them first | 
|  | */ | 
|  | err = phy_read(phydev, MII_VSC8244_ISTAT); | 
|  |  | 
|  | if (err < 0) | 
|  | return err; | 
|  |  | 
|  | err = phy_write(phydev, MII_VSC8244_IMASK, 0); | 
|  | } | 
|  |  | 
|  | return err; | 
|  | } | 
|  |  | 
|  | static int vsc8221_config_init(struct phy_device *phydev) | 
|  | { | 
|  | int err; | 
|  |  | 
|  | err = phy_write(phydev, MII_VSC8244_AUX_CONSTAT, | 
|  | MII_VSC8221_AUXCONSTAT_INIT); | 
|  | return err; | 
|  |  | 
|  | /* Perhaps we should set EXT_CON1 based on the interface? | 
|  | * Options are 802.3Z SerDes or SGMII | 
|  | */ | 
|  | } | 
|  |  | 
|  | /* vsc82x4_config_autocross_enable - Enable auto MDI/MDI-X for forced links | 
|  | * @phydev: target phy_device struct | 
|  | * | 
|  | * Enable auto MDI/MDI-X when in 10/100 forced link speeds by writing | 
|  | * special values in the VSC8234/VSC8244 extended reserved registers | 
|  | */ | 
|  | static int vsc82x4_config_autocross_enable(struct phy_device *phydev) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | if (phydev->autoneg == AUTONEG_ENABLE || phydev->speed > SPEED_100) | 
|  | return 0; | 
|  |  | 
|  | /* map extended registers set 0x10 - 0x1e */ | 
|  | ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_ACCESS, 0x52b5); | 
|  | if (ret >= 0) | 
|  | ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_18E, 0x0012); | 
|  | if (ret >= 0) | 
|  | ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_17E, 0x2803); | 
|  | if (ret >= 0) | 
|  | ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_16E, 0x87fa); | 
|  | /* map standard registers set 0x10 - 0x1e */ | 
|  | if (ret >= 0) | 
|  | ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_ACCESS, 0x0000); | 
|  | else | 
|  | phy_write(phydev, MII_VSC82X4_EXT_PAGE_ACCESS, 0x0000); | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | /* vsc82x4_config_aneg - restart auto-negotiation or write BMCR | 
|  | * @phydev: target phy_device struct | 
|  | * | 
|  | * Description: If auto-negotiation is enabled, we configure the | 
|  | *   advertising, and then restart auto-negotiation.  If it is not | 
|  | *   enabled, then we write the BMCR and also start the auto | 
|  | *   MDI/MDI-X feature | 
|  | */ | 
|  | static int vsc82x4_config_aneg(struct phy_device *phydev) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | /* Enable auto MDI/MDI-X when in 10/100 forced link speeds by | 
|  | * writing special values in the VSC8234 extended reserved registers | 
|  | */ | 
|  | if (phydev->autoneg != AUTONEG_ENABLE && phydev->speed <= SPEED_100) { | 
|  | ret = genphy_setup_forced(phydev); | 
|  |  | 
|  | if (ret < 0) /* error */ | 
|  | return ret; | 
|  |  | 
|  | return vsc82x4_config_autocross_enable(phydev); | 
|  | } | 
|  |  | 
|  | return genphy_config_aneg(phydev); | 
|  | } | 
|  |  | 
|  | /* Vitesse 82xx */ | 
|  | static struct phy_driver vsc82xx_driver[] = { | 
|  | { | 
|  | .phy_id         = PHY_ID_VSC8234, | 
|  | .name           = "Vitesse VSC8234", | 
|  | .phy_id_mask    = 0x000ffff0, | 
|  | .features       = PHY_GBIT_FEATURES, | 
|  | .flags          = PHY_HAS_INTERRUPT, | 
|  | .config_init    = &vsc824x_config_init, | 
|  | .config_aneg    = &vsc82x4_config_aneg, | 
|  | .read_status    = &genphy_read_status, | 
|  | .ack_interrupt  = &vsc824x_ack_interrupt, | 
|  | .config_intr    = &vsc82xx_config_intr, | 
|  | }, { | 
|  | .phy_id		= PHY_ID_VSC8244, | 
|  | .name		= "Vitesse VSC8244", | 
|  | .phy_id_mask	= 0x000fffc0, | 
|  | .features	= PHY_GBIT_FEATURES, | 
|  | .flags		= PHY_HAS_INTERRUPT, | 
|  | .config_init	= &vsc824x_config_init, | 
|  | .config_aneg	= &vsc82x4_config_aneg, | 
|  | .read_status	= &genphy_read_status, | 
|  | .ack_interrupt	= &vsc824x_ack_interrupt, | 
|  | .config_intr	= &vsc82xx_config_intr, | 
|  | }, { | 
|  | .phy_id		= PHY_ID_VSC8514, | 
|  | .name		= "Vitesse VSC8514", | 
|  | .phy_id_mask	= 0x000ffff0, | 
|  | .features	= PHY_GBIT_FEATURES, | 
|  | .flags		= PHY_HAS_INTERRUPT, | 
|  | .config_init	= &vsc824x_config_init, | 
|  | .config_aneg	= &vsc82x4_config_aneg, | 
|  | .read_status	= &genphy_read_status, | 
|  | .ack_interrupt	= &vsc824x_ack_interrupt, | 
|  | .config_intr	= &vsc82xx_config_intr, | 
|  | }, { | 
|  | .phy_id         = PHY_ID_VSC8574, | 
|  | .name           = "Vitesse VSC8574", | 
|  | .phy_id_mask    = 0x000ffff0, | 
|  | .features       = PHY_GBIT_FEATURES, | 
|  | .flags          = PHY_HAS_INTERRUPT, | 
|  | .config_init    = &vsc824x_config_init, | 
|  | .config_aneg    = &vsc82x4_config_aneg, | 
|  | .read_status    = &genphy_read_status, | 
|  | .ack_interrupt  = &vsc824x_ack_interrupt, | 
|  | .config_intr    = &vsc82xx_config_intr, | 
|  | }, { | 
|  | .phy_id         = PHY_ID_VSC8601, | 
|  | .name           = "Vitesse VSC8601", | 
|  | .phy_id_mask    = 0x000ffff0, | 
|  | .features       = PHY_GBIT_FEATURES, | 
|  | .flags          = PHY_HAS_INTERRUPT, | 
|  | .config_init    = &genphy_config_init, | 
|  | .config_aneg    = &genphy_config_aneg, | 
|  | .read_status    = &genphy_read_status, | 
|  | .ack_interrupt  = &vsc824x_ack_interrupt, | 
|  | .config_intr    = &vsc82xx_config_intr, | 
|  | }, { | 
|  | .phy_id         = PHY_ID_VSC8662, | 
|  | .name           = "Vitesse VSC8662", | 
|  | .phy_id_mask    = 0x000ffff0, | 
|  | .features       = PHY_GBIT_FEATURES, | 
|  | .flags          = PHY_HAS_INTERRUPT, | 
|  | .config_init    = &vsc824x_config_init, | 
|  | .config_aneg    = &vsc82x4_config_aneg, | 
|  | .read_status    = &genphy_read_status, | 
|  | .ack_interrupt  = &vsc824x_ack_interrupt, | 
|  | .config_intr    = &vsc82xx_config_intr, | 
|  | }, { | 
|  | /* Vitesse 8221 */ | 
|  | .phy_id		= PHY_ID_VSC8221, | 
|  | .phy_id_mask	= 0x000ffff0, | 
|  | .name		= "Vitesse VSC8221", | 
|  | .features	= PHY_GBIT_FEATURES, | 
|  | .flags		= PHY_HAS_INTERRUPT, | 
|  | .config_init	= &vsc8221_config_init, | 
|  | .config_aneg	= &genphy_config_aneg, | 
|  | .read_status	= &genphy_read_status, | 
|  | .ack_interrupt	= &vsc824x_ack_interrupt, | 
|  | .config_intr	= &vsc82xx_config_intr, | 
|  | }, { | 
|  | /* Vitesse 8211 */ | 
|  | .phy_id		= PHY_ID_VSC8211, | 
|  | .phy_id_mask	= 0x000ffff0, | 
|  | .name		= "Vitesse VSC8211", | 
|  | .features	= PHY_GBIT_FEATURES, | 
|  | .flags		= PHY_HAS_INTERRUPT, | 
|  | .config_init	= &vsc8221_config_init, | 
|  | .config_aneg	= &genphy_config_aneg, | 
|  | .read_status	= &genphy_read_status, | 
|  | .ack_interrupt	= &vsc824x_ack_interrupt, | 
|  | .config_intr	= &vsc82xx_config_intr, | 
|  | } }; | 
|  |  | 
|  | module_phy_driver(vsc82xx_driver); | 
|  |  | 
|  | static struct mdio_device_id __maybe_unused vitesse_tbl[] = { | 
|  | { PHY_ID_VSC8234, 0x000ffff0 }, | 
|  | { PHY_ID_VSC8244, 0x000fffc0 }, | 
|  | { PHY_ID_VSC8514, 0x000ffff0 }, | 
|  | { PHY_ID_VSC8574, 0x000ffff0 }, | 
|  | { PHY_ID_VSC8662, 0x000ffff0 }, | 
|  | { PHY_ID_VSC8221, 0x000ffff0 }, | 
|  | { PHY_ID_VSC8211, 0x000ffff0 }, | 
|  | { } | 
|  | }; | 
|  |  | 
|  | MODULE_DEVICE_TABLE(mdio, vitesse_tbl); |