| /* | |
| * drivers/net/phy/marvell.c | |
| * | |
| * Driver for Marvell PHYs | |
| * | |
| * Author: Andy Fleming | |
| * | |
| * Copyright (c) 2004 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/string.h> | |
| #include <linux/errno.h> | |
| #include <linux/unistd.h> | |
| #include <linux/interrupt.h> | |
| #include <linux/init.h> | |
| #include <linux/delay.h> | |
| #include <linux/netdevice.h> | |
| #include <linux/etherdevice.h> | |
| #include <linux/skbuff.h> | |
| #include <linux/spinlock.h> | |
| #include <linux/mm.h> | |
| #include <linux/module.h> | |
| #include <linux/mii.h> | |
| #include <linux/ethtool.h> | |
| #include <linux/phy.h> | |
| #include <linux/marvell_phy.h> | |
| #include <linux/of.h> | |
| #include <asm/io.h> | |
| #include <asm/irq.h> | |
| #include <asm/uaccess.h> | |
| #define MII_MARVELL_PHY_PAGE 22 | |
| #define MII_M1011_IEVENT 0x13 | |
| #define MII_M1011_IEVENT_CLEAR 0x0000 | |
| #define MII_M1011_IMASK 0x12 | |
| #define MII_M1011_IMASK_INIT 0x6400 | |
| #define MII_M1011_IMASK_CLEAR 0x0000 | |
| #define MII_M1011_PHY_SCR 0x10 | |
| #define MII_M1011_PHY_SCR_AUTO_CROSS 0x0060 | |
| #define MII_M1145_PHY_EXT_CR 0x14 | |
| #define MII_M1145_RGMII_RX_DELAY 0x0080 | |
| #define MII_M1145_RGMII_TX_DELAY 0x0002 | |
| #define MII_M1111_PHY_LED_CONTROL 0x18 | |
| #define MII_M1111_PHY_LED_DIRECT 0x4100 | |
| #define MII_M1111_PHY_LED_COMBINE 0x411c | |
| #define MII_M1111_PHY_EXT_CR 0x14 | |
| #define MII_M1111_RX_DELAY 0x80 | |
| #define MII_M1111_TX_DELAY 0x2 | |
| #define MII_M1111_PHY_EXT_SR 0x1b | |
| #define MII_M1111_HWCFG_MODE_MASK 0xf | |
| #define MII_M1111_HWCFG_MODE_COPPER_RGMII 0xb | |
| #define MII_M1111_HWCFG_MODE_FIBER_RGMII 0x3 | |
| #define MII_M1111_HWCFG_MODE_SGMII_NO_CLK 0x4 | |
| #define MII_M1111_HWCFG_MODE_COPPER_RTBI 0x9 | |
| #define MII_M1111_HWCFG_FIBER_COPPER_AUTO 0x8000 | |
| #define MII_M1111_HWCFG_FIBER_COPPER_RES 0x2000 | |
| #define MII_M1111_COPPER 0 | |
| #define MII_M1111_FIBER 1 | |
| #define MII_88E1121_PHY_MSCR_PAGE 2 | |
| #define MII_88E1121_PHY_MSCR_REG 21 | |
| #define MII_88E1121_PHY_MSCR_RX_DELAY BIT(5) | |
| #define MII_88E1121_PHY_MSCR_TX_DELAY BIT(4) | |
| #define MII_88E1121_PHY_MSCR_DELAY_MASK (~(0x3 << 4)) | |
| #define MII_88E1318S_PHY_MSCR1_REG 16 | |
| #define MII_88E1318S_PHY_MSCR1_PAD_ODD BIT(6) | |
| #define MII_88E1121_PHY_LED_CTRL 16 | |
| #define MII_88E1121_PHY_LED_PAGE 3 | |
| #define MII_88E1121_PHY_LED_DEF 0x0030 | |
| #define MII_M1011_PHY_STATUS 0x11 | |
| #define MII_M1011_PHY_STATUS_1000 0x8000 | |
| #define MII_M1011_PHY_STATUS_100 0x4000 | |
| #define MII_M1011_PHY_STATUS_SPD_MASK 0xc000 | |
| #define MII_M1011_PHY_STATUS_FULLDUPLEX 0x2000 | |
| #define MII_M1011_PHY_STATUS_RESOLVED 0x0800 | |
| #define MII_M1011_PHY_STATUS_LINK 0x0400 | |
| MODULE_DESCRIPTION("Marvell PHY driver"); | |
| MODULE_AUTHOR("Andy Fleming"); | |
| MODULE_LICENSE("GPL"); | |
| static int marvell_ack_interrupt(struct phy_device *phydev) | |
| { | |
| int err; | |
| /* Clear the interrupts by reading the reg */ | |
| err = phy_read(phydev, MII_M1011_IEVENT); | |
| if (err < 0) | |
| return err; | |
| return 0; | |
| } | |
| static int marvell_config_intr(struct phy_device *phydev) | |
| { | |
| int err; | |
| if (phydev->interrupts == PHY_INTERRUPT_ENABLED) | |
| err = phy_write(phydev, MII_M1011_IMASK, MII_M1011_IMASK_INIT); | |
| else | |
| err = phy_write(phydev, MII_M1011_IMASK, MII_M1011_IMASK_CLEAR); | |
| return err; | |
| } | |
| static int marvell_config_aneg(struct phy_device *phydev) | |
| { | |
| int err; | |
| /* The Marvell PHY has an errata which requires | |
| * that certain registers get written in order | |
| * to restart autonegotiation */ | |
| err = phy_write(phydev, MII_BMCR, BMCR_RESET); | |
| if (err < 0) | |
| return err; | |
| err = phy_write(phydev, 0x1d, 0x1f); | |
| if (err < 0) | |
| return err; | |
| err = phy_write(phydev, 0x1e, 0x200c); | |
| if (err < 0) | |
| return err; | |
| err = phy_write(phydev, 0x1d, 0x5); | |
| if (err < 0) | |
| return err; | |
| err = phy_write(phydev, 0x1e, 0); | |
| if (err < 0) | |
| return err; | |
| err = phy_write(phydev, 0x1e, 0x100); | |
| if (err < 0) | |
| return err; | |
| err = phy_write(phydev, MII_M1011_PHY_SCR, | |
| MII_M1011_PHY_SCR_AUTO_CROSS); | |
| if (err < 0) | |
| return err; | |
| err = phy_write(phydev, MII_M1111_PHY_LED_CONTROL, | |
| MII_M1111_PHY_LED_DIRECT); | |
| if (err < 0) | |
| return err; | |
| err = genphy_config_aneg(phydev); | |
| if (err < 0) | |
| return err; | |
| if (phydev->autoneg != AUTONEG_ENABLE) { | |
| int bmcr; | |
| /* | |
| * A write to speed/duplex bits (that is performed by | |
| * genphy_config_aneg() call above) must be followed by | |
| * a software reset. Otherwise, the write has no effect. | |
| */ | |
| bmcr = phy_read(phydev, MII_BMCR); | |
| if (bmcr < 0) | |
| return bmcr; | |
| err = phy_write(phydev, MII_BMCR, bmcr | BMCR_RESET); | |
| if (err < 0) | |
| return err; | |
| } | |
| return 0; | |
| } | |
| #ifdef CONFIG_OF_MDIO | |
| /* | |
| * Set and/or override some configuration registers based on the | |
| * marvell,reg-init property stored in the of_node for the phydev. | |
| * | |
| * marvell,reg-init = <reg-page reg mask value>,...; | |
| * | |
| * There may be one or more sets of <reg-page reg mask value>: | |
| * | |
| * reg-page: which register bank to use. | |
| * reg: the register. | |
| * mask: if non-zero, ANDed with existing register value. | |
| * value: ORed with the masked value and written to the regiser. | |
| * | |
| */ | |
| static int marvell_of_reg_init(struct phy_device *phydev) | |
| { | |
| const __be32 *paddr; | |
| int len, i, saved_page, current_page, page_changed, ret; | |
| if (!phydev->dev.of_node) | |
| return 0; | |
| paddr = of_get_property(phydev->dev.of_node, "marvell,reg-init", &len); | |
| if (!paddr || len < (4 * sizeof(*paddr))) | |
| return 0; | |
| saved_page = phy_read(phydev, MII_MARVELL_PHY_PAGE); | |
| if (saved_page < 0) | |
| return saved_page; | |
| page_changed = 0; | |
| current_page = saved_page; | |
| ret = 0; | |
| len /= sizeof(*paddr); | |
| for (i = 0; i < len - 3; i += 4) { | |
| u16 reg_page = be32_to_cpup(paddr + i); | |
| u16 reg = be32_to_cpup(paddr + i + 1); | |
| u16 mask = be32_to_cpup(paddr + i + 2); | |
| u16 val_bits = be32_to_cpup(paddr + i + 3); | |
| int val; | |
| if (reg_page != current_page) { | |
| current_page = reg_page; | |
| page_changed = 1; | |
| ret = phy_write(phydev, MII_MARVELL_PHY_PAGE, reg_page); | |
| if (ret < 0) | |
| goto err; | |
| } | |
| val = 0; | |
| if (mask) { | |
| val = phy_read(phydev, reg); | |
| if (val < 0) { | |
| ret = val; | |
| goto err; | |
| } | |
| val &= mask; | |
| } | |
| val |= val_bits; | |
| ret = phy_write(phydev, reg, val); | |
| if (ret < 0) | |
| goto err; | |
| } | |
| err: | |
| if (page_changed) { | |
| i = phy_write(phydev, MII_MARVELL_PHY_PAGE, saved_page); | |
| if (ret == 0) | |
| ret = i; | |
| } | |
| return ret; | |
| } | |
| #else | |
| static int marvell_of_reg_init(struct phy_device *phydev) | |
| { | |
| return 0; | |
| } | |
| #endif /* CONFIG_OF_MDIO */ | |
| static int m88e1121_config_aneg(struct phy_device *phydev) | |
| { | |
| int err, oldpage, mscr; | |
| oldpage = phy_read(phydev, MII_MARVELL_PHY_PAGE); | |
| err = phy_write(phydev, MII_MARVELL_PHY_PAGE, | |
| MII_88E1121_PHY_MSCR_PAGE); | |
| if (err < 0) | |
| return err; | |
| if ((phydev->interface == PHY_INTERFACE_MODE_RGMII) || | |
| (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID) || | |
| (phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) || | |
| (phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID)) { | |
| mscr = phy_read(phydev, MII_88E1121_PHY_MSCR_REG) & | |
| MII_88E1121_PHY_MSCR_DELAY_MASK; | |
| if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID) | |
| mscr |= (MII_88E1121_PHY_MSCR_RX_DELAY | | |
| MII_88E1121_PHY_MSCR_TX_DELAY); | |
| else if (phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) | |
| mscr |= MII_88E1121_PHY_MSCR_RX_DELAY; | |
| else if (phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID) | |
| mscr |= MII_88E1121_PHY_MSCR_TX_DELAY; | |
| err = phy_write(phydev, MII_88E1121_PHY_MSCR_REG, mscr); | |
| if (err < 0) | |
| return err; | |
| } | |
| phy_write(phydev, MII_MARVELL_PHY_PAGE, oldpage); | |
| err = phy_write(phydev, MII_BMCR, BMCR_RESET); | |
| if (err < 0) | |
| return err; | |
| err = phy_write(phydev, MII_M1011_PHY_SCR, | |
| MII_M1011_PHY_SCR_AUTO_CROSS); | |
| if (err < 0) | |
| return err; | |
| oldpage = phy_read(phydev, MII_MARVELL_PHY_PAGE); | |
| phy_write(phydev, MII_MARVELL_PHY_PAGE, MII_88E1121_PHY_LED_PAGE); | |
| phy_write(phydev, MII_88E1121_PHY_LED_CTRL, MII_88E1121_PHY_LED_DEF); | |
| phy_write(phydev, MII_MARVELL_PHY_PAGE, oldpage); | |
| err = genphy_config_aneg(phydev); | |
| return err; | |
| } | |
| static int m88e1318_config_aneg(struct phy_device *phydev) | |
| { | |
| int err, oldpage, mscr; | |
| oldpage = phy_read(phydev, MII_MARVELL_PHY_PAGE); | |
| err = phy_write(phydev, MII_MARVELL_PHY_PAGE, | |
| MII_88E1121_PHY_MSCR_PAGE); | |
| if (err < 0) | |
| return err; | |
| mscr = phy_read(phydev, MII_88E1318S_PHY_MSCR1_REG); | |
| mscr |= MII_88E1318S_PHY_MSCR1_PAD_ODD; | |
| err = phy_write(phydev, MII_88E1318S_PHY_MSCR1_REG, mscr); | |
| if (err < 0) | |
| return err; | |
| err = phy_write(phydev, MII_MARVELL_PHY_PAGE, oldpage); | |
| if (err < 0) | |
| return err; | |
| return m88e1121_config_aneg(phydev); | |
| } | |
| static int m88e1111_config_init(struct phy_device *phydev) | |
| { | |
| int err; | |
| int temp; | |
| /* Enable Fiber/Copper auto selection */ | |
| temp = phy_read(phydev, MII_M1111_PHY_EXT_SR); | |
| temp &= ~MII_M1111_HWCFG_FIBER_COPPER_AUTO; | |
| phy_write(phydev, MII_M1111_PHY_EXT_SR, temp); | |
| temp = phy_read(phydev, MII_BMCR); | |
| temp |= BMCR_RESET; | |
| phy_write(phydev, MII_BMCR, temp); | |
| if ((phydev->interface == PHY_INTERFACE_MODE_RGMII) || | |
| (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID) || | |
| (phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) || | |
| (phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID)) { | |
| temp = phy_read(phydev, MII_M1111_PHY_EXT_CR); | |
| if (temp < 0) | |
| return temp; | |
| if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID) { | |
| temp |= (MII_M1111_RX_DELAY | MII_M1111_TX_DELAY); | |
| } else if (phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) { | |
| temp &= ~MII_M1111_TX_DELAY; | |
| temp |= MII_M1111_RX_DELAY; | |
| } else if (phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID) { | |
| temp &= ~MII_M1111_RX_DELAY; | |
| temp |= MII_M1111_TX_DELAY; | |
| } | |
| err = phy_write(phydev, MII_M1111_PHY_EXT_CR, temp); | |
| if (err < 0) | |
| return err; | |
| temp = phy_read(phydev, MII_M1111_PHY_EXT_SR); | |
| if (temp < 0) | |
| return temp; | |
| temp &= ~(MII_M1111_HWCFG_MODE_MASK); | |
| if (temp & MII_M1111_HWCFG_FIBER_COPPER_RES) | |
| temp |= MII_M1111_HWCFG_MODE_FIBER_RGMII; | |
| else | |
| temp |= MII_M1111_HWCFG_MODE_COPPER_RGMII; | |
| err = phy_write(phydev, MII_M1111_PHY_EXT_SR, temp); | |
| if (err < 0) | |
| return err; | |
| } | |
| if (phydev->interface == PHY_INTERFACE_MODE_SGMII) { | |
| temp = phy_read(phydev, MII_M1111_PHY_EXT_SR); | |
| if (temp < 0) | |
| return temp; | |
| temp &= ~(MII_M1111_HWCFG_MODE_MASK); | |
| temp |= MII_M1111_HWCFG_MODE_SGMII_NO_CLK; | |
| temp |= MII_M1111_HWCFG_FIBER_COPPER_AUTO; | |
| err = phy_write(phydev, MII_M1111_PHY_EXT_SR, temp); | |
| if (err < 0) | |
| return err; | |
| } | |
| if (phydev->interface == PHY_INTERFACE_MODE_RTBI) { | |
| temp = phy_read(phydev, MII_M1111_PHY_EXT_CR); | |
| if (temp < 0) | |
| return temp; | |
| temp |= (MII_M1111_RX_DELAY | MII_M1111_TX_DELAY); | |
| err = phy_write(phydev, MII_M1111_PHY_EXT_CR, temp); | |
| if (err < 0) | |
| return err; | |
| temp = phy_read(phydev, MII_M1111_PHY_EXT_SR); | |
| if (temp < 0) | |
| return temp; | |
| temp &= ~(MII_M1111_HWCFG_MODE_MASK | MII_M1111_HWCFG_FIBER_COPPER_RES); | |
| temp |= 0x7 | MII_M1111_HWCFG_FIBER_COPPER_AUTO; | |
| err = phy_write(phydev, MII_M1111_PHY_EXT_SR, temp); | |
| if (err < 0) | |
| return err; | |
| /* soft reset */ | |
| err = phy_write(phydev, MII_BMCR, BMCR_RESET); | |
| if (err < 0) | |
| return err; | |
| do | |
| temp = phy_read(phydev, MII_BMCR); | |
| while (temp & BMCR_RESET); | |
| temp = phy_read(phydev, MII_M1111_PHY_EXT_SR); | |
| if (temp < 0) | |
| return temp; | |
| temp &= ~(MII_M1111_HWCFG_MODE_MASK | MII_M1111_HWCFG_FIBER_COPPER_RES); | |
| temp |= MII_M1111_HWCFG_MODE_COPPER_RTBI | MII_M1111_HWCFG_FIBER_COPPER_AUTO; | |
| err = phy_write(phydev, MII_M1111_PHY_EXT_SR, temp); | |
| if (err < 0) | |
| return err; | |
| } | |
| err = marvell_of_reg_init(phydev); | |
| if (err < 0) | |
| return err; | |
| err = phy_write(phydev, MII_BMCR, BMCR_RESET); | |
| if (err < 0) | |
| return err; | |
| return 0; | |
| } | |
| static int m88e1118_config_aneg(struct phy_device *phydev) | |
| { | |
| int err; | |
| err = phy_write(phydev, MII_BMCR, BMCR_RESET); | |
| if (err < 0) | |
| return err; | |
| err = phy_write(phydev, MII_M1011_PHY_SCR, | |
| MII_M1011_PHY_SCR_AUTO_CROSS); | |
| if (err < 0) | |
| return err; | |
| err = genphy_config_aneg(phydev); | |
| return 0; | |
| } | |
| static int m88e1118_config_init(struct phy_device *phydev) | |
| { | |
| int err; | |
| /* Change address */ | |
| err = phy_write(phydev, MII_MARVELL_PHY_PAGE, 0x0002); | |
| if (err < 0) | |
| return err; | |
| /* Enable 1000 Mbit */ | |
| err = phy_write(phydev, 0x15, 0x1070); | |
| if (err < 0) | |
| return err; | |
| /* Change address */ | |
| err = phy_write(phydev, MII_MARVELL_PHY_PAGE, 0x0003); | |
| if (err < 0) | |
| return err; | |
| /* Adjust LED Control */ | |
| if (phydev->dev_flags & MARVELL_PHY_M1118_DNS323_LEDS) | |
| err = phy_write(phydev, 0x10, 0x1100); | |
| else | |
| err = phy_write(phydev, 0x10, 0x021e); | |
| if (err < 0) | |
| return err; | |
| err = marvell_of_reg_init(phydev); | |
| if (err < 0) | |
| return err; | |
| /* Reset address */ | |
| err = phy_write(phydev, MII_MARVELL_PHY_PAGE, 0x0); | |
| if (err < 0) | |
| return err; | |
| err = phy_write(phydev, MII_BMCR, BMCR_RESET); | |
| if (err < 0) | |
| return err; | |
| return 0; | |
| } | |
| static int m88e1149_config_init(struct phy_device *phydev) | |
| { | |
| int err; | |
| /* Change address */ | |
| err = phy_write(phydev, MII_MARVELL_PHY_PAGE, 0x0002); | |
| if (err < 0) | |
| return err; | |
| /* Enable 1000 Mbit */ | |
| err = phy_write(phydev, 0x15, 0x1048); | |
| if (err < 0) | |
| return err; | |
| err = marvell_of_reg_init(phydev); | |
| if (err < 0) | |
| return err; | |
| /* Reset address */ | |
| err = phy_write(phydev, MII_MARVELL_PHY_PAGE, 0x0); | |
| if (err < 0) | |
| return err; | |
| err = phy_write(phydev, MII_BMCR, BMCR_RESET); | |
| if (err < 0) | |
| return err; | |
| return 0; | |
| } | |
| static int m88e1145_config_init(struct phy_device *phydev) | |
| { | |
| int err; | |
| /* Take care of errata E0 & E1 */ | |
| err = phy_write(phydev, 0x1d, 0x001b); | |
| if (err < 0) | |
| return err; | |
| err = phy_write(phydev, 0x1e, 0x418f); | |
| if (err < 0) | |
| return err; | |
| err = phy_write(phydev, 0x1d, 0x0016); | |
| if (err < 0) | |
| return err; | |
| err = phy_write(phydev, 0x1e, 0xa2da); | |
| if (err < 0) | |
| return err; | |
| if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID) { | |
| int temp = phy_read(phydev, MII_M1145_PHY_EXT_CR); | |
| if (temp < 0) | |
| return temp; | |
| temp |= (MII_M1145_RGMII_RX_DELAY | MII_M1145_RGMII_TX_DELAY); | |
| err = phy_write(phydev, MII_M1145_PHY_EXT_CR, temp); | |
| if (err < 0) | |
| return err; | |
| if (phydev->dev_flags & MARVELL_PHY_M1145_FLAGS_RESISTANCE) { | |
| err = phy_write(phydev, 0x1d, 0x0012); | |
| if (err < 0) | |
| return err; | |
| temp = phy_read(phydev, 0x1e); | |
| if (temp < 0) | |
| return temp; | |
| temp &= 0xf03f; | |
| temp |= 2 << 9; /* 36 ohm */ | |
| temp |= 2 << 6; /* 39 ohm */ | |
| err = phy_write(phydev, 0x1e, temp); | |
| if (err < 0) | |
| return err; | |
| err = phy_write(phydev, 0x1d, 0x3); | |
| if (err < 0) | |
| return err; | |
| err = phy_write(phydev, 0x1e, 0x8000); | |
| if (err < 0) | |
| return err; | |
| } | |
| } | |
| err = marvell_of_reg_init(phydev); | |
| if (err < 0) | |
| return err; | |
| return 0; | |
| } | |
| /* marvell_read_status | |
| * | |
| * Generic status code does not detect Fiber correctly! | |
| * Description: | |
| * Check the link, then figure out the current state | |
| * by comparing what we advertise with what the link partner | |
| * advertises. Start by checking the gigabit possibilities, | |
| * then move on to 10/100. | |
| */ | |
| static int marvell_read_status(struct phy_device *phydev) | |
| { | |
| int adv; | |
| int err; | |
| int lpa; | |
| int status = 0; | |
| /* Update the link, but return if there | |
| * was an error */ | |
| err = genphy_update_link(phydev); | |
| if (err) | |
| return err; | |
| if (AUTONEG_ENABLE == phydev->autoneg) { | |
| status = phy_read(phydev, MII_M1011_PHY_STATUS); | |
| if (status < 0) | |
| return status; | |
| lpa = phy_read(phydev, MII_LPA); | |
| if (lpa < 0) | |
| return lpa; | |
| adv = phy_read(phydev, MII_ADVERTISE); | |
| if (adv < 0) | |
| return adv; | |
| lpa &= adv; | |
| if (status & MII_M1011_PHY_STATUS_FULLDUPLEX) | |
| phydev->duplex = DUPLEX_FULL; | |
| else | |
| phydev->duplex = DUPLEX_HALF; | |
| status = status & MII_M1011_PHY_STATUS_SPD_MASK; | |
| phydev->pause = phydev->asym_pause = 0; | |
| switch (status) { | |
| case MII_M1011_PHY_STATUS_1000: | |
| phydev->speed = SPEED_1000; | |
| break; | |
| case MII_M1011_PHY_STATUS_100: | |
| phydev->speed = SPEED_100; | |
| break; | |
| default: | |
| phydev->speed = SPEED_10; | |
| break; | |
| } | |
| if (phydev->duplex == DUPLEX_FULL) { | |
| phydev->pause = lpa & LPA_PAUSE_CAP ? 1 : 0; | |
| phydev->asym_pause = lpa & LPA_PAUSE_ASYM ? 1 : 0; | |
| } | |
| } else { | |
| int bmcr = phy_read(phydev, MII_BMCR); | |
| if (bmcr < 0) | |
| return bmcr; | |
| if (bmcr & BMCR_FULLDPLX) | |
| phydev->duplex = DUPLEX_FULL; | |
| else | |
| phydev->duplex = DUPLEX_HALF; | |
| if (bmcr & BMCR_SPEED1000) | |
| phydev->speed = SPEED_1000; | |
| else if (bmcr & BMCR_SPEED100) | |
| phydev->speed = SPEED_100; | |
| else | |
| phydev->speed = SPEED_10; | |
| phydev->pause = phydev->asym_pause = 0; | |
| } | |
| return 0; | |
| } | |
| static int m88e1121_did_interrupt(struct phy_device *phydev) | |
| { | |
| int imask; | |
| imask = phy_read(phydev, MII_M1011_IEVENT); | |
| if (imask & MII_M1011_IMASK_INIT) | |
| return 1; | |
| return 0; | |
| } | |
| static struct phy_driver marvell_drivers[] = { | |
| { | |
| .phy_id = MARVELL_PHY_ID_88E1101, | |
| .phy_id_mask = MARVELL_PHY_ID_MASK, | |
| .name = "Marvell 88E1101", | |
| .features = PHY_GBIT_FEATURES, | |
| .flags = PHY_HAS_INTERRUPT, | |
| .config_aneg = &marvell_config_aneg, | |
| .read_status = &genphy_read_status, | |
| .ack_interrupt = &marvell_ack_interrupt, | |
| .config_intr = &marvell_config_intr, | |
| .driver = { .owner = THIS_MODULE }, | |
| }, | |
| { | |
| .phy_id = MARVELL_PHY_ID_88E1112, | |
| .phy_id_mask = MARVELL_PHY_ID_MASK, | |
| .name = "Marvell 88E1112", | |
| .features = PHY_GBIT_FEATURES, | |
| .flags = PHY_HAS_INTERRUPT, | |
| .config_init = &m88e1111_config_init, | |
| .config_aneg = &marvell_config_aneg, | |
| .read_status = &genphy_read_status, | |
| .ack_interrupt = &marvell_ack_interrupt, | |
| .config_intr = &marvell_config_intr, | |
| .driver = { .owner = THIS_MODULE }, | |
| }, | |
| { | |
| .phy_id = MARVELL_PHY_ID_88E1111, | |
| .phy_id_mask = MARVELL_PHY_ID_MASK, | |
| .name = "Marvell 88E1111", | |
| .features = PHY_GBIT_FEATURES, | |
| .flags = PHY_HAS_INTERRUPT, | |
| .config_init = &m88e1111_config_init, | |
| .config_aneg = &marvell_config_aneg, | |
| .read_status = &marvell_read_status, | |
| .ack_interrupt = &marvell_ack_interrupt, | |
| .config_intr = &marvell_config_intr, | |
| .driver = { .owner = THIS_MODULE }, | |
| }, | |
| { | |
| .phy_id = MARVELL_PHY_ID_88E1118, | |
| .phy_id_mask = MARVELL_PHY_ID_MASK, | |
| .name = "Marvell 88E1118", | |
| .features = PHY_GBIT_FEATURES, | |
| .flags = PHY_HAS_INTERRUPT, | |
| .config_init = &m88e1118_config_init, | |
| .config_aneg = &m88e1118_config_aneg, | |
| .read_status = &genphy_read_status, | |
| .ack_interrupt = &marvell_ack_interrupt, | |
| .config_intr = &marvell_config_intr, | |
| .driver = {.owner = THIS_MODULE,}, | |
| }, | |
| { | |
| .phy_id = MARVELL_PHY_ID_88E1121R, | |
| .phy_id_mask = MARVELL_PHY_ID_MASK, | |
| .name = "Marvell 88E1121R", | |
| .features = PHY_GBIT_FEATURES, | |
| .flags = PHY_HAS_INTERRUPT, | |
| .config_aneg = &m88e1121_config_aneg, | |
| .read_status = &marvell_read_status, | |
| .ack_interrupt = &marvell_ack_interrupt, | |
| .config_intr = &marvell_config_intr, | |
| .did_interrupt = &m88e1121_did_interrupt, | |
| .driver = { .owner = THIS_MODULE }, | |
| }, | |
| { | |
| .phy_id = MARVELL_PHY_ID_88E1318S, | |
| .phy_id_mask = MARVELL_PHY_ID_MASK, | |
| .name = "Marvell 88E1318S", | |
| .features = PHY_GBIT_FEATURES, | |
| .flags = PHY_HAS_INTERRUPT, | |
| .config_aneg = &m88e1318_config_aneg, | |
| .read_status = &marvell_read_status, | |
| .ack_interrupt = &marvell_ack_interrupt, | |
| .config_intr = &marvell_config_intr, | |
| .did_interrupt = &m88e1121_did_interrupt, | |
| .driver = { .owner = THIS_MODULE }, | |
| }, | |
| { | |
| .phy_id = MARVELL_PHY_ID_88E1145, | |
| .phy_id_mask = MARVELL_PHY_ID_MASK, | |
| .name = "Marvell 88E1145", | |
| .features = PHY_GBIT_FEATURES, | |
| .flags = PHY_HAS_INTERRUPT, | |
| .config_init = &m88e1145_config_init, | |
| .config_aneg = &marvell_config_aneg, | |
| .read_status = &genphy_read_status, | |
| .ack_interrupt = &marvell_ack_interrupt, | |
| .config_intr = &marvell_config_intr, | |
| .driver = { .owner = THIS_MODULE }, | |
| }, | |
| { | |
| .phy_id = MARVELL_PHY_ID_88E1149R, | |
| .phy_id_mask = MARVELL_PHY_ID_MASK, | |
| .name = "Marvell 88E1149R", | |
| .features = PHY_GBIT_FEATURES, | |
| .flags = PHY_HAS_INTERRUPT, | |
| .config_init = &m88e1149_config_init, | |
| .config_aneg = &m88e1118_config_aneg, | |
| .read_status = &genphy_read_status, | |
| .ack_interrupt = &marvell_ack_interrupt, | |
| .config_intr = &marvell_config_intr, | |
| .driver = { .owner = THIS_MODULE }, | |
| }, | |
| { | |
| .phy_id = MARVELL_PHY_ID_88E1240, | |
| .phy_id_mask = MARVELL_PHY_ID_MASK, | |
| .name = "Marvell 88E1240", | |
| .features = PHY_GBIT_FEATURES, | |
| .flags = PHY_HAS_INTERRUPT, | |
| .config_init = &m88e1111_config_init, | |
| .config_aneg = &marvell_config_aneg, | |
| .read_status = &genphy_read_status, | |
| .ack_interrupt = &marvell_ack_interrupt, | |
| .config_intr = &marvell_config_intr, | |
| .driver = { .owner = THIS_MODULE }, | |
| }, | |
| }; | |
| static int __init marvell_init(void) | |
| { | |
| int ret; | |
| int i; | |
| for (i = 0; i < ARRAY_SIZE(marvell_drivers); i++) { | |
| ret = phy_driver_register(&marvell_drivers[i]); | |
| if (ret) { | |
| while (i-- > 0) | |
| phy_driver_unregister(&marvell_drivers[i]); | |
| return ret; | |
| } | |
| } | |
| return 0; | |
| } | |
| static void __exit marvell_exit(void) | |
| { | |
| int i; | |
| for (i = 0; i < ARRAY_SIZE(marvell_drivers); i++) | |
| phy_driver_unregister(&marvell_drivers[i]); | |
| } | |
| module_init(marvell_init); | |
| module_exit(marvell_exit); | |
| static struct mdio_device_id __maybe_unused marvell_tbl[] = { | |
| { 0x01410c60, 0xfffffff0 }, | |
| { 0x01410c90, 0xfffffff0 }, | |
| { 0x01410cc0, 0xfffffff0 }, | |
| { 0x01410e10, 0xfffffff0 }, | |
| { 0x01410cb0, 0xfffffff0 }, | |
| { 0x01410cd0, 0xfffffff0 }, | |
| { 0x01410e50, 0xfffffff0 }, | |
| { 0x01410e30, 0xfffffff0 }, | |
| { 0x01410e90, 0xfffffff0 }, | |
| { } | |
| }; | |
| MODULE_DEVICE_TABLE(mdio, marvell_tbl); |