net: phy: c45: add setup and read master/slave helpers

This patch adds two static helpers in drivers/net/phy/phy-c45.c to
configure and read back master-slave roles for non BASE-T1 Clause 45
PHYs via the 10GBASE-T AN control/status registers.
These helpers are wired into genphy_c45_config_aneg() and
genphy_c45_read_status(). This changes the observable ethtool output
for drivers using the generic c45 read path.

Reviewed-by: Andrew Lunn <andrew@lunn.ch>
Signed-off-by: Javen Xu <javen_xu@realsil.com.cn>
Link: https://patch.msgid.link/20260728073106.1515-3-javen_xu@realsil.com.cn
Signed-off-by: Jakub Kicinski <kuba@kernel.org>
This commit is contained in:
Javen Xu
2026-07-28 15:31:03 +08:00
committed by Jakub Kicinski
parent 3b63c19e64
commit d7722c0308
2 changed files with 108 additions and 0 deletions

View File

@@ -406,6 +406,97 @@ int genphy_c45_pma_soft_reset(struct phy_device *phydev)
}
EXPORT_SYMBOL_GPL(genphy_c45_pma_soft_reset);
/**
* genphy_c45_an_setup_master_slave - Configure Master/Slave setting for C45 PHYs
* @phydev: target phy_device struct
*
* Description: Configure the forced or preferred Master/Slave role
* 10GBASE-T control register (MMD 7, Register 0x0020) according to
* IEEE 802.3 standards.
*
* Return: negative errno code on failure, 0 if Master/Slave didn't change,
* or 1 if Master/Slave modes changed.
*/
static int genphy_c45_an_setup_master_slave(struct phy_device *phydev)
{
u16 ctl = 0;
switch (phydev->master_slave_set) {
case MASTER_SLAVE_CFG_MASTER_PREFERRED:
ctl = MDIO_AN_10GBT_CTRL_MS_PORT_TYPE;
break;
case MASTER_SLAVE_CFG_SLAVE_PREFERRED:
break;
case MASTER_SLAVE_CFG_MASTER_FORCE:
ctl = MDIO_AN_10GBT_CTRL_MS_ENABLE | MDIO_AN_10GBT_CTRL_MS_VALUE;
break;
case MASTER_SLAVE_CFG_SLAVE_FORCE:
ctl = MDIO_AN_10GBT_CTRL_MS_ENABLE;
break;
case MASTER_SLAVE_CFG_UNKNOWN:
case MASTER_SLAVE_CFG_UNSUPPORTED:
return 0;
default:
phydev_warn(phydev, "Unsupported Master/Slave mode\n");
return -EOPNOTSUPP;
}
return phy_modify_mmd_changed(phydev, MDIO_MMD_AN, MDIO_AN_10GBT_CTRL,
MDIO_AN_10GBT_CTRL_MS_ENABLE |
MDIO_AN_10GBT_CTRL_MS_VALUE |
MDIO_AN_10GBT_CTRL_MS_PORT_TYPE, ctl);
}
/**
* genphy_c45_read_master_slave - read master/slave status
* @phydev: target phy_device struct
*
* Description: Read the Master/Slave configuration and status
* from 10GBASE-T control/status registers (MMD 7, Reg 0x0020 and 0x0021).
*
* Return: 0 on success, or a negative error code on failure.
*/
static int genphy_c45_read_master_slave(struct phy_device *phydev)
{
int val;
phydev->master_slave_get = MASTER_SLAVE_CFG_UNKNOWN;
phydev->master_slave_state = MASTER_SLAVE_STATE_UNKNOWN;
val = phy_read_mmd(phydev, MDIO_MMD_AN, MDIO_AN_10GBT_CTRL);
if (val < 0)
return val;
if (val & MDIO_AN_10GBT_CTRL_MS_ENABLE) {
if (val & MDIO_AN_10GBT_CTRL_MS_VALUE)
phydev->master_slave_get = MASTER_SLAVE_CFG_MASTER_FORCE;
else
phydev->master_slave_get = MASTER_SLAVE_CFG_SLAVE_FORCE;
} else {
if (val & MDIO_AN_10GBT_CTRL_MS_PORT_TYPE)
phydev->master_slave_get = MASTER_SLAVE_CFG_MASTER_PREFERRED;
else
phydev->master_slave_get = MASTER_SLAVE_CFG_SLAVE_PREFERRED;
}
val = phy_read_mmd(phydev, MDIO_MMD_AN, MDIO_AN_10GBT_STAT);
if (val < 0)
return val;
if (val & MDIO_AN_10GBT_STAT_MS_FAULT) {
phydev->master_slave_state = MASTER_SLAVE_STATE_ERR;
} else if (phydev->link) {
if (val & MDIO_AN_10GBT_STAT_MS_RES)
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_UNKNOWN;
}
return 0;
}
/**
* genphy_c45_aneg_done - return auto-negotiation complete status
* @phydev: target phy_device struct
@@ -1214,6 +1305,10 @@ int genphy_c45_read_status(struct phy_device *phydev)
ret = genphy_c45_baset1_read_status(phydev);
if (ret < 0)
return ret;
} else {
ret = genphy_c45_read_master_slave(phydev);
if (ret < 0)
return ret;
}
phy_resolve_aneg_linkmode(phydev);
@@ -1247,6 +1342,14 @@ int genphy_c45_config_aneg(struct phy_device *phydev)
if (ret > 0)
changed = true;
if (!genphy_c45_baset1_able(phydev)) {
ret = genphy_c45_an_setup_master_slave(phydev);
if (ret < 0)
return ret;
if (ret > 0)
changed = true;
}
return genphy_c45_check_and_restart_aneg(phydev, changed);
}
EXPORT_SYMBOL_GPL(genphy_c45_config_aneg);

View File

@@ -332,8 +332,13 @@
#define MDIO_AN_10GBT_CTRL_ADV2_5G 0x0080 /* Advertise 2.5GBASE-T */
#define MDIO_AN_10GBT_CTRL_ADV5G 0x0100 /* Advertise 5GBASE-T */
#define MDIO_AN_10GBT_CTRL_ADV10G 0x1000 /* Advertise 10GBASE-T */
#define MDIO_AN_10GBT_CTRL_MS_ENABLE 0x8000 /* Master/slave manual config enable */
#define MDIO_AN_10GBT_CTRL_MS_VALUE 0x4000 /* Master/slave config value (1=Master) */
#define MDIO_AN_10GBT_CTRL_MS_PORT_TYPE 0x2000 /* Master Preferred Type */
/* AN 10GBASE-T status register. */
#define MDIO_AN_10GBT_STAT_MS_FAULT 0x8000 /* Master/slave fault */
#define MDIO_AN_10GBT_STAT_MS_RES 0x4000 /* Master/slave resolution (1=Master) */
#define MDIO_AN_10GBT_STAT_LP2_5G 0x0020 /* LP is 2.5GBT capable */
#define MDIO_AN_10GBT_STAT_LP5G 0x0040 /* LP is 5GBT capable */
#define MDIO_AN_10GBT_STAT_LPTRR 0x0200 /* LP training reset req. */