net: phy: realtek: support NBase-T MMD EEE registers on RTL8125

Emulate the 802.3bz MMD EEE registers for 2.5Gbps EEE on RTL8125.

Signed-off-by: Heiner Kallweit <hkallweit1@gmail.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

diff --git a/drivers/net/phy/realtek.c b/drivers/net/phy/realtek.c
index fa662099fb853fb97d6460f6ba752cdf58f0713d..677c45985338a6dbd5ccde6ae49150c6e282da3d 100644 (file)
--- a/drivers/net/phy/realtek.c
+++ b/drivers/net/phy/realtek.c
@@ -305,6 +305,47 @@ static int rtlgen_write_mmd(struct phy_device *phydev, int devnum, u16 regnum,
        return ret;
 }
 
+static int rtl8125_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 rtl8125_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 rtl8125_get_features(struct phy_device *phydev)
 {
        int val;
@@ -473,8 +514,8 @@ static struct phy_driver realtek_drvs[] = {
                .resume         = genphy_resume,
                .read_page      = rtl821x_read_page,
                .write_page     = rtl821x_write_page,
-               .read_mmd       = rtlgen_read_mmd,
-               .write_mmd      = rtlgen_write_mmd,
+               .read_mmd       = rtl8125_read_mmd,
+               .write_mmd      = rtl8125_write_mmd,
        }, {
                PHY_ID_MATCH_EXACT(0x001cc961),
                .name           = "RTL8366RB Gigabit Ethernet",