diff options
Diffstat (limited to 'drivers/net/phy/realtek.c')
| -rw-r--r-- | drivers/net/phy/realtek.c | 1092 |
1 files changed, 0 insertions, 1092 deletions
diff --git a/drivers/net/phy/realtek.c b/drivers/net/phy/realtek.c deleted file mode 100644 index 1fa70427b2a2..000000000000 --- a/drivers/net/phy/realtek.c +++ /dev/null @@ -1,1092 +0,0 @@ -// SPDX-License-Identifier: GPL-2.0+ -/* drivers/net/phy/realtek.c - * - * Driver for Realtek PHYs - * - * Author: Johnson Leung <r58129@freescale.com> - * - * Copyright (c) 2004 Freescale Semiconductor, Inc. - */ -#include <linux/bitops.h> -#include <linux/of.h> -#include <linux/phy.h> -#include <linux/module.h> -#include <linux/delay.h> -#include <linux/clk.h> - -#define RTL821x_PHYSR 0x11 -#define RTL821x_PHYSR_DUPLEX BIT(13) -#define RTL821x_PHYSR_SPEED GENMASK(15, 14) - -#define RTL821x_INER 0x12 -#define RTL8211B_INER_INIT 0x6400 -#define RTL8211E_INER_LINK_STATUS BIT(10) -#define RTL8211F_INER_LINK_STATUS BIT(4) - -#define RTL821x_INSR 0x13 - -#define RTL821x_EXT_PAGE_SELECT 0x1e -#define RTL821x_PAGE_SELECT 0x1f - -#define RTL8211F_PHYCR1 0x18 -#define RTL8211F_PHYCR2 0x19 -#define RTL8211F_INSR 0x1d - -#define RTL8211F_TX_DELAY BIT(8) -#define RTL8211F_RX_DELAY BIT(3) - -#define RTL8211F_ALDPS_PLL_OFF BIT(1) -#define RTL8211F_ALDPS_ENABLE BIT(2) -#define RTL8211F_ALDPS_XTAL_OFF BIT(12) - -#define RTL8211E_CTRL_DELAY BIT(13) -#define RTL8211E_TX_DELAY BIT(12) -#define RTL8211E_RX_DELAY BIT(11) - -#define RTL8211F_CLKOUT_EN BIT(0) - -#define RTL8201F_ISR 0x1e -#define RTL8201F_ISR_ANERR BIT(15) -#define RTL8201F_ISR_DUPLEX BIT(13) -#define RTL8201F_ISR_LINK BIT(11) -#define RTL8201F_ISR_MASK (RTL8201F_ISR_ANERR | \ - RTL8201F_ISR_DUPLEX | \ - RTL8201F_ISR_LINK) -#define RTL8201F_IER 0x13 - -#define RTL8366RB_POWER_SAVE 0x15 -#define RTL8366RB_POWER_SAVE_ON BIT(12) - -#define RTL9000A_GINMR 0x14 -#define RTL9000A_GINMR_LINK_STATUS BIT(4) - -#define RTLGEN_SPEED_MASK 0x0630 - -#define RTL_GENERIC_PHYID 0x001cc800 -#define RTL_8211FVD_PHYID 0x001cc878 - -MODULE_DESCRIPTION("Realtek PHY driver"); -MODULE_AUTHOR("Johnson Leung"); -MODULE_LICENSE("GPL"); - -struct rtl821x_priv { - u16 phycr1; - u16 phycr2; - bool has_phycr2; - struct clk *clk; -}; - -static int rtl821x_read_page(struct phy_device *phydev) -{ - return __phy_read(phydev, RTL821x_PAGE_SELECT); -} - -static int rtl821x_write_page(struct phy_device *phydev, int page) -{ - return __phy_write(phydev, RTL821x_PAGE_SELECT, page); -} - -static int rtl821x_probe(struct phy_device *phydev) -{ - struct device *dev = &phydev->mdio.dev; - struct rtl821x_priv *priv; - u32 phy_id = phydev->drv->phy_id; - int ret; - - priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); - if (!priv) - return -ENOMEM; - - priv->clk = devm_clk_get_optional_enabled(dev, NULL); - if (IS_ERR(priv->clk)) - return dev_err_probe(dev, PTR_ERR(priv->clk), - "failed to get phy clock\n"); - - ret = phy_read_paged(phydev, 0xa43, RTL8211F_PHYCR1); - if (ret < 0) - return ret; - - priv->phycr1 = ret & (RTL8211F_ALDPS_PLL_OFF | RTL8211F_ALDPS_ENABLE | RTL8211F_ALDPS_XTAL_OFF); - if (of_property_read_bool(dev->of_node, "realtek,aldps-enable")) - priv->phycr1 |= RTL8211F_ALDPS_PLL_OFF | RTL8211F_ALDPS_ENABLE | RTL8211F_ALDPS_XTAL_OFF; - - priv->has_phycr2 = !(phy_id == RTL_8211FVD_PHYID); - if (priv->has_phycr2) { - ret = phy_read_paged(phydev, 0xa43, RTL8211F_PHYCR2); - if (ret < 0) - return ret; - - priv->phycr2 = ret & RTL8211F_CLKOUT_EN; - if (of_property_read_bool(dev->of_node, "realtek,clkout-disable")) - priv->phycr2 &= ~RTL8211F_CLKOUT_EN; - } - - phydev->priv = priv; - - return 0; -} - -static int rtl8201_ack_interrupt(struct phy_device *phydev) -{ - int err; - - err = phy_read(phydev, RTL8201F_ISR); - - return (err < 0) ? err : 0; -} - -static int rtl821x_ack_interrupt(struct phy_device *phydev) -{ - int err; - - err = phy_read(phydev, RTL821x_INSR); - - return (err < 0) ? err : 0; -} - -static int rtl8211f_ack_interrupt(struct phy_device *phydev) -{ - int err; - - err = phy_read_paged(phydev, 0xa43, RTL8211F_INSR); - - return (err < 0) ? err : 0; -} - -static int rtl8201_config_intr(struct phy_device *phydev) -{ - u16 val; - int err; - - if (phydev->interrupts == PHY_INTERRUPT_ENABLED) { - err = rtl8201_ack_interrupt(phydev); - if (err) - return err; - - val = BIT(13) | BIT(12) | BIT(11); - err = phy_write_paged(phydev, 0x7, RTL8201F_IER, val); - } else { - val = 0; - err = phy_write_paged(phydev, 0x7, RTL8201F_IER, val); - if (err) - return err; - - err = rtl8201_ack_interrupt(phydev); - } - - return err; -} - -static int rtl8211b_config_intr(struct phy_device *phydev) -{ - int err; - - if (phydev->interrupts == PHY_INTERRUPT_ENABLED) { - err = rtl821x_ack_interrupt(phydev); - if (err) - return err; - - err = phy_write(phydev, RTL821x_INER, - RTL8211B_INER_INIT); - } else { - err = phy_write(phydev, RTL821x_INER, 0); - if (err) - return err; - - err = rtl821x_ack_interrupt(phydev); - } - - return err; -} - -static int rtl8211e_config_intr(struct phy_device *phydev) -{ - int err; - - if (phydev->interrupts == PHY_INTERRUPT_ENABLED) { - err = rtl821x_ack_interrupt(phydev); - if (err) - return err; - - err = phy_write(phydev, RTL821x_INER, - RTL8211E_INER_LINK_STATUS); - } else { - err = phy_write(phydev, RTL821x_INER, 0); - if (err) - return err; - - err = rtl821x_ack_interrupt(phydev); - } - - return err; -} - -static int rtl8211f_config_intr(struct phy_device *phydev) -{ - u16 val; - int err; - - if (phydev->interrupts == PHY_INTERRUPT_ENABLED) { - err = rtl8211f_ack_interrupt(phydev); - if (err) - return err; - - val = RTL8211F_INER_LINK_STATUS; - err = phy_write_paged(phydev, 0xa42, RTL821x_INER, val); - } else { - val = 0; - err = phy_write_paged(phydev, 0xa42, RTL821x_INER, val); - if (err) - return err; - - err = rtl8211f_ack_interrupt(phydev); - } - - return err; -} - -static irqreturn_t rtl8201_handle_interrupt(struct phy_device *phydev) -{ - int irq_status; - - irq_status = phy_read(phydev, RTL8201F_ISR); - if (irq_status < 0) { - phy_error(phydev); - return IRQ_NONE; - } - - if (!(irq_status & RTL8201F_ISR_MASK)) - return IRQ_NONE; - - phy_trigger_machine(phydev); - - return IRQ_HANDLED; -} - -static irqreturn_t rtl821x_handle_interrupt(struct phy_device *phydev) -{ - int irq_status, irq_enabled; - - irq_status = phy_read(phydev, RTL821x_INSR); - if (irq_status < 0) { - phy_error(phydev); - return IRQ_NONE; - } - - irq_enabled = phy_read(phydev, RTL821x_INER); - if (irq_enabled < 0) { - phy_error(phydev); - return IRQ_NONE; - } - - if (!(irq_status & irq_enabled)) - return IRQ_NONE; - - phy_trigger_machine(phydev); - - return IRQ_HANDLED; -} - -static irqreturn_t rtl8211f_handle_interrupt(struct phy_device *phydev) -{ - int irq_status; - - irq_status = phy_read_paged(phydev, 0xa43, RTL8211F_INSR); - if (irq_status < 0) { - phy_error(phydev); - return IRQ_NONE; - } - - if (!(irq_status & RTL8211F_INER_LINK_STATUS)) - return IRQ_NONE; - - phy_trigger_machine(phydev); - - return IRQ_HANDLED; -} - -static int rtl8211_config_aneg(struct phy_device *phydev) -{ - int ret; - - ret = genphy_config_aneg(phydev); - if (ret < 0) - return ret; - - /* Quirk was copied from vendor driver. Unfortunately it includes no - * description of the magic numbers. - */ - if (phydev->speed == SPEED_100 && phydev->autoneg == AUTONEG_DISABLE) { - phy_write(phydev, 0x17, 0x2138); - phy_write(phydev, 0x0e, 0x0260); - } else { - phy_write(phydev, 0x17, 0x2108); - phy_write(phydev, 0x0e, 0x0000); - } - - return 0; -} - -static int rtl8211c_config_init(struct phy_device *phydev) -{ - /* RTL8211C has an issue when operating in Gigabit slave mode */ - return phy_set_bits(phydev, MII_CTRL1000, - CTL1000_ENABLE_MASTER | CTL1000_AS_MASTER); -} - -static int rtl8211f_config_init(struct phy_device *phydev) -{ - struct rtl821x_priv *priv = phydev->priv; - struct device *dev = &phydev->mdio.dev; - u16 val_txdly, val_rxdly; - int ret; - - ret = phy_modify_paged_changed(phydev, 0xa43, RTL8211F_PHYCR1, - RTL8211F_ALDPS_PLL_OFF | RTL8211F_ALDPS_ENABLE | RTL8211F_ALDPS_XTAL_OFF, - priv->phycr1); - if (ret < 0) { - dev_err(dev, "aldps mode configuration failed: %pe\n", - ERR_PTR(ret)); - return ret; - } - - switch (phydev->interface) { - case PHY_INTERFACE_MODE_RGMII: - val_txdly = 0; - val_rxdly = 0; - break; - - case PHY_INTERFACE_MODE_RGMII_RXID: - val_txdly = 0; - val_rxdly = RTL8211F_RX_DELAY; - break; - - case PHY_INTERFACE_MODE_RGMII_TXID: - val_txdly = RTL8211F_TX_DELAY; - val_rxdly = 0; - break; - - case PHY_INTERFACE_MODE_RGMII_ID: - val_txdly = RTL8211F_TX_DELAY; - val_rxdly = RTL8211F_RX_DELAY; - break; - - default: /* the rest of the modes imply leaving delay as is. */ - return 0; - } - - ret = phy_modify_paged_changed(phydev, 0xd08, 0x11, RTL8211F_TX_DELAY, - val_txdly); - if (ret < 0) { - dev_err(dev, "Failed to update the TX delay register\n"); - return ret; - } else if (ret) { - dev_dbg(dev, - "%s 2ns TX delay (and changing the value from pin-strapping RXD1 or the bootloader)\n", - val_txdly ? "Enabling" : "Disabling"); - } else { - dev_dbg(dev, - "2ns TX delay was already %s (by pin-strapping RXD1 or bootloader configuration)\n", - val_txdly ? "enabled" : "disabled"); - } - - ret = phy_modify_paged_changed(phydev, 0xd08, 0x15, RTL8211F_RX_DELAY, - val_rxdly); - if (ret < 0) { - dev_err(dev, "Failed to update the RX delay register\n"); - return ret; - } else if (ret) { - dev_dbg(dev, - "%s 2ns RX delay (and changing the value from pin-strapping RXD0 or the bootloader)\n", - val_rxdly ? "Enabling" : "Disabling"); - } else { - dev_dbg(dev, - "2ns RX delay was already %s (by pin-strapping RXD0 or bootloader configuration)\n", - val_rxdly ? "enabled" : "disabled"); - } - - if (priv->has_phycr2) { - ret = phy_modify_paged(phydev, 0xa43, RTL8211F_PHYCR2, - RTL8211F_CLKOUT_EN, priv->phycr2); - if (ret < 0) { - dev_err(dev, "clkout configuration failed: %pe\n", - ERR_PTR(ret)); - return ret; - } - - return genphy_soft_reset(phydev); - } - - return 0; -} - -static int rtl821x_suspend(struct phy_device *phydev) -{ - struct rtl821x_priv *priv = phydev->priv; - int ret = 0; - - if (!phydev->wol_enabled) { - ret = genphy_suspend(phydev); - - if (ret) - return ret; - - clk_disable_unprepare(priv->clk); - } - - return ret; -} - -static int rtl821x_resume(struct phy_device *phydev) -{ - struct rtl821x_priv *priv = phydev->priv; - int ret; - - if (!phydev->wol_enabled) - clk_prepare_enable(priv->clk); - - ret = genphy_resume(phydev); - if (ret < 0) - return ret; - - msleep(20); - - return 0; -} - -static int rtl8211e_config_init(struct phy_device *phydev) -{ - int ret = 0, oldpage; - u16 val; - - /* enable TX/RX delay for rgmii-* modes, and disable them for rgmii. */ - switch (phydev->interface) { - case PHY_INTERFACE_MODE_RGMII: - val = RTL8211E_CTRL_DELAY | 0; - break; - case PHY_INTERFACE_MODE_RGMII_ID: - val = RTL8211E_CTRL_DELAY | RTL8211E_TX_DELAY | RTL8211E_RX_DELAY; - break; - case PHY_INTERFACE_MODE_RGMII_RXID: - val = RTL8211E_CTRL_DELAY | RTL8211E_RX_DELAY; - break; - case PHY_INTERFACE_MODE_RGMII_TXID: - val = RTL8211E_CTRL_DELAY | RTL8211E_TX_DELAY; - break; - default: /* the rest of the modes imply leaving delays as is. */ - return 0; - } - - /* According to a sample driver there is a 0x1c config register on the - * 0xa4 extension page (0x7) layout. It can be used to disable/enable - * the RX/TX delays otherwise controlled by RXDLY/TXDLY pins. - * The configuration register definition: - * 14 = reserved - * 13 = Force Tx RX Delay controlled by bit12 bit11, - * 12 = RX Delay, 11 = TX Delay - * 10:0 = Test && debug settings reserved by realtek - */ - oldpage = phy_select_page(phydev, 0x7); - if (oldpage < 0) - goto err_restore_page; - - ret = __phy_write(phydev, RTL821x_EXT_PAGE_SELECT, 0xa4); - if (ret) - goto err_restore_page; - - ret = __phy_modify(phydev, 0x1c, RTL8211E_CTRL_DELAY - | RTL8211E_TX_DELAY | RTL8211E_RX_DELAY, - val); - -err_restore_page: - return phy_restore_page(phydev, oldpage, ret); -} - -static int rtl8211b_suspend(struct phy_device *phydev) -{ - phy_write(phydev, MII_MMD_DATA, BIT(9)); - - return genphy_suspend(phydev); -} - -static int rtl8211b_resume(struct phy_device *phydev) -{ - phy_write(phydev, MII_MMD_DATA, 0); - - return genphy_resume(phydev); -} - -static int rtl8366rb_config_init(struct phy_device *phydev) -{ - int ret; - - ret = phy_set_bits(phydev, RTL8366RB_POWER_SAVE, - RTL8366RB_POWER_SAVE_ON); - if (ret) { - dev_err(&phydev->mdio.dev, - "error enabling power management\n"); - } - - return ret; -} - -/* get actual speed to cover the downshift case */ -static int rtlgen_get_speed(struct phy_device *phydev) -{ - int val; - - if (!phydev->link) - return 0; - - val = phy_read_paged(phydev, 0xa43, 0x12); - if (val < 0) - return val; - - switch (val & RTLGEN_SPEED_MASK) { - case 0x0000: - phydev->speed = SPEED_10; - break; - case 0x0010: - phydev->speed = SPEED_100; - break; - case 0x0020: - phydev->speed = SPEED_1000; - break; - case 0x0200: - phydev->speed = SPEED_10000; - break; - case 0x0210: - phydev->speed = SPEED_2500; - break; - case 0x0220: - phydev->speed = SPEED_5000; - break; - default: - break; - } - - return 0; -} - -static int rtlgen_read_status(struct phy_device *phydev) -{ - int ret; - - ret = genphy_read_status(phydev); - if (ret < 0) - return ret; - - return rtlgen_get_speed(phydev); -} - -static int rtlgen_read_mmd(struct phy_device *phydev, int devnum, u16 regnum) -{ - int ret; - - if (devnum == MDIO_MMD_PCS && regnum == MDIO_PCS_EEE_ABLE) { - rtl821x_write_page(phydev, 0xa5c); - ret = __phy_read(phydev, 0x12); - rtl821x_write_page(phydev, 0); - } else if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_ADV) { - rtl821x_write_page(phydev, 0xa5d); - ret = __phy_read(phydev, 0x10); - rtl821x_write_page(phydev, 0); - } else if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_LPABLE) { - rtl821x_write_page(phydev, 0xa5d); - ret = __phy_read(phydev, 0x11); - rtl821x_write_page(phydev, 0); - } else { - ret = -EOPNOTSUPP; - } - - return ret; -} - -static int rtlgen_write_mmd(struct phy_device *phydev, int devnum, u16 regnum, - u16 val) -{ - int ret; - - if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_ADV) { - rtl821x_write_page(phydev, 0xa5d); - ret = __phy_write(phydev, 0x10, val); - rtl821x_write_page(phydev, 0); - } else { - ret = -EOPNOTSUPP; - } - - return ret; -} - -static int rtl822x_read_mmd(struct phy_device *phydev, int devnum, u16 regnum) -{ - int ret = rtlgen_read_mmd(phydev, devnum, regnum); - - if (ret != -EOPNOTSUPP) - return ret; - - if (devnum == MDIO_MMD_PCS && regnum == MDIO_PCS_EEE_ABLE2) { - rtl821x_write_page(phydev, 0xa6e); - ret = __phy_read(phydev, 0x16); - rtl821x_write_page(phydev, 0); - } else if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_ADV2) { - rtl821x_write_page(phydev, 0xa6d); - ret = __phy_read(phydev, 0x12); - rtl821x_write_page(phydev, 0); - } else if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_LPABLE2) { - rtl821x_write_page(phydev, 0xa6d); - ret = __phy_read(phydev, 0x10); - rtl821x_write_page(phydev, 0); - } - - return ret; -} - -static int rtl822x_write_mmd(struct phy_device *phydev, int devnum, u16 regnum, - u16 val) -{ - int ret = rtlgen_write_mmd(phydev, devnum, regnum, val); - - if (ret != -EOPNOTSUPP) - return ret; - - if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_ADV2) { - rtl821x_write_page(phydev, 0xa6d); - ret = __phy_write(phydev, 0x12, val); - rtl821x_write_page(phydev, 0); - } - - return ret; -} - -static int rtl822x_get_features(struct phy_device *phydev) -{ - int val; - - val = phy_read_paged(phydev, 0xa61, 0x13); - if (val < 0) - return val; - - linkmode_mod_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, - phydev->supported, val & MDIO_PMA_SPEED_2_5G); - linkmode_mod_bit(ETHTOOL_LINK_MODE_5000baseT_Full_BIT, - phydev->supported, val & MDIO_PMA_SPEED_5G); - linkmode_mod_bit(ETHTOOL_LINK_MODE_10000baseT_Full_BIT, - phydev->supported, val & MDIO_SPEED_10G); - - return genphy_read_abilities(phydev); -} - -static int rtl822x_config_aneg(struct phy_device *phydev) -{ - int ret = 0; - - if (phydev->autoneg == AUTONEG_ENABLE) { - u16 adv = linkmode_adv_to_mii_10gbt_adv_t(phydev->advertising); - - ret = phy_modify_paged_changed(phydev, 0xa5d, 0x12, - MDIO_AN_10GBT_CTRL_ADV2_5G | - MDIO_AN_10GBT_CTRL_ADV5G, - adv); - if (ret < 0) - return ret; - } - - return __genphy_config_aneg(phydev, ret); -} - -static int rtl822x_read_status(struct phy_device *phydev) -{ - int ret; - - if (phydev->autoneg == AUTONEG_ENABLE) { - int lpadv = phy_read_paged(phydev, 0xa5d, 0x13); - - if (lpadv < 0) - return lpadv; - - mii_10gbt_stat_mod_linkmode_lpa_t(phydev->lp_advertising, - lpadv); - } - - ret = genphy_read_status(phydev); - if (ret < 0) - return ret; - - return rtlgen_get_speed(phydev); -} - -static bool rtlgen_supports_2_5gbps(struct phy_device *phydev) -{ - int val; - - phy_write(phydev, RTL821x_PAGE_SELECT, 0xa61); - val = phy_read(phydev, 0x13); - phy_write(phydev, RTL821x_PAGE_SELECT, 0); - - return val >= 0 && val & MDIO_PMA_SPEED_2_5G; -} - -static int rtlgen_match_phy_device(struct phy_device *phydev) -{ - return phydev->phy_id == RTL_GENERIC_PHYID && - !rtlgen_supports_2_5gbps(phydev); -} - -static int rtl8226_match_phy_device(struct phy_device *phydev) -{ - return phydev->phy_id == RTL_GENERIC_PHYID && - rtlgen_supports_2_5gbps(phydev); -} - -static int rtlgen_resume(struct phy_device *phydev) -{ - int ret = genphy_resume(phydev); - - /* Internal PHY's from RTL8168h up may not be instantly ready */ - msleep(20); - - return ret; -} - -static int rtl9000a_config_init(struct phy_device *phydev) -{ - phydev->autoneg = AUTONEG_DISABLE; - phydev->speed = SPEED_100; - phydev->duplex = DUPLEX_FULL; - - return 0; -} - -static int rtl9000a_config_aneg(struct phy_device *phydev) -{ - int ret; - u16 ctl = 0; - - switch (phydev->master_slave_set) { - case MASTER_SLAVE_CFG_MASTER_FORCE: - ctl |= CTL1000_AS_MASTER; - break; - case MASTER_SLAVE_CFG_SLAVE_FORCE: - break; - case MASTER_SLAVE_CFG_UNKNOWN: - case MASTER_SLAVE_CFG_UNSUPPORTED: - return 0; - default: - phydev_warn(phydev, "Unsupported Master/Slave mode\n"); - return -EOPNOTSUPP; - } - - ret = phy_modify_changed(phydev, MII_CTRL1000, CTL1000_AS_MASTER, ctl); - if (ret == 1) - ret = genphy_soft_reset(phydev); - - return ret; -} - -static int rtl9000a_read_status(struct phy_device *phydev) -{ - int ret; - - phydev->master_slave_get = MASTER_SLAVE_CFG_UNKNOWN; - phydev->master_slave_state = MASTER_SLAVE_STATE_UNKNOWN; - - ret = genphy_update_link(phydev); - if (ret) - return ret; - - ret = phy_read(phydev, MII_CTRL1000); - if (ret < 0) - return ret; - if (ret & CTL1000_AS_MASTER) - phydev->master_slave_get = MASTER_SLAVE_CFG_MASTER_FORCE; - else - phydev->master_slave_get = MASTER_SLAVE_CFG_SLAVE_FORCE; - - ret = phy_read(phydev, MII_STAT1000); - if (ret < 0) - return ret; - if (ret & LPA_1000MSRES) - phydev->master_slave_state = MASTER_SLAVE_STATE_MASTER; - else - phydev->master_slave_state = MASTER_SLAVE_STATE_SLAVE; - - return 0; -} - -static int rtl9000a_ack_interrupt(struct phy_device *phydev) -{ - int err; - - err = phy_read(phydev, RTL8211F_INSR); - - return (err < 0) ? err : 0; -} - -static int rtl9000a_config_intr(struct phy_device *phydev) -{ - u16 val; - int err; - - if (phydev->interrupts == PHY_INTERRUPT_ENABLED) { - err = rtl9000a_ack_interrupt(phydev); - if (err) - return err; - - val = (u16)~RTL9000A_GINMR_LINK_STATUS; - err = phy_write_paged(phydev, 0xa42, RTL9000A_GINMR, val); - } else { - val = ~0; - err = phy_write_paged(phydev, 0xa42, RTL9000A_GINMR, val); - if (err) - return err; - - err = rtl9000a_ack_interrupt(phydev); - } - - return phy_write_paged(phydev, 0xa42, RTL9000A_GINMR, val); -} - -static irqreturn_t rtl9000a_handle_interrupt(struct phy_device *phydev) -{ - int irq_status; - - irq_status = phy_read(phydev, RTL8211F_INSR); - if (irq_status < 0) { - phy_error(phydev); - return IRQ_NONE; - } - - if (!(irq_status & RTL8211F_INER_LINK_STATUS)) - return IRQ_NONE; - - phy_trigger_machine(phydev); - - return IRQ_HANDLED; -} - -static struct phy_driver realtek_drvs[] = { - { - PHY_ID_MATCH_EXACT(0x00008201), - .name = "RTL8201CP Ethernet", - .read_page = rtl821x_read_page, - .write_page = rtl821x_write_page, - }, { - PHY_ID_MATCH_EXACT(0x001cc816), - .name = "RTL8201F Fast Ethernet", - .config_intr = &rtl8201_config_intr, - .handle_interrupt = rtl8201_handle_interrupt, - .suspend = genphy_suspend, - .resume = genphy_resume, - .read_page = rtl821x_read_page, - .write_page = rtl821x_write_page, - }, { - PHY_ID_MATCH_MODEL(0x001cc880), - .name = "RTL8208 Fast Ethernet", - .read_mmd = genphy_read_mmd_unsupported, - .write_mmd = genphy_write_mmd_unsupported, - .suspend = genphy_suspend, - .resume = genphy_resume, - .read_page = rtl821x_read_page, - .write_page = rtl821x_write_page, - }, { - PHY_ID_MATCH_EXACT(0x001cc910), - .name = "RTL8211 Gigabit Ethernet", - .config_aneg = rtl8211_config_aneg, - .read_mmd = &genphy_read_mmd_unsupported, - .write_mmd = &genphy_write_mmd_unsupported, - .read_page = rtl821x_read_page, - .write_page = rtl821x_write_page, - }, { - PHY_ID_MATCH_EXACT(0x001cc912), - .name = "RTL8211B Gigabit Ethernet", - .config_intr = &rtl8211b_config_intr, - .handle_interrupt = rtl821x_handle_interrupt, - .read_mmd = &genphy_read_mmd_unsupported, - .write_mmd = &genphy_write_mmd_unsupported, - .suspend = rtl8211b_suspend, - .resume = rtl8211b_resume, - .read_page = rtl821x_read_page, - .write_page = rtl821x_write_page, - }, { - PHY_ID_MATCH_EXACT(0x001cc913), - .name = "RTL8211C Gigabit Ethernet", - .config_init = rtl8211c_config_init, - .read_mmd = &genphy_read_mmd_unsupported, - .write_mmd = &genphy_write_mmd_unsupported, - .read_page = rtl821x_read_page, - .write_page = rtl821x_write_page, - }, { - PHY_ID_MATCH_EXACT(0x001cc914), - .name = "RTL8211DN Gigabit Ethernet", - .config_intr = rtl8211e_config_intr, - .handle_interrupt = rtl821x_handle_interrupt, - .suspend = genphy_suspend, - .resume = genphy_resume, - .read_page = rtl821x_read_page, - .write_page = rtl821x_write_page, - }, { - PHY_ID_MATCH_EXACT(0x001cc915), - .name = "RTL8211E Gigabit Ethernet", - .config_init = &rtl8211e_config_init, - .config_intr = &rtl8211e_config_intr, - .handle_interrupt = rtl821x_handle_interrupt, - .suspend = genphy_suspend, - .resume = genphy_resume, - .read_page = rtl821x_read_page, - .write_page = rtl821x_write_page, - }, { - PHY_ID_MATCH_EXACT(0x001cc916), - .name = "RTL8211F Gigabit Ethernet", - .probe = rtl821x_probe, - .config_init = &rtl8211f_config_init, - .read_status = rtlgen_read_status, - .config_intr = &rtl8211f_config_intr, - .handle_interrupt = rtl8211f_handle_interrupt, - .suspend = rtl821x_suspend, - .resume = rtl821x_resume, - .read_page = rtl821x_read_page, - .write_page = rtl821x_write_page, - .flags = PHY_ALWAYS_CALL_SUSPEND, - }, { - PHY_ID_MATCH_EXACT(RTL_8211FVD_PHYID), - .name = "RTL8211F-VD Gigabit Ethernet", - .probe = rtl821x_probe, - .config_init = &rtl8211f_config_init, - .read_status = rtlgen_read_status, - .config_intr = &rtl8211f_config_intr, - .handle_interrupt = rtl8211f_handle_interrupt, - .suspend = rtl821x_suspend, - .resume = rtl821x_resume, - .read_page = rtl821x_read_page, - .write_page = rtl821x_write_page, - .flags = PHY_ALWAYS_CALL_SUSPEND, - }, { - .name = "Generic FE-GE Realtek PHY", - .match_phy_device = rtlgen_match_phy_device, - .read_status = rtlgen_read_status, - .suspend = genphy_suspend, - .resume = rtlgen_resume, - .read_page = rtl821x_read_page, - .write_page = rtl821x_write_page, - .read_mmd = rtlgen_read_mmd, - .write_mmd = rtlgen_write_mmd, - }, { - .name = "RTL8226 2.5Gbps PHY", - .match_phy_device = rtl8226_match_phy_device, - .get_features = rtl822x_get_features, - .config_aneg = rtl822x_config_aneg, - .read_status = rtl822x_read_status, - .suspend = genphy_suspend, - .resume = rtlgen_resume, - .read_page = rtl821x_read_page, - .write_page = rtl821x_write_page, - .read_mmd = rtl822x_read_mmd, - .write_mmd = rtl822x_write_mmd, - }, { - PHY_ID_MATCH_EXACT(0x001cc840), - .name = "RTL8226B_RTL8221B 2.5Gbps PHY", - .get_features = rtl822x_get_features, - .config_aneg = rtl822x_config_aneg, - .read_status = rtl822x_read_status, - .suspend = genphy_suspend, - .resume = rtlgen_resume, - .read_page = rtl821x_read_page, - .write_page = rtl821x_write_page, - .read_mmd = rtl822x_read_mmd, - .write_mmd = rtl822x_write_mmd, - }, { - PHY_ID_MATCH_EXACT(0x001cc838), - .name = "RTL8226-CG 2.5Gbps PHY", - .get_features = rtl822x_get_features, - .config_aneg = rtl822x_config_aneg, - .read_status = rtl822x_read_status, - .suspend = genphy_suspend, - .resume = rtlgen_resume, - .read_page = rtl821x_read_page, - .write_page = rtl821x_write_page, - }, { - PHY_ID_MATCH_EXACT(0x001cc848), - .name = "RTL8226B-CG_RTL8221B-CG 2.5Gbps PHY", - .get_features = rtl822x_get_features, - .config_aneg = rtl822x_config_aneg, - .read_status = rtl822x_read_status, - .suspend = genphy_suspend, - .resume = rtlgen_resume, - .read_page = rtl821x_read_page, - .write_page = rtl821x_write_page, - }, { - PHY_ID_MATCH_EXACT(0x001cc849), - .name = "RTL8221B-VB-CG 2.5Gbps PHY", - .get_features = rtl822x_get_features, - .config_aneg = rtl822x_config_aneg, - .read_status = rtl822x_read_status, - .suspend = genphy_suspend, - .resume = rtlgen_resume, - .read_page = rtl821x_read_page, - .write_page = rtl821x_write_page, - }, { - PHY_ID_MATCH_EXACT(0x001cc84a), - .name = "RTL8221B-VM-CG 2.5Gbps PHY", - .get_features = rtl822x_get_features, - .config_aneg = rtl822x_config_aneg, - .read_status = rtl822x_read_status, - .suspend = genphy_suspend, - .resume = rtlgen_resume, - .read_page = rtl821x_read_page, - .write_page = rtl821x_write_page, - }, { - PHY_ID_MATCH_EXACT(0x001cc862), - .name = "RTL8251B 5Gbps PHY", - .get_features = rtl822x_get_features, - .config_aneg = rtl822x_config_aneg, - .read_status = rtl822x_read_status, - .suspend = genphy_suspend, - .resume = rtlgen_resume, - .read_page = rtl821x_read_page, - .write_page = rtl821x_write_page, - }, { - PHY_ID_MATCH_EXACT(0x001cc961), - .name = "RTL8366RB Gigabit Ethernet", - .config_init = &rtl8366rb_config_init, - /* These interrupts are handled by the irq controller - * embedded inside the RTL8366RB, they get unmasked when the - * irq is requested and ACKed by reading the status register, - * which is done by the irqchip code. - */ - .config_intr = genphy_no_config_intr, - .handle_interrupt = genphy_handle_interrupt_no_ack, - .suspend = genphy_suspend, - .resume = genphy_resume, - }, { - PHY_ID_MATCH_EXACT(0x001ccb00), - .name = "RTL9000AA_RTL9000AN Ethernet", - .features = PHY_BASIC_T1_FEATURES, - .config_init = rtl9000a_config_init, - .config_aneg = rtl9000a_config_aneg, - .read_status = rtl9000a_read_status, - .config_intr = rtl9000a_config_intr, - .handle_interrupt = rtl9000a_handle_interrupt, - .suspend = genphy_suspend, - .resume = genphy_resume, - .read_page = rtl821x_read_page, - .write_page = rtl821x_write_page, - }, { - PHY_ID_MATCH_EXACT(0x001cc942), - .name = "RTL8365MB-VC Gigabit Ethernet", - /* Interrupt handling analogous to RTL8366RB */ - .config_intr = genphy_no_config_intr, - .handle_interrupt = genphy_handle_interrupt_no_ack, - .suspend = genphy_suspend, - .resume = genphy_resume, - }, -}; - -module_phy_driver(realtek_drvs); - -static const struct mdio_device_id __maybe_unused realtek_tbl[] = { - { PHY_ID_MATCH_VENDOR(0x001cc800) }, - { } -}; - -MODULE_DEVICE_TABLE(mdio, realtek_tbl); |