net: phy: c45: add support for MDIO_AN_EEE_ADV2

Add support for handling the EEE advertisement 2 register.
For now only 2500baseT and 5000baseT modes are supported.

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

diff --git a/drivers/net/phy/phy-c45.c b/drivers/net/phy/phy-c45.c
index b09c6ba..c69568e 100644 (file)
--- a/drivers/net/phy/phy-c45.c
+++ b/drivers/net/phy/phy-c45.c
@@ -706,6 +706,22 @@ int genphy_c45_write_eee_adv(struct phy_device *phydev, unsigned long *adv)
                        changed = 1;
        }
 
+       if (linkmode_intersects(phydev->supported_eee, PHY_EEE_CAP2_FEATURES)) {
+               val = linkmode_to_mii_eee_cap2_t(adv);
+
+               /* IEEE 802.3-2022 45.2.7.16 EEE advertisement 2
+                * (Register 7.62)
+                */
+               val = phy_modify_mmd_changed(phydev, MDIO_MMD_AN,
+                                            MDIO_AN_EEE_ADV2,
+                                            MDIO_EEE_2_5GT | MDIO_EEE_5GT,
+                                            val);
+               if (val < 0)
+                       return val;
+               if (val > 0)
+                       changed = 1;
+       }
+
        if (linkmode_test_bit(ETHTOOL_LINK_MODE_10baseT1L_Full_BIT,
                              phydev->supported_eee)) {
                val = linkmode_adv_to_mii_10base_t1_t(adv);
@@ -745,6 +761,17 @@ int genphy_c45_read_eee_adv(struct phy_device *phydev, unsigned long *adv)
                mii_eee_cap1_mod_linkmode_t(adv, val);
        }
 
+       if (linkmode_intersects(phydev->supported_eee, PHY_EEE_CAP2_FEATURES)) {
+               /* IEEE 802.3-2022 45.2.7.16 EEE advertisement 2
+                * (Register 7.62)
+                */
+               val = phy_read_mmd(phydev, MDIO_MMD_AN, MDIO_AN_EEE_ADV2);
+               if (val < 0)
+                       return val;
+
+               mii_eee_cap2_mod_linkmode_adv_t(adv, val);
+       }
+
        if (linkmode_test_bit(ETHTOOL_LINK_MODE_10baseT1L_Full_BIT,
                              phydev->supported_eee)) {
                /* IEEE 802.3cg-2019 45.2.7.25 10BASE-T1 AN control register