mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
synced 2025-12-27 07:35:36 -05:00
When support for RTL8211F(D)(I)-VD-CG was introduced in commitbb726b753f("net: phy: realtek: add support for RTL8211F(D)(I)-VD-CG") the implementation assumed that this PHY model doesn't have the control register PHYCR2 (Page 0xa43 Address 0x19). This assumption was based on the differences in CLKOUT configurations between RTL8211FVD and the remaining RTL8211F PHYs. In the latter commit2c67301584("net: phy: realtek: Avoid PHYCR2 access if PHYCR2 not present") this assumption was expanded to the PHY-mode EEE. I performed tests on RTL8211FI-VD-CG and confirmed that disabling PHY-mode EEE works correctly and is uniform with other PHYs supported by the driver. To validate the correctness, I contacted Realtek support. Realtek confirmed that PHY-mode EEE on RTL8211F(D)(I)-VD-CG is configured via Page 0xa43 Address 0x19 bit 5. Moreover, Realtek informed me that the most recent datasheet for RTL8211F(D)(I)-VD-CG v1.1 is incomplete and the naming of control registers is partly inconsistent. The errata I received from Realtek corrects the naming as follows: | Register | Datasheet v1.1 | Errata | |-------------------------|----------------|--------| | Page 0xa44 Address 0x11 | PHYCR2 | PHYCR3 | | Page 0xa43 Address 0x19 | N/A | PHYCR2 | This information confirms that the supposedly missing control register, PHYCR2, exists in the RTL8211F(D)(I)-VD-CG under the same address and the same name. It controls widely the same configs as other PHYs from the RTL8211F series (e.g. PHY-mode EEE). Clock out configuration is an exception. Given all this information, restore disabling of the PHY-mode EEE. Fixes:2c67301584("net: phy: realtek: Avoid PHYCR2 access if PHYCR2 not present") Signed-off-by: Ivan Galkin <ivan.galkin@axis.com> Reviewed-by: Vladimir Oltean <vladimir.oltean@nxp.com> Link: https://patch.msgid.link/20251202-phy_eee-v1-1-fe0bf6ab3df0@axis.com Signed-off-by: Paolo Abeni <pabeni@redhat.com>
2274 lines
58 KiB
C
2274 lines
58 KiB
C
// 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/ethtool_netlink.h>
|
|
#include <linux/of.h>
|
|
#include <linux/phy.h>
|
|
#include <linux/pm_wakeirq.h>
|
|
#include <linux/netdevice.h>
|
|
#include <linux/module.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/clk.h>
|
|
#include <linux/string_choices.h>
|
|
|
|
#include "realtek.h"
|
|
|
|
#define RTL8201F_IER 0x13
|
|
|
|
#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 RTL821x_INER 0x12
|
|
#define RTL8211B_INER_INIT 0x6400
|
|
#define RTL8211E_INER_LINK_STATUS BIT(10)
|
|
#define RTL8211F_INER_PME BIT(7)
|
|
#define RTL8211F_INER_LINK_STATUS BIT(4)
|
|
|
|
#define RTL821x_INSR 0x13
|
|
|
|
#define RTL821x_EXT_PAGE_SELECT 0x1e
|
|
|
|
#define RTL821x_PAGE_SELECT 0x1f
|
|
#define RTL821x_SET_EXT_PAGE 0x07
|
|
|
|
/* RTL8211E extension page 44/0x2c */
|
|
#define RTL8211E_LEDCR_EXT_PAGE 0x2c
|
|
#define RTL8211E_LEDCR1 0x1a
|
|
#define RTL8211E_LEDCR1_ACT_TXRX BIT(4)
|
|
#define RTL8211E_LEDCR1_MASK BIT(4)
|
|
#define RTL8211E_LEDCR1_SHIFT 1
|
|
|
|
#define RTL8211E_LEDCR2 0x1c
|
|
#define RTL8211E_LEDCR2_LINK_1000 BIT(2)
|
|
#define RTL8211E_LEDCR2_LINK_100 BIT(1)
|
|
#define RTL8211E_LEDCR2_LINK_10 BIT(0)
|
|
#define RTL8211E_LEDCR2_MASK GENMASK(2, 0)
|
|
#define RTL8211E_LEDCR2_SHIFT 4
|
|
|
|
/* RTL8211E extension page 164/0xa4 */
|
|
#define RTL8211E_RGMII_EXT_PAGE 0xa4
|
|
#define RTL8211E_RGMII_DELAY 0x1c
|
|
#define RTL8211E_CTRL_DELAY BIT(13)
|
|
#define RTL8211E_TX_DELAY BIT(12)
|
|
#define RTL8211E_RX_DELAY BIT(11)
|
|
#define RTL8211E_DELAY_MASK GENMASK(13, 11)
|
|
|
|
/* RTL8211F PHY configuration */
|
|
#define RTL8211F_PHYCR_PAGE 0xa43
|
|
#define RTL8211F_PHYCR1 0x18
|
|
#define RTL8211F_ALDPS_PLL_OFF BIT(1)
|
|
#define RTL8211F_ALDPS_ENABLE BIT(2)
|
|
#define RTL8211F_ALDPS_XTAL_OFF BIT(12)
|
|
|
|
#define RTL8211F_PHYCR2 0x19
|
|
#define RTL8211F_CLKOUT_EN BIT(0)
|
|
#define RTL8211F_PHYCR2_PHY_EEE_ENABLE BIT(5)
|
|
|
|
#define RTL8211F_INSR_PAGE 0xa43
|
|
#define RTL8211F_INSR 0x1d
|
|
|
|
/* RTL8211F LED configuration */
|
|
#define RTL8211F_LEDCR_PAGE 0xd04
|
|
#define RTL8211F_LEDCR 0x10
|
|
#define RTL8211F_LEDCR_MODE BIT(15)
|
|
#define RTL8211F_LEDCR_ACT_TXRX BIT(4)
|
|
#define RTL8211F_LEDCR_LINK_1000 BIT(3)
|
|
#define RTL8211F_LEDCR_LINK_100 BIT(1)
|
|
#define RTL8211F_LEDCR_LINK_10 BIT(0)
|
|
#define RTL8211F_LEDCR_MASK GENMASK(4, 0)
|
|
#define RTL8211F_LEDCR_SHIFT 5
|
|
|
|
/* RTL8211F(D)(I)-VD-CG CLKOUT configuration is specified via magic values
|
|
* to undocumented register pages. The names here do not reflect the datasheet.
|
|
* Unlike other PHY models, CLKOUT configuration does not go through PHYCR2.
|
|
*/
|
|
#define RTL8211FVD_CLKOUT_PAGE 0xd05
|
|
#define RTL8211FVD_CLKOUT_REG 0x11
|
|
#define RTL8211FVD_CLKOUT_EN BIT(8)
|
|
|
|
/* RTL8211F RGMII configuration */
|
|
#define RTL8211F_RGMII_PAGE 0xd08
|
|
|
|
#define RTL8211F_TXCR 0x11
|
|
#define RTL8211F_TX_DELAY BIT(8)
|
|
|
|
#define RTL8211F_RXCR 0x15
|
|
#define RTL8211F_RX_DELAY BIT(3)
|
|
|
|
/* RTL8211F WOL settings */
|
|
#define RTL8211F_WOL_PAGE 0xd8a
|
|
#define RTL8211F_WOL_SETTINGS_EVENTS 16
|
|
#define RTL8211F_WOL_EVENT_MAGIC BIT(12)
|
|
#define RTL8211F_WOL_RST_RMSQ 17
|
|
#define RTL8211F_WOL_RG_RSTB BIT(15)
|
|
#define RTL8211F_WOL_RMSQ 0x1fff
|
|
|
|
/* RTL8211F Unique phyiscal and multicast address (WOL) */
|
|
#define RTL8211F_PHYSICAL_ADDR_PAGE 0xd8c
|
|
#define RTL8211F_PHYSICAL_ADDR_WORD0 16
|
|
#define RTL8211F_PHYSICAL_ADDR_WORD1 17
|
|
#define RTL8211F_PHYSICAL_ADDR_WORD2 18
|
|
|
|
#define RTL822X_VND1_SERDES_OPTION 0x697a
|
|
#define RTL822X_VND1_SERDES_OPTION_MODE_MASK GENMASK(5, 0)
|
|
#define RTL822X_VND1_SERDES_OPTION_MODE_2500BASEX_SGMII 0
|
|
#define RTL822X_VND1_SERDES_OPTION_MODE_2500BASEX 2
|
|
|
|
#define RTL822X_VND1_SERDES_CTRL3 0x7580
|
|
#define RTL822X_VND1_SERDES_CTRL3_MODE_MASK GENMASK(5, 0)
|
|
#define RTL822X_VND1_SERDES_CTRL3_MODE_SGMII 0x02
|
|
#define RTL822X_VND1_SERDES_CTRL3_MODE_2500BASEX 0x16
|
|
|
|
/* RTL822X_VND2_XXXXX registers are only accessible when phydev->is_c45
|
|
* is set, they cannot be accessed by C45-over-C22.
|
|
*/
|
|
#define RTL822X_VND2_C22_REG(reg) (0xa400 + 2 * (reg))
|
|
|
|
#define RTL8221B_VND2_INER 0xa4d2
|
|
#define RTL8221B_VND2_INER_LINK_STATUS BIT(4)
|
|
|
|
#define RTL8221B_VND2_INSR 0xa4d4
|
|
|
|
#define RTL8224_MII_RTCT 0x11
|
|
#define RTL8224_MII_RTCT_ENABLE BIT(0)
|
|
#define RTL8224_MII_RTCT_PAIR_A BIT(4)
|
|
#define RTL8224_MII_RTCT_PAIR_B BIT(5)
|
|
#define RTL8224_MII_RTCT_PAIR_C BIT(6)
|
|
#define RTL8224_MII_RTCT_PAIR_D BIT(7)
|
|
#define RTL8224_MII_RTCT_DONE BIT(15)
|
|
|
|
#define RTL8224_MII_SRAM_ADDR 0x1b
|
|
#define RTL8224_MII_SRAM_DATA 0x1c
|
|
|
|
#define RTL8224_SRAM_RTCT_FAULT(pair) (0x8026 + (pair) * 4)
|
|
#define RTL8224_SRAM_RTCT_FAULT_BUSY BIT(0)
|
|
#define RTL8224_SRAM_RTCT_FAULT_OPEN BIT(3)
|
|
#define RTL8224_SRAM_RTCT_FAULT_SAME_SHORT BIT(4)
|
|
#define RTL8224_SRAM_RTCT_FAULT_OK BIT(5)
|
|
#define RTL8224_SRAM_RTCT_FAULT_DONE BIT(6)
|
|
#define RTL8224_SRAM_RTCT_FAULT_CROSS_SHORT BIT(7)
|
|
|
|
#define RTL8224_SRAM_RTCT_LEN(pair) (0x8028 + (pair) * 4)
|
|
|
|
#define RTL8366RB_POWER_SAVE 0x15
|
|
#define RTL8366RB_POWER_SAVE_ON BIT(12)
|
|
|
|
#define RTL9000A_GINMR 0x14
|
|
#define RTL9000A_GINMR_LINK_STATUS BIT(4)
|
|
|
|
#define RTL_VND2_PHYSR 0xa434
|
|
#define RTL_VND2_PHYSR_DUPLEX BIT(3)
|
|
#define RTL_VND2_PHYSR_SPEEDL GENMASK(5, 4)
|
|
#define RTL_VND2_PHYSR_SPEEDH GENMASK(10, 9)
|
|
#define RTL_VND2_PHYSR_MASTER BIT(11)
|
|
#define RTL_VND2_PHYSR_SPEED_MASK (RTL_VND2_PHYSR_SPEEDL | RTL_VND2_PHYSR_SPEEDH)
|
|
|
|
#define RTL_MDIO_PCS_EEE_ABLE 0xa5c4
|
|
#define RTL_MDIO_AN_EEE_ADV 0xa5d0
|
|
#define RTL_MDIO_AN_EEE_LPABLE 0xa5d2
|
|
#define RTL_MDIO_AN_10GBT_CTRL 0xa5d4
|
|
#define RTL_MDIO_AN_10GBT_STAT 0xa5d6
|
|
#define RTL_MDIO_PMA_SPEED 0xa616
|
|
#define RTL_MDIO_AN_EEE_LPABLE2 0xa6d0
|
|
#define RTL_MDIO_AN_EEE_ADV2 0xa6d4
|
|
#define RTL_MDIO_PCS_EEE_ABLE2 0xa6ec
|
|
|
|
#define RTL_GENERIC_PHYID 0x001cc800
|
|
#define RTL_8211FVD_PHYID 0x001cc878
|
|
#define RTL_8221B 0x001cc840
|
|
#define RTL_8221B_VB_CG 0x001cc849
|
|
#define RTL_8221B_VM_CG 0x001cc84a
|
|
#define RTL_8251B 0x001cc862
|
|
#define RTL_8261C 0x001cc890
|
|
|
|
/* RTL8211E and RTL8211F support up to three LEDs */
|
|
#define RTL8211x_LED_COUNT 3
|
|
|
|
MODULE_DESCRIPTION("Realtek PHY driver");
|
|
MODULE_AUTHOR("Johnson Leung");
|
|
MODULE_LICENSE("GPL");
|
|
|
|
struct rtl821x_priv {
|
|
bool enable_aldps;
|
|
bool disable_clk_out;
|
|
struct clk *clk;
|
|
/* rtl8211f */
|
|
u16 iner;
|
|
};
|
|
|
|
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_read_ext_page(struct phy_device *phydev, u16 ext_page,
|
|
u32 regnum)
|
|
{
|
|
int oldpage, ret = 0;
|
|
|
|
oldpage = phy_select_page(phydev, RTL821x_SET_EXT_PAGE);
|
|
if (oldpage >= 0) {
|
|
ret = __phy_write(phydev, RTL821x_EXT_PAGE_SELECT, ext_page);
|
|
if (ret == 0)
|
|
ret = __phy_read(phydev, regnum);
|
|
}
|
|
|
|
return phy_restore_page(phydev, oldpage, ret);
|
|
}
|
|
|
|
static int rtl821x_modify_ext_page(struct phy_device *phydev, u16 ext_page,
|
|
u32 regnum, u16 mask, u16 set)
|
|
{
|
|
int oldpage, ret = 0;
|
|
|
|
oldpage = phy_select_page(phydev, RTL821x_SET_EXT_PAGE);
|
|
if (oldpage >= 0) {
|
|
ret = __phy_write(phydev, RTL821x_EXT_PAGE_SELECT, ext_page);
|
|
if (ret == 0)
|
|
ret = __phy_modify(phydev, regnum, mask, set);
|
|
}
|
|
|
|
return phy_restore_page(phydev, oldpage, ret);
|
|
}
|
|
|
|
static int rtl821x_probe(struct phy_device *phydev)
|
|
{
|
|
struct device *dev = &phydev->mdio.dev;
|
|
struct rtl821x_priv *priv;
|
|
|
|
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");
|
|
|
|
priv->enable_aldps = of_property_read_bool(dev->of_node,
|
|
"realtek,aldps-enable");
|
|
priv->disable_clk_out = of_property_read_bool(dev->of_node,
|
|
"realtek,clkout-disable");
|
|
|
|
phydev->priv = priv;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rtl8211f_probe(struct phy_device *phydev)
|
|
{
|
|
struct device *dev = &phydev->mdio.dev;
|
|
int ret;
|
|
|
|
ret = rtl821x_probe(phydev);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/* Disable all PME events */
|
|
ret = phy_write_paged(phydev, RTL8211F_WOL_PAGE,
|
|
RTL8211F_WOL_SETTINGS_EVENTS, 0);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/* Mark this PHY as wakeup capable and register the interrupt as a
|
|
* wakeup IRQ if the PHY is marked as a wakeup source in firmware,
|
|
* and the interrupt is valid.
|
|
*/
|
|
if (device_property_read_bool(dev, "wakeup-source") &&
|
|
phy_interrupt_is_valid(phydev)) {
|
|
device_set_wakeup_capable(dev, true);
|
|
devm_pm_set_wake_irq(dev, phydev->irq);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
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, RTL8211F_INSR_PAGE, 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)
|
|
{
|
|
struct rtl821x_priv *priv = phydev->priv;
|
|
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);
|
|
if (err == 0)
|
|
priv->iner = val;
|
|
} else {
|
|
priv->iner = 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, RTL8211F_INSR_PAGE, RTL8211F_INSR);
|
|
if (irq_status < 0) {
|
|
phy_error(phydev);
|
|
return IRQ_NONE;
|
|
}
|
|
|
|
if (irq_status & RTL8211F_INER_LINK_STATUS) {
|
|
phy_trigger_machine(phydev);
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
if (irq_status & RTL8211F_INER_PME) {
|
|
pm_wakeup_event(&phydev->mdio.dev, 0);
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
return IRQ_NONE;
|
|
}
|
|
|
|
static void rtl8211f_get_wol(struct phy_device *dev, struct ethtool_wolinfo *wol)
|
|
{
|
|
int wol_events;
|
|
|
|
/* If the PHY is not capable of waking the system, then WoL can not
|
|
* be supported.
|
|
*/
|
|
if (!device_can_wakeup(&dev->mdio.dev)) {
|
|
wol->supported = 0;
|
|
return;
|
|
}
|
|
|
|
wol->supported = WAKE_MAGIC;
|
|
|
|
wol_events = phy_read_paged(dev, RTL8211F_WOL_PAGE, RTL8211F_WOL_SETTINGS_EVENTS);
|
|
if (wol_events < 0)
|
|
return;
|
|
|
|
if (wol_events & RTL8211F_WOL_EVENT_MAGIC)
|
|
wol->wolopts = WAKE_MAGIC;
|
|
}
|
|
|
|
static int rtl8211f_set_wol(struct phy_device *dev, struct ethtool_wolinfo *wol)
|
|
{
|
|
const u8 *mac_addr = dev->attached_dev->dev_addr;
|
|
int oldpage;
|
|
|
|
if (!device_can_wakeup(&dev->mdio.dev))
|
|
return -EOPNOTSUPP;
|
|
|
|
oldpage = phy_save_page(dev);
|
|
if (oldpage < 0)
|
|
goto err;
|
|
|
|
if (wol->wolopts & WAKE_MAGIC) {
|
|
/* Store the device address for the magic packet */
|
|
rtl821x_write_page(dev, RTL8211F_PHYSICAL_ADDR_PAGE);
|
|
__phy_write(dev, RTL8211F_PHYSICAL_ADDR_WORD0, mac_addr[1] << 8 | (mac_addr[0]));
|
|
__phy_write(dev, RTL8211F_PHYSICAL_ADDR_WORD1, mac_addr[3] << 8 | (mac_addr[2]));
|
|
__phy_write(dev, RTL8211F_PHYSICAL_ADDR_WORD2, mac_addr[5] << 8 | (mac_addr[4]));
|
|
|
|
/* Enable magic packet matching */
|
|
rtl821x_write_page(dev, RTL8211F_WOL_PAGE);
|
|
__phy_write(dev, RTL8211F_WOL_SETTINGS_EVENTS, RTL8211F_WOL_EVENT_MAGIC);
|
|
/* Set the maximum packet size, and assert WoL reset */
|
|
__phy_write(dev, RTL8211F_WOL_RST_RMSQ, RTL8211F_WOL_RMSQ);
|
|
} else {
|
|
/* Disable magic packet matching */
|
|
rtl821x_write_page(dev, RTL8211F_WOL_PAGE);
|
|
__phy_write(dev, RTL8211F_WOL_SETTINGS_EVENTS, 0);
|
|
|
|
/* Place WoL in reset */
|
|
__phy_clear_bits(dev, RTL8211F_WOL_RST_RMSQ,
|
|
RTL8211F_WOL_RG_RSTB);
|
|
}
|
|
|
|
device_set_wakeup_enable(&dev->mdio.dev, !!(wol->wolopts & WAKE_MAGIC));
|
|
|
|
err:
|
|
return phy_restore_page(dev, oldpage, 0);
|
|
}
|
|
|
|
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_rgmii_delay(struct phy_device *phydev)
|
|
{
|
|
u16 val_txdly, val_rxdly;
|
|
int 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, RTL8211F_RGMII_PAGE,
|
|
RTL8211F_TXCR, RTL8211F_TX_DELAY,
|
|
val_txdly);
|
|
if (ret < 0) {
|
|
phydev_err(phydev, "Failed to update the TX delay register: %pe\n",
|
|
ERR_PTR(ret));
|
|
return ret;
|
|
} else if (ret) {
|
|
phydev_dbg(phydev,
|
|
"%s 2ns TX delay (and changing the value from pin-strapping RXD1 or the bootloader)\n",
|
|
str_enable_disable(val_txdly));
|
|
} else {
|
|
phydev_dbg(phydev,
|
|
"2ns TX delay was already %s (by pin-strapping RXD1 or bootloader configuration)\n",
|
|
str_enabled_disabled(val_txdly));
|
|
}
|
|
|
|
ret = phy_modify_paged_changed(phydev, RTL8211F_RGMII_PAGE,
|
|
RTL8211F_RXCR, RTL8211F_RX_DELAY,
|
|
val_rxdly);
|
|
if (ret < 0) {
|
|
phydev_err(phydev, "Failed to update the RX delay register: %pe\n",
|
|
ERR_PTR(ret));
|
|
return ret;
|
|
} else if (ret) {
|
|
phydev_dbg(phydev,
|
|
"%s 2ns RX delay (and changing the value from pin-strapping RXD0 or the bootloader)\n",
|
|
str_enable_disable(val_rxdly));
|
|
} else {
|
|
phydev_dbg(phydev,
|
|
"2ns RX delay was already %s (by pin-strapping RXD0 or bootloader configuration)\n",
|
|
str_enabled_disabled(val_rxdly));
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rtl8211f_config_clk_out(struct phy_device *phydev)
|
|
{
|
|
struct rtl821x_priv *priv = phydev->priv;
|
|
int ret;
|
|
|
|
/* The value is preserved if the device tree property is absent */
|
|
if (!priv->disable_clk_out)
|
|
return 0;
|
|
|
|
if (phydev->drv->phy_id == RTL_8211FVD_PHYID)
|
|
ret = phy_modify_paged(phydev, RTL8211FVD_CLKOUT_PAGE,
|
|
RTL8211FVD_CLKOUT_REG,
|
|
RTL8211FVD_CLKOUT_EN, 0);
|
|
else
|
|
ret = phy_modify_paged(phydev, RTL8211F_PHYCR_PAGE,
|
|
RTL8211F_PHYCR2, RTL8211F_CLKOUT_EN, 0);
|
|
if (ret)
|
|
return ret;
|
|
|
|
return genphy_soft_reset(phydev);
|
|
}
|
|
|
|
/* Advance Link Down Power Saving (ALDPS) mode changes crystal/clock behaviour,
|
|
* which causes the RXC clock signal to stop for tens to hundreds of
|
|
* milliseconds.
|
|
*
|
|
* Some MACs need the RXC clock to support their internal RX logic, so ALDPS is
|
|
* only enabled based on an opt-in device tree property.
|
|
*/
|
|
static int rtl8211f_config_aldps(struct phy_device *phydev)
|
|
{
|
|
struct rtl821x_priv *priv = phydev->priv;
|
|
u16 mask = RTL8211F_ALDPS_PLL_OFF |
|
|
RTL8211F_ALDPS_ENABLE |
|
|
RTL8211F_ALDPS_XTAL_OFF;
|
|
|
|
/* The value is preserved if the device tree property is absent */
|
|
if (!priv->enable_aldps)
|
|
return 0;
|
|
|
|
return phy_modify_paged(phydev, RTL8211F_PHYCR_PAGE, RTL8211F_PHYCR1,
|
|
mask, mask);
|
|
}
|
|
|
|
static int rtl8211f_config_phy_eee(struct phy_device *phydev)
|
|
{
|
|
/* Disable PHY-mode EEE so LPI is passed to the MAC */
|
|
return phy_modify_paged(phydev, RTL8211F_PHYCR_PAGE, RTL8211F_PHYCR2,
|
|
RTL8211F_PHYCR2_PHY_EEE_ENABLE, 0);
|
|
}
|
|
|
|
static int rtl8211f_config_init(struct phy_device *phydev)
|
|
{
|
|
struct device *dev = &phydev->mdio.dev;
|
|
int ret;
|
|
|
|
ret = rtl8211f_config_aldps(phydev);
|
|
if (ret) {
|
|
dev_err(dev, "aldps mode configuration failed: %pe\n",
|
|
ERR_PTR(ret));
|
|
return ret;
|
|
}
|
|
|
|
ret = rtl8211f_config_rgmii_delay(phydev);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = rtl8211f_config_clk_out(phydev);
|
|
if (ret) {
|
|
dev_err(dev, "clkout configuration failed: %pe\n",
|
|
ERR_PTR(ret));
|
|
return ret;
|
|
}
|
|
|
|
return rtl8211f_config_phy_eee(phydev);
|
|
}
|
|
|
|
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 rtl8211f_suspend(struct phy_device *phydev)
|
|
{
|
|
u16 wol_rst;
|
|
int ret;
|
|
|
|
ret = rtl821x_suspend(phydev);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/* If a PME event is enabled, then configure the interrupt for
|
|
* PME events only, disabling link interrupt. We avoid switching
|
|
* to PMEB mode as we don't have a status bit for that.
|
|
*/
|
|
if (device_may_wakeup(&phydev->mdio.dev)) {
|
|
ret = phy_write_paged(phydev, 0xa42, RTL821x_INER,
|
|
RTL8211F_INER_PME);
|
|
if (ret < 0)
|
|
goto err;
|
|
|
|
/* Read the INSR to clear any pending interrupt */
|
|
phy_read_paged(phydev, RTL8211F_INSR_PAGE, RTL8211F_INSR);
|
|
|
|
/* Reset the WoL to ensure that an event is picked up.
|
|
* Unless we do this, even if we receive another packet,
|
|
* we may not have a PME interrupt raised.
|
|
*/
|
|
ret = phy_read_paged(phydev, RTL8211F_WOL_PAGE,
|
|
RTL8211F_WOL_RST_RMSQ);
|
|
if (ret < 0)
|
|
goto err;
|
|
|
|
wol_rst = ret & ~RTL8211F_WOL_RG_RSTB;
|
|
ret = phy_write_paged(phydev, RTL8211F_WOL_PAGE,
|
|
RTL8211F_WOL_RST_RMSQ, wol_rst);
|
|
if (ret < 0)
|
|
goto err;
|
|
|
|
wol_rst |= RTL8211F_WOL_RG_RSTB;
|
|
ret = phy_write_paged(phydev, RTL8211F_WOL_PAGE,
|
|
RTL8211F_WOL_RST_RMSQ, wol_rst);
|
|
}
|
|
|
|
err:
|
|
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 rtl8211f_resume(struct phy_device *phydev)
|
|
{
|
|
struct rtl821x_priv *priv = phydev->priv;
|
|
int ret;
|
|
|
|
ret = rtl821x_resume(phydev);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/* If the device was programmed for a PME event, restore the interrupt
|
|
* enable so phylib can receive link state interrupts.
|
|
*/
|
|
if (device_may_wakeup(&phydev->mdio.dev))
|
|
ret = phy_write_paged(phydev, 0xa42, RTL821x_INER, priv->iner);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int rtl8211x_led_hw_is_supported(struct phy_device *phydev, u8 index,
|
|
unsigned long rules)
|
|
{
|
|
const unsigned long mask = BIT(TRIGGER_NETDEV_LINK) |
|
|
BIT(TRIGGER_NETDEV_LINK_10) |
|
|
BIT(TRIGGER_NETDEV_LINK_100) |
|
|
BIT(TRIGGER_NETDEV_LINK_1000) |
|
|
BIT(TRIGGER_NETDEV_RX) |
|
|
BIT(TRIGGER_NETDEV_TX);
|
|
|
|
/* The RTL8211F PHY supports these LED settings on up to three LEDs:
|
|
* - Link: Configurable subset of 10/100/1000 link rates
|
|
* - Active: Blink on activity, RX or TX is not differentiated
|
|
* The Active option has two modes, A and B:
|
|
* - A: Link and Active indication at configurable, but matching,
|
|
* subset of 10/100/1000 link rates
|
|
* - B: Link indication at configurable subset of 10/100/1000 link
|
|
* rates and Active indication always at all three 10+100+1000
|
|
* link rates.
|
|
* This code currently uses mode B only.
|
|
*
|
|
* RTL8211E PHY LED has one mode, which works like RTL8211F mode B.
|
|
*/
|
|
|
|
if (index >= RTL8211x_LED_COUNT)
|
|
return -EINVAL;
|
|
|
|
/* Filter out any other unsupported triggers. */
|
|
if (rules & ~mask)
|
|
return -EOPNOTSUPP;
|
|
|
|
/* RX and TX are not differentiated, either both are set or not set. */
|
|
if (!(rules & BIT(TRIGGER_NETDEV_RX)) ^ !(rules & BIT(TRIGGER_NETDEV_TX)))
|
|
return -EOPNOTSUPP;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rtl8211f_led_hw_control_get(struct phy_device *phydev, u8 index,
|
|
unsigned long *rules)
|
|
{
|
|
int val;
|
|
|
|
if (index >= RTL8211x_LED_COUNT)
|
|
return -EINVAL;
|
|
|
|
val = phy_read_paged(phydev, 0xd04, RTL8211F_LEDCR);
|
|
if (val < 0)
|
|
return val;
|
|
|
|
val >>= RTL8211F_LEDCR_SHIFT * index;
|
|
val &= RTL8211F_LEDCR_MASK;
|
|
|
|
if (val & RTL8211F_LEDCR_LINK_10)
|
|
__set_bit(TRIGGER_NETDEV_LINK_10, rules);
|
|
|
|
if (val & RTL8211F_LEDCR_LINK_100)
|
|
__set_bit(TRIGGER_NETDEV_LINK_100, rules);
|
|
|
|
if (val & RTL8211F_LEDCR_LINK_1000)
|
|
__set_bit(TRIGGER_NETDEV_LINK_1000, rules);
|
|
|
|
if ((val & RTL8211F_LEDCR_LINK_10) &&
|
|
(val & RTL8211F_LEDCR_LINK_100) &&
|
|
(val & RTL8211F_LEDCR_LINK_1000)) {
|
|
__set_bit(TRIGGER_NETDEV_LINK, rules);
|
|
}
|
|
|
|
if (val & RTL8211F_LEDCR_ACT_TXRX) {
|
|
__set_bit(TRIGGER_NETDEV_RX, rules);
|
|
__set_bit(TRIGGER_NETDEV_TX, rules);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rtl8211f_led_hw_control_set(struct phy_device *phydev, u8 index,
|
|
unsigned long rules)
|
|
{
|
|
const u16 mask = RTL8211F_LEDCR_MASK << (RTL8211F_LEDCR_SHIFT * index);
|
|
u16 reg = 0;
|
|
|
|
if (index >= RTL8211x_LED_COUNT)
|
|
return -EINVAL;
|
|
|
|
if (test_bit(TRIGGER_NETDEV_LINK, &rules) ||
|
|
test_bit(TRIGGER_NETDEV_LINK_10, &rules)) {
|
|
reg |= RTL8211F_LEDCR_LINK_10;
|
|
}
|
|
|
|
if (test_bit(TRIGGER_NETDEV_LINK, &rules) ||
|
|
test_bit(TRIGGER_NETDEV_LINK_100, &rules)) {
|
|
reg |= RTL8211F_LEDCR_LINK_100;
|
|
}
|
|
|
|
if (test_bit(TRIGGER_NETDEV_LINK, &rules) ||
|
|
test_bit(TRIGGER_NETDEV_LINK_1000, &rules)) {
|
|
reg |= RTL8211F_LEDCR_LINK_1000;
|
|
}
|
|
|
|
if (test_bit(TRIGGER_NETDEV_RX, &rules) ||
|
|
test_bit(TRIGGER_NETDEV_TX, &rules)) {
|
|
reg |= RTL8211F_LEDCR_ACT_TXRX;
|
|
}
|
|
|
|
reg <<= RTL8211F_LEDCR_SHIFT * index;
|
|
reg |= RTL8211F_LEDCR_MODE; /* Mode B */
|
|
|
|
return phy_modify_paged(phydev, 0xd04, RTL8211F_LEDCR, mask, reg);
|
|
}
|
|
|
|
static int rtl8211e_led_hw_control_get(struct phy_device *phydev, u8 index,
|
|
unsigned long *rules)
|
|
{
|
|
int ret;
|
|
u16 cr1, cr2;
|
|
|
|
if (index >= RTL8211x_LED_COUNT)
|
|
return -EINVAL;
|
|
|
|
ret = rtl821x_read_ext_page(phydev, RTL8211E_LEDCR_EXT_PAGE,
|
|
RTL8211E_LEDCR1);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
cr1 = ret >> RTL8211E_LEDCR1_SHIFT * index;
|
|
if (cr1 & RTL8211E_LEDCR1_ACT_TXRX) {
|
|
__set_bit(TRIGGER_NETDEV_RX, rules);
|
|
__set_bit(TRIGGER_NETDEV_TX, rules);
|
|
}
|
|
|
|
ret = rtl821x_read_ext_page(phydev, RTL8211E_LEDCR_EXT_PAGE,
|
|
RTL8211E_LEDCR2);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
cr2 = ret >> RTL8211E_LEDCR2_SHIFT * index;
|
|
if (cr2 & RTL8211E_LEDCR2_LINK_10)
|
|
__set_bit(TRIGGER_NETDEV_LINK_10, rules);
|
|
|
|
if (cr2 & RTL8211E_LEDCR2_LINK_100)
|
|
__set_bit(TRIGGER_NETDEV_LINK_100, rules);
|
|
|
|
if (cr2 & RTL8211E_LEDCR2_LINK_1000)
|
|
__set_bit(TRIGGER_NETDEV_LINK_1000, rules);
|
|
|
|
if ((cr2 & RTL8211E_LEDCR2_LINK_10) &&
|
|
(cr2 & RTL8211E_LEDCR2_LINK_100) &&
|
|
(cr2 & RTL8211E_LEDCR2_LINK_1000)) {
|
|
__set_bit(TRIGGER_NETDEV_LINK, rules);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int rtl8211e_led_hw_control_set(struct phy_device *phydev, u8 index,
|
|
unsigned long rules)
|
|
{
|
|
const u16 cr1mask =
|
|
RTL8211E_LEDCR1_MASK << (RTL8211E_LEDCR1_SHIFT * index);
|
|
const u16 cr2mask =
|
|
RTL8211E_LEDCR2_MASK << (RTL8211E_LEDCR2_SHIFT * index);
|
|
u16 cr1 = 0, cr2 = 0;
|
|
int ret;
|
|
|
|
if (index >= RTL8211x_LED_COUNT)
|
|
return -EINVAL;
|
|
|
|
if (test_bit(TRIGGER_NETDEV_RX, &rules) ||
|
|
test_bit(TRIGGER_NETDEV_TX, &rules)) {
|
|
cr1 |= RTL8211E_LEDCR1_ACT_TXRX;
|
|
}
|
|
|
|
cr1 <<= RTL8211E_LEDCR1_SHIFT * index;
|
|
ret = rtl821x_modify_ext_page(phydev, RTL8211E_LEDCR_EXT_PAGE,
|
|
RTL8211E_LEDCR1, cr1mask, cr1);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
if (test_bit(TRIGGER_NETDEV_LINK, &rules) ||
|
|
test_bit(TRIGGER_NETDEV_LINK_10, &rules)) {
|
|
cr2 |= RTL8211E_LEDCR2_LINK_10;
|
|
}
|
|
|
|
if (test_bit(TRIGGER_NETDEV_LINK, &rules) ||
|
|
test_bit(TRIGGER_NETDEV_LINK_100, &rules)) {
|
|
cr2 |= RTL8211E_LEDCR2_LINK_100;
|
|
}
|
|
|
|
if (test_bit(TRIGGER_NETDEV_LINK, &rules) ||
|
|
test_bit(TRIGGER_NETDEV_LINK_1000, &rules)) {
|
|
cr2 |= RTL8211E_LEDCR2_LINK_1000;
|
|
}
|
|
|
|
cr2 <<= RTL8211E_LEDCR2_SHIFT * index;
|
|
ret = rtl821x_modify_ext_page(phydev, RTL8211E_LEDCR_EXT_PAGE,
|
|
RTL8211E_LEDCR2, cr2mask, cr2);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int rtl8211e_config_init(struct phy_device *phydev)
|
|
{
|
|
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
|
|
*/
|
|
return rtl821x_modify_ext_page(phydev, RTL8211E_RGMII_EXT_PAGE,
|
|
RTL8211E_RGMII_DELAY,
|
|
RTL8211E_DELAY_MASK, val);
|
|
}
|
|
|
|
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 void rtlgen_decode_physr(struct phy_device *phydev, int val)
|
|
{
|
|
/* bit 3
|
|
* 0: Half Duplex
|
|
* 1: Full Duplex
|
|
*/
|
|
if (val & RTL_VND2_PHYSR_DUPLEX)
|
|
phydev->duplex = DUPLEX_FULL;
|
|
else
|
|
phydev->duplex = DUPLEX_HALF;
|
|
|
|
switch (val & RTL_VND2_PHYSR_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;
|
|
}
|
|
|
|
/* bit 11
|
|
* 0: Slave Mode
|
|
* 1: Master Mode
|
|
*/
|
|
if (phydev->speed >= 1000) {
|
|
if (val & RTL_VND2_PHYSR_MASTER)
|
|
phydev->master_slave_state = MASTER_SLAVE_STATE_MASTER;
|
|
else
|
|
phydev->master_slave_state = MASTER_SLAVE_STATE_SLAVE;
|
|
} else {
|
|
phydev->master_slave_state = MASTER_SLAVE_STATE_UNSUPPORTED;
|
|
}
|
|
}
|
|
|
|
static int rtlgen_read_status(struct phy_device *phydev)
|
|
{
|
|
int ret, val;
|
|
|
|
ret = genphy_read_status(phydev);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
if (!phydev->link)
|
|
return 0;
|
|
|
|
val = phy_read_paged(phydev, 0xa43, 0x12);
|
|
if (val < 0)
|
|
return val;
|
|
|
|
rtlgen_decode_physr(phydev, val);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rtlgen_read_vend2(struct phy_device *phydev, int regnum)
|
|
{
|
|
return __mdiobus_c45_read(phydev->mdio.bus, 0, MDIO_MMD_VEND2, regnum);
|
|
}
|
|
|
|
static int rtlgen_write_vend2(struct phy_device *phydev, int regnum, u16 val)
|
|
{
|
|
return __mdiobus_c45_write(phydev->mdio.bus, 0, MDIO_MMD_VEND2, regnum,
|
|
val);
|
|
}
|
|
|
|
static int rtlgen_read_mmd(struct phy_device *phydev, int devnum, u16 regnum)
|
|
{
|
|
int ret;
|
|
|
|
if (devnum == MDIO_MMD_VEND2)
|
|
ret = rtlgen_read_vend2(phydev, regnum);
|
|
else if (devnum == MDIO_MMD_PCS && regnum == MDIO_PCS_EEE_ABLE)
|
|
ret = rtlgen_read_vend2(phydev, RTL_MDIO_PCS_EEE_ABLE);
|
|
else if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_ADV)
|
|
ret = rtlgen_read_vend2(phydev, RTL_MDIO_AN_EEE_ADV);
|
|
else if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_LPABLE)
|
|
ret = rtlgen_read_vend2(phydev, RTL_MDIO_AN_EEE_LPABLE);
|
|
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_VEND2)
|
|
ret = rtlgen_write_vend2(phydev, regnum, val);
|
|
else if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_ADV)
|
|
ret = rtlgen_write_vend2(phydev, regnum, RTL_MDIO_AN_EEE_ADV);
|
|
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)
|
|
ret = rtlgen_read_vend2(phydev, RTL_MDIO_PCS_EEE_ABLE2);
|
|
else if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_ADV2)
|
|
ret = rtlgen_read_vend2(phydev, RTL_MDIO_AN_EEE_ADV2);
|
|
else if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_LPABLE2)
|
|
ret = rtlgen_read_vend2(phydev, RTL_MDIO_AN_EEE_LPABLE2);
|
|
|
|
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)
|
|
ret = rtlgen_write_vend2(phydev, RTL_MDIO_AN_EEE_ADV2, val);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int rtl822x_probe(struct phy_device *phydev)
|
|
{
|
|
if (IS_ENABLED(CONFIG_REALTEK_PHY_HWMON) &&
|
|
phydev->phy_id != RTL_GENERIC_PHYID)
|
|
return rtl822x_hwmon_init(phydev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rtl822x_set_serdes_option_mode(struct phy_device *phydev, bool gen1)
|
|
{
|
|
bool has_2500, has_sgmii;
|
|
u16 mode;
|
|
int ret;
|
|
|
|
has_2500 = test_bit(PHY_INTERFACE_MODE_2500BASEX,
|
|
phydev->host_interfaces) ||
|
|
phydev->interface == PHY_INTERFACE_MODE_2500BASEX;
|
|
|
|
has_sgmii = test_bit(PHY_INTERFACE_MODE_SGMII,
|
|
phydev->host_interfaces) ||
|
|
phydev->interface == PHY_INTERFACE_MODE_SGMII;
|
|
|
|
/* fill in possible interfaces */
|
|
__assign_bit(PHY_INTERFACE_MODE_2500BASEX, phydev->possible_interfaces,
|
|
has_2500);
|
|
__assign_bit(PHY_INTERFACE_MODE_SGMII, phydev->possible_interfaces,
|
|
has_sgmii);
|
|
|
|
if (!has_2500 && !has_sgmii)
|
|
return 0;
|
|
|
|
/* determine SerDes option mode */
|
|
if (has_2500 && !has_sgmii) {
|
|
mode = RTL822X_VND1_SERDES_OPTION_MODE_2500BASEX;
|
|
phydev->rate_matching = RATE_MATCH_PAUSE;
|
|
} else {
|
|
mode = RTL822X_VND1_SERDES_OPTION_MODE_2500BASEX_SGMII;
|
|
phydev->rate_matching = RATE_MATCH_NONE;
|
|
}
|
|
|
|
/* the following sequence with magic numbers sets up the SerDes
|
|
* option mode
|
|
*/
|
|
|
|
if (!gen1) {
|
|
ret = phy_write_mmd(phydev, MDIO_MMD_VEND1, 0x75f3, 0);
|
|
if (ret < 0)
|
|
return ret;
|
|
}
|
|
|
|
ret = phy_modify_mmd_changed(phydev, MDIO_MMD_VEND1,
|
|
RTL822X_VND1_SERDES_OPTION,
|
|
RTL822X_VND1_SERDES_OPTION_MODE_MASK,
|
|
mode);
|
|
if (gen1 || ret < 0)
|
|
return ret;
|
|
|
|
ret = phy_write_mmd(phydev, MDIO_MMD_VEND1, 0x6a04, 0x0503);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = phy_write_mmd(phydev, MDIO_MMD_VEND1, 0x6f10, 0xd455);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return phy_write_mmd(phydev, MDIO_MMD_VEND1, 0x6f11, 0x8020);
|
|
}
|
|
|
|
static int rtl822x_config_init(struct phy_device *phydev)
|
|
{
|
|
return rtl822x_set_serdes_option_mode(phydev, true);
|
|
}
|
|
|
|
static int rtl822xb_config_init(struct phy_device *phydev)
|
|
{
|
|
return rtl822x_set_serdes_option_mode(phydev, false);
|
|
}
|
|
|
|
static int rtl822xb_get_rate_matching(struct phy_device *phydev,
|
|
phy_interface_t iface)
|
|
{
|
|
int val;
|
|
|
|
/* Only rate matching at 2500base-x */
|
|
if (iface != PHY_INTERFACE_MODE_2500BASEX)
|
|
return RATE_MATCH_NONE;
|
|
|
|
val = phy_read_mmd(phydev, MDIO_MMD_VEND1, RTL822X_VND1_SERDES_OPTION);
|
|
if (val < 0)
|
|
return val;
|
|
|
|
if ((val & RTL822X_VND1_SERDES_OPTION_MODE_MASK) ==
|
|
RTL822X_VND1_SERDES_OPTION_MODE_2500BASEX)
|
|
return RATE_MATCH_PAUSE;
|
|
|
|
/* RTL822X_VND1_SERDES_OPTION_MODE_2500BASEX_SGMII */
|
|
return RATE_MATCH_NONE;
|
|
}
|
|
|
|
static int rtl822x_get_features(struct phy_device *phydev)
|
|
{
|
|
int val;
|
|
|
|
val = phy_read_mmd(phydev, MDIO_MMD_VEND2, RTL_MDIO_PMA_SPEED);
|
|
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_mmd_changed(phydev, MDIO_MMD_VEND2,
|
|
RTL_MDIO_AN_10GBT_CTRL,
|
|
MDIO_AN_10GBT_CTRL_ADV2_5G |
|
|
MDIO_AN_10GBT_CTRL_ADV5G, adv);
|
|
if (ret < 0)
|
|
return ret;
|
|
}
|
|
|
|
return __genphy_config_aneg(phydev, ret);
|
|
}
|
|
|
|
static void rtl822xb_update_interface(struct phy_device *phydev)
|
|
{
|
|
int val;
|
|
|
|
if (!phydev->link)
|
|
return;
|
|
|
|
/* Change interface according to serdes mode */
|
|
val = phy_read_mmd(phydev, MDIO_MMD_VEND1, RTL822X_VND1_SERDES_CTRL3);
|
|
if (val < 0)
|
|
return;
|
|
|
|
switch (val & RTL822X_VND1_SERDES_CTRL3_MODE_MASK) {
|
|
case RTL822X_VND1_SERDES_CTRL3_MODE_2500BASEX:
|
|
phydev->interface = PHY_INTERFACE_MODE_2500BASEX;
|
|
break;
|
|
case RTL822X_VND1_SERDES_CTRL3_MODE_SGMII:
|
|
phydev->interface = PHY_INTERFACE_MODE_SGMII;
|
|
break;
|
|
}
|
|
}
|
|
|
|
static int rtl822x_read_status(struct phy_device *phydev)
|
|
{
|
|
int lpadv, ret;
|
|
|
|
mii_10gbt_stat_mod_linkmode_lpa_t(phydev->lp_advertising, 0);
|
|
|
|
ret = rtlgen_read_status(phydev);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
if (phydev->autoneg == AUTONEG_DISABLE ||
|
|
!phydev->autoneg_complete)
|
|
return 0;
|
|
|
|
lpadv = phy_read_mmd(phydev, MDIO_MMD_VEND2, RTL_MDIO_AN_10GBT_STAT);
|
|
if (lpadv < 0)
|
|
return lpadv;
|
|
|
|
mii_10gbt_stat_mod_linkmode_lpa_t(phydev->lp_advertising, lpadv);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rtl822xb_read_status(struct phy_device *phydev)
|
|
{
|
|
int ret;
|
|
|
|
ret = rtl822x_read_status(phydev);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
rtl822xb_update_interface(phydev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rtl822x_c45_get_features(struct phy_device *phydev)
|
|
{
|
|
linkmode_set_bit(ETHTOOL_LINK_MODE_TP_BIT,
|
|
phydev->supported);
|
|
|
|
return genphy_c45_pma_read_abilities(phydev);
|
|
}
|
|
|
|
static int rtl822x_c45_config_aneg(struct phy_device *phydev)
|
|
{
|
|
bool changed = false;
|
|
int ret, val;
|
|
|
|
if (phydev->autoneg == AUTONEG_DISABLE)
|
|
return genphy_c45_pma_setup_forced(phydev);
|
|
|
|
ret = genphy_c45_an_config_aneg(phydev);
|
|
if (ret < 0)
|
|
return ret;
|
|
if (ret > 0)
|
|
changed = true;
|
|
|
|
val = linkmode_adv_to_mii_ctrl1000_t(phydev->advertising);
|
|
|
|
/* Vendor register as C45 has no standardized support for 1000BaseT */
|
|
ret = phy_modify_mmd_changed(phydev, MDIO_MMD_VEND2,
|
|
RTL822X_VND2_C22_REG(MII_CTRL1000),
|
|
ADVERTISE_1000FULL, val);
|
|
if (ret < 0)
|
|
return ret;
|
|
if (ret > 0)
|
|
changed = true;
|
|
|
|
return genphy_c45_check_and_restart_aneg(phydev, changed);
|
|
}
|
|
|
|
static int rtl822x_c45_read_status(struct phy_device *phydev)
|
|
{
|
|
int ret, val;
|
|
|
|
/* Vendor register as C45 has no standardized support for 1000BaseT */
|
|
if (phydev->autoneg == AUTONEG_ENABLE && genphy_c45_aneg_done(phydev)) {
|
|
val = phy_read_mmd(phydev, MDIO_MMD_VEND2,
|
|
RTL822X_VND2_C22_REG(MII_STAT1000));
|
|
if (val < 0)
|
|
return val;
|
|
} else {
|
|
val = 0;
|
|
}
|
|
mii_stat1000_mod_linkmode_lpa_t(phydev->lp_advertising, val);
|
|
|
|
ret = genphy_c45_read_status(phydev);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
if (!phydev->link) {
|
|
phydev->master_slave_state = MASTER_SLAVE_STATE_UNKNOWN;
|
|
return 0;
|
|
}
|
|
|
|
/* Read actual speed from vendor register. */
|
|
val = phy_read_mmd(phydev, MDIO_MMD_VEND2, RTL_VND2_PHYSR);
|
|
if (val < 0)
|
|
return val;
|
|
|
|
rtlgen_decode_physr(phydev, val);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rtl822x_c45_soft_reset(struct phy_device *phydev)
|
|
{
|
|
int ret, val;
|
|
|
|
ret = phy_modify_mmd(phydev, MDIO_MMD_PMAPMD, MDIO_CTRL1,
|
|
MDIO_CTRL1_RESET, MDIO_CTRL1_RESET);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return phy_read_mmd_poll_timeout(phydev, MDIO_MMD_PMAPMD,
|
|
MDIO_CTRL1, val,
|
|
!(val & MDIO_CTRL1_RESET),
|
|
5000, 100000, true);
|
|
}
|
|
|
|
static int rtl822xb_c45_read_status(struct phy_device *phydev)
|
|
{
|
|
int ret;
|
|
|
|
ret = rtl822x_c45_read_status(phydev);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
rtl822xb_update_interface(phydev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rtl8224_cable_test_start(struct phy_device *phydev)
|
|
{
|
|
u32 val;
|
|
int ret;
|
|
|
|
/* disable auto-negotiation and force 1000/Full */
|
|
ret = phy_modify_mmd(phydev, MDIO_MMD_VEND2,
|
|
RTL822X_VND2_C22_REG(MII_BMCR),
|
|
BMCR_ANENABLE | BMCR_SPEED100 | BMCR_SPEED10,
|
|
BMCR_SPEED1000 | BMCR_FULLDPLX);
|
|
if (ret)
|
|
return ret;
|
|
|
|
mdelay(500);
|
|
|
|
/* trigger cable test */
|
|
val = RTL8224_MII_RTCT_ENABLE;
|
|
val |= RTL8224_MII_RTCT_PAIR_A;
|
|
val |= RTL8224_MII_RTCT_PAIR_B;
|
|
val |= RTL8224_MII_RTCT_PAIR_C;
|
|
val |= RTL8224_MII_RTCT_PAIR_D;
|
|
|
|
return phy_modify_mmd(phydev, MDIO_MMD_VEND2,
|
|
RTL822X_VND2_C22_REG(RTL8224_MII_RTCT),
|
|
RTL8224_MII_RTCT_DONE, val);
|
|
}
|
|
|
|
static int rtl8224_sram_read(struct phy_device *phydev, u32 reg)
|
|
{
|
|
int ret;
|
|
|
|
ret = phy_write_mmd(phydev, MDIO_MMD_VEND2,
|
|
RTL822X_VND2_C22_REG(RTL8224_MII_SRAM_ADDR),
|
|
reg);
|
|
if (ret)
|
|
return ret;
|
|
|
|
return phy_read_mmd(phydev, MDIO_MMD_VEND2,
|
|
RTL822X_VND2_C22_REG(RTL8224_MII_SRAM_DATA));
|
|
}
|
|
|
|
static int rtl8224_pair_len_get(struct phy_device *phydev, u32 pair)
|
|
{
|
|
int cable_len;
|
|
u32 reg_len;
|
|
int ret;
|
|
u32 cm;
|
|
|
|
reg_len = RTL8224_SRAM_RTCT_LEN(pair);
|
|
|
|
ret = rtl8224_sram_read(phydev, reg_len);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
cable_len = ret & 0xff00;
|
|
|
|
ret = rtl8224_sram_read(phydev, reg_len + 1);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
cable_len |= (ret & 0xff00) >> 8;
|
|
|
|
cable_len -= 620;
|
|
cable_len = max(cable_len, 0);
|
|
|
|
cm = cable_len * 100 / 78;
|
|
|
|
return cm;
|
|
}
|
|
|
|
static int rtl8224_cable_test_result_trans(u32 result)
|
|
{
|
|
if (!(result & RTL8224_SRAM_RTCT_FAULT_DONE))
|
|
return -EBUSY;
|
|
|
|
if (result & RTL8224_SRAM_RTCT_FAULT_OK)
|
|
return ETHTOOL_A_CABLE_RESULT_CODE_OK;
|
|
|
|
if (result & RTL8224_SRAM_RTCT_FAULT_OPEN)
|
|
return ETHTOOL_A_CABLE_RESULT_CODE_OPEN;
|
|
|
|
if (result & RTL8224_SRAM_RTCT_FAULT_SAME_SHORT)
|
|
return ETHTOOL_A_CABLE_RESULT_CODE_SAME_SHORT;
|
|
|
|
if (result & RTL8224_SRAM_RTCT_FAULT_BUSY)
|
|
return ETHTOOL_A_CABLE_RESULT_CODE_UNSPEC;
|
|
|
|
if (result & RTL8224_SRAM_RTCT_FAULT_CROSS_SHORT)
|
|
return ETHTOOL_A_CABLE_RESULT_CODE_CROSS_SHORT;
|
|
|
|
return ETHTOOL_A_CABLE_RESULT_CODE_UNSPEC;
|
|
}
|
|
|
|
static int rtl8224_cable_test_report_pair(struct phy_device *phydev, unsigned int pair)
|
|
{
|
|
int fault_rslt;
|
|
int ret;
|
|
|
|
ret = rtl8224_sram_read(phydev, RTL8224_SRAM_RTCT_FAULT(pair));
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
fault_rslt = rtl8224_cable_test_result_trans(ret);
|
|
if (fault_rslt < 0)
|
|
return 0;
|
|
|
|
ret = ethnl_cable_test_result(phydev, pair, fault_rslt);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
switch (fault_rslt) {
|
|
case ETHTOOL_A_CABLE_RESULT_CODE_OPEN:
|
|
case ETHTOOL_A_CABLE_RESULT_CODE_SAME_SHORT:
|
|
case ETHTOOL_A_CABLE_RESULT_CODE_CROSS_SHORT:
|
|
ret = rtl8224_pair_len_get(phydev, pair);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return ethnl_cable_test_fault_length(phydev, pair, ret);
|
|
default:
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
static int rtl8224_cable_test_report(struct phy_device *phydev, bool *finished)
|
|
{
|
|
unsigned int pair;
|
|
int ret;
|
|
|
|
for (pair = ETHTOOL_A_CABLE_PAIR_A; pair <= ETHTOOL_A_CABLE_PAIR_D; pair++) {
|
|
ret = rtl8224_cable_test_report_pair(phydev, pair);
|
|
if (ret == -EBUSY) {
|
|
*finished = false;
|
|
return 0;
|
|
}
|
|
|
|
if (ret < 0)
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int rtl8224_cable_test_get_status(struct phy_device *phydev, bool *finished)
|
|
{
|
|
int ret;
|
|
|
|
*finished = false;
|
|
|
|
ret = phy_read_mmd(phydev, MDIO_MMD_VEND2,
|
|
RTL822X_VND2_C22_REG(RTL8224_MII_RTCT));
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
if (!(ret & RTL8224_MII_RTCT_DONE))
|
|
return 0;
|
|
|
|
*finished = true;
|
|
|
|
return rtl8224_cable_test_report(phydev, finished);
|
|
}
|
|
|
|
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;
|
|
}
|
|
|
|
/* On internal PHY's MMD reads over C22 always return 0.
|
|
* Check a MMD register which is known to be non-zero.
|
|
*/
|
|
static bool rtlgen_supports_mmd(struct phy_device *phydev)
|
|
{
|
|
int val;
|
|
|
|
phy_lock_mdio_bus(phydev);
|
|
__phy_write(phydev, MII_MMD_CTRL, MDIO_MMD_PCS);
|
|
__phy_write(phydev, MII_MMD_DATA, MDIO_PCS_EEE_ABLE);
|
|
__phy_write(phydev, MII_MMD_CTRL, MDIO_MMD_PCS | MII_MMD_CTRL_NOINCR);
|
|
val = __phy_read(phydev, MII_MMD_DATA);
|
|
phy_unlock_mdio_bus(phydev);
|
|
|
|
return val > 0;
|
|
}
|
|
|
|
static int rtlgen_match_phy_device(struct phy_device *phydev,
|
|
const struct phy_driver *phydrv)
|
|
{
|
|
return phydev->phy_id == RTL_GENERIC_PHYID &&
|
|
!rtlgen_supports_2_5gbps(phydev);
|
|
}
|
|
|
|
static int rtl8226_match_phy_device(struct phy_device *phydev,
|
|
const struct phy_driver *phydrv)
|
|
{
|
|
return phydev->phy_id == RTL_GENERIC_PHYID &&
|
|
rtlgen_supports_2_5gbps(phydev) &&
|
|
rtlgen_supports_mmd(phydev);
|
|
}
|
|
|
|
static int rtlgen_is_c45_match(struct phy_device *phydev, unsigned int id,
|
|
bool is_c45)
|
|
{
|
|
if (phydev->is_c45)
|
|
return is_c45 && (id == phydev->c45_ids.device_ids[1]);
|
|
else
|
|
return !is_c45 && (id == phydev->phy_id);
|
|
}
|
|
|
|
static int rtl8221b_match_phy_device(struct phy_device *phydev,
|
|
const struct phy_driver *phydrv)
|
|
{
|
|
return phydev->phy_id == RTL_8221B && rtlgen_supports_mmd(phydev);
|
|
}
|
|
|
|
static int rtl8221b_vb_cg_c22_match_phy_device(struct phy_device *phydev,
|
|
const struct phy_driver *phydrv)
|
|
{
|
|
return rtlgen_is_c45_match(phydev, RTL_8221B_VB_CG, false);
|
|
}
|
|
|
|
static int rtl8221b_vb_cg_c45_match_phy_device(struct phy_device *phydev,
|
|
const struct phy_driver *phydrv)
|
|
{
|
|
return rtlgen_is_c45_match(phydev, RTL_8221B_VB_CG, true);
|
|
}
|
|
|
|
static int rtl8221b_vm_cg_c22_match_phy_device(struct phy_device *phydev,
|
|
const struct phy_driver *phydrv)
|
|
{
|
|
return rtlgen_is_c45_match(phydev, RTL_8221B_VM_CG, false);
|
|
}
|
|
|
|
static int rtl8221b_vm_cg_c45_match_phy_device(struct phy_device *phydev,
|
|
const struct phy_driver *phydrv)
|
|
{
|
|
return rtlgen_is_c45_match(phydev, RTL_8221B_VM_CG, true);
|
|
}
|
|
|
|
static int rtl_internal_nbaset_match_phy_device(struct phy_device *phydev,
|
|
const struct phy_driver *phydrv)
|
|
{
|
|
if (phydev->is_c45)
|
|
return false;
|
|
|
|
switch (phydev->phy_id) {
|
|
case RTL_GENERIC_PHYID:
|
|
case RTL_8221B:
|
|
case RTL_8251B:
|
|
case RTL_8261C:
|
|
case 0x001cc841:
|
|
break;
|
|
default:
|
|
return false;
|
|
}
|
|
|
|
return rtlgen_supports_2_5gbps(phydev) && !rtlgen_supports_mmd(phydev);
|
|
}
|
|
|
|
static int rtl8251b_c45_match_phy_device(struct phy_device *phydev,
|
|
const struct phy_driver *phydrv)
|
|
{
|
|
return rtlgen_is_c45_match(phydev, RTL_8251B, true);
|
|
}
|
|
|
|
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 rtlgen_c45_resume(struct phy_device *phydev)
|
|
{
|
|
int ret = genphy_c45_pma_resume(phydev);
|
|
|
|
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 int rtl8221b_ack_interrupt(struct phy_device *phydev)
|
|
{
|
|
int err;
|
|
|
|
err = phy_read_mmd(phydev, MDIO_MMD_VEND2, RTL8221B_VND2_INSR);
|
|
|
|
return (err < 0) ? err : 0;
|
|
}
|
|
|
|
static int rtl8221b_config_intr(struct phy_device *phydev)
|
|
{
|
|
int err;
|
|
|
|
if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
|
|
err = rtl8221b_ack_interrupt(phydev);
|
|
if (err)
|
|
return err;
|
|
|
|
err = phy_write_mmd(phydev, MDIO_MMD_VEND2, RTL8221B_VND2_INER,
|
|
RTL8221B_VND2_INER_LINK_STATUS);
|
|
} else {
|
|
err = phy_write_mmd(phydev, MDIO_MMD_VEND2,
|
|
RTL8221B_VND2_INER, 0);
|
|
if (err)
|
|
return err;
|
|
|
|
err = rtl8221b_ack_interrupt(phydev);
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
static irqreturn_t rtl8221b_handle_interrupt(struct phy_device *phydev)
|
|
{
|
|
int err;
|
|
|
|
err = rtl8221b_ack_interrupt(phydev);
|
|
if (err) {
|
|
phy_error(phydev);
|
|
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,
|
|
.led_hw_is_supported = rtl8211x_led_hw_is_supported,
|
|
.led_hw_control_get = rtl8211e_led_hw_control_get,
|
|
.led_hw_control_set = rtl8211e_led_hw_control_set,
|
|
}, {
|
|
PHY_ID_MATCH_EXACT(0x001cc916),
|
|
.name = "RTL8211F Gigabit Ethernet",
|
|
.probe = rtl8211f_probe,
|
|
.config_init = &rtl8211f_config_init,
|
|
.read_status = rtlgen_read_status,
|
|
.config_intr = &rtl8211f_config_intr,
|
|
.handle_interrupt = rtl8211f_handle_interrupt,
|
|
.set_wol = rtl8211f_set_wol,
|
|
.get_wol = rtl8211f_get_wol,
|
|
.suspend = rtl8211f_suspend,
|
|
.resume = rtl8211f_resume,
|
|
.read_page = rtl821x_read_page,
|
|
.write_page = rtl821x_write_page,
|
|
.flags = PHY_ALWAYS_CALL_SUSPEND,
|
|
.led_hw_is_supported = rtl8211x_led_hw_is_supported,
|
|
.led_hw_control_get = rtl8211f_led_hw_control_get,
|
|
.led_hw_control_set = rtl8211f_led_hw_control_set,
|
|
}, {
|
|
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,
|
|
}, {
|
|
.match_phy_device = rtl8221b_match_phy_device,
|
|
.name = "RTL8226B_RTL8221B 2.5Gbps PHY",
|
|
.get_features = rtl822x_get_features,
|
|
.config_aneg = rtl822x_config_aneg,
|
|
.config_init = rtl822xb_config_init,
|
|
.get_rate_matching = rtl822xb_get_rate_matching,
|
|
.read_status = rtl822xb_read_status,
|
|
.suspend = genphy_suspend,
|
|
.resume = rtlgen_resume,
|
|
.read_page = rtl821x_read_page,
|
|
.write_page = rtl821x_write_page,
|
|
}, {
|
|
PHY_ID_MATCH_EXACT(0x001cc838),
|
|
.name = "RTL8226-CG 2.5Gbps PHY",
|
|
.soft_reset = rtl822x_c45_soft_reset,
|
|
.get_features = rtl822x_c45_get_features,
|
|
.config_aneg = rtl822x_c45_config_aneg,
|
|
.config_init = rtl822x_config_init,
|
|
.read_status = rtl822xb_c45_read_status,
|
|
.suspend = genphy_c45_pma_suspend,
|
|
.resume = rtlgen_c45_resume,
|
|
}, {
|
|
PHY_ID_MATCH_EXACT(0x001cc848),
|
|
.name = "RTL8226B-CG_RTL8221B-CG 2.5Gbps PHY",
|
|
.get_features = rtl822x_get_features,
|
|
.config_aneg = rtl822x_config_aneg,
|
|
.config_init = rtl822xb_config_init,
|
|
.get_rate_matching = rtl822xb_get_rate_matching,
|
|
.read_status = rtl822xb_read_status,
|
|
.suspend = genphy_suspend,
|
|
.resume = rtlgen_resume,
|
|
.read_page = rtl821x_read_page,
|
|
.write_page = rtl821x_write_page,
|
|
}, {
|
|
.match_phy_device = rtl8221b_vb_cg_c22_match_phy_device,
|
|
.name = "RTL8221B-VB-CG 2.5Gbps PHY (C22)",
|
|
.probe = rtl822x_probe,
|
|
.get_features = rtl822x_get_features,
|
|
.config_aneg = rtl822x_config_aneg,
|
|
.config_init = rtl822xb_config_init,
|
|
.get_rate_matching = rtl822xb_get_rate_matching,
|
|
.read_status = rtl822xb_read_status,
|
|
.suspend = genphy_suspend,
|
|
.resume = rtlgen_resume,
|
|
.read_page = rtl821x_read_page,
|
|
.write_page = rtl821x_write_page,
|
|
}, {
|
|
.match_phy_device = rtl8221b_vb_cg_c45_match_phy_device,
|
|
.name = "RTL8221B-VB-CG 2.5Gbps PHY (C45)",
|
|
.config_intr = rtl8221b_config_intr,
|
|
.handle_interrupt = rtl8221b_handle_interrupt,
|
|
.probe = rtl822x_probe,
|
|
.config_init = rtl822xb_config_init,
|
|
.get_rate_matching = rtl822xb_get_rate_matching,
|
|
.get_features = rtl822x_c45_get_features,
|
|
.config_aneg = rtl822x_c45_config_aneg,
|
|
.read_status = rtl822xb_c45_read_status,
|
|
.suspend = genphy_c45_pma_suspend,
|
|
.resume = rtlgen_c45_resume,
|
|
}, {
|
|
.match_phy_device = rtl8221b_vm_cg_c22_match_phy_device,
|
|
.name = "RTL8221B-VM-CG 2.5Gbps PHY (C22)",
|
|
.probe = rtl822x_probe,
|
|
.get_features = rtl822x_get_features,
|
|
.config_aneg = rtl822x_config_aneg,
|
|
.config_init = rtl822xb_config_init,
|
|
.get_rate_matching = rtl822xb_get_rate_matching,
|
|
.read_status = rtl822xb_read_status,
|
|
.suspend = genphy_suspend,
|
|
.resume = rtlgen_resume,
|
|
.read_page = rtl821x_read_page,
|
|
.write_page = rtl821x_write_page,
|
|
}, {
|
|
.match_phy_device = rtl8221b_vm_cg_c45_match_phy_device,
|
|
.name = "RTL8221B-VM-CG 2.5Gbps PHY (C45)",
|
|
.config_intr = rtl8221b_config_intr,
|
|
.handle_interrupt = rtl8221b_handle_interrupt,
|
|
.probe = rtl822x_probe,
|
|
.config_init = rtl822xb_config_init,
|
|
.get_rate_matching = rtl822xb_get_rate_matching,
|
|
.get_features = rtl822x_c45_get_features,
|
|
.config_aneg = rtl822x_c45_config_aneg,
|
|
.read_status = rtl822xb_c45_read_status,
|
|
.suspend = genphy_c45_pma_suspend,
|
|
.resume = rtlgen_c45_resume,
|
|
}, {
|
|
.match_phy_device = rtl8251b_c45_match_phy_device,
|
|
.name = "RTL8251B 5Gbps PHY",
|
|
.probe = rtl822x_probe,
|
|
.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,
|
|
}, {
|
|
.match_phy_device = rtl_internal_nbaset_match_phy_device,
|
|
.name = "Realtek Internal NBASE-T PHY",
|
|
.flags = PHY_IS_INTERNAL,
|
|
.probe = rtl822x_probe,
|
|
.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(0x001ccad0),
|
|
.name = "RTL8224 2.5Gbps PHY",
|
|
.flags = PHY_POLL_CABLE_TEST,
|
|
.get_features = rtl822x_c45_get_features,
|
|
.config_aneg = rtl822x_c45_config_aneg,
|
|
.read_status = rtl822x_c45_read_status,
|
|
.suspend = genphy_c45_pma_suspend,
|
|
.resume = rtlgen_c45_resume,
|
|
.cable_test_start = rtl8224_cable_test_start,
|
|
.cable_test_get_status = rtl8224_cable_test_get_status,
|
|
}, {
|
|
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,
|
|
}, {
|
|
PHY_ID_MATCH_EXACT(0x001cc960),
|
|
.name = "RTL8366S Gigabit Ethernet",
|
|
.suspend = genphy_suspend,
|
|
.resume = genphy_resume,
|
|
.read_mmd = genphy_read_mmd_unsupported,
|
|
.write_mmd = genphy_write_mmd_unsupported,
|
|
},
|
|
};
|
|
|
|
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);
|