diff options
| author | Ariel D'Alessandro <ariel.dalessandro@collabora.com> | 2022-04-12 10:31:36 -0300 |
|---|---|---|
| committer | Stefano Babic <sbabic@denx.de> | 2022-04-12 19:10:44 +0200 |
| commit | 087baf80ec70660b71ea578b20f357c24deb2ed4 (patch) | |
| tree | 86b5fc4ad91bb0ac212034a7fcf10ea908cf1bdd | |
| parent | d7db0e6df3e42a5d47bac4d3b7a9e6c13ac08ec9 (diff) | |
net: phy: Add phy_modify() accessor
Add read-modify-write unlocked accessor for accessing a PHY register.
Signed-off-by: Ariel D'Alessandro <ariel.dalessandro@collabora.com>
Reviewed-by: Ramon Fried <rfried.dev@gmail.com>
| -rw-r--r-- | drivers/net/phy/phy.c | 20 | ||||
| -rw-r--r-- | include/phy.h | 2 |
2 files changed, 22 insertions, 0 deletions
diff --git a/drivers/net/phy/phy.c b/drivers/net/phy/phy.c index e61c9b8a17..50448cf62c 100644 --- a/drivers/net/phy/phy.c +++ b/drivers/net/phy/phy.c @@ -1110,3 +1110,23 @@ int phy_get_interface_by_name(const char *str) return -1; } + +/** + * phy_modify - Convenience function for modifying a given PHY register + * @phydev: the phy_device struct + * @devad: The MMD to read from + * @regnum: register number to write + * @mask: bit mask of bits to clear + * @set: new value of bits set in mask to write to @regnum + */ +int phy_modify(struct phy_device *phydev, int devad, int regnum, u16 mask, + u16 set) +{ + int ret; + + ret = phy_read(phydev, devad, regnum); + if (ret < 0) + return ret; + + return phy_write(phydev, devad, regnum, (ret & ~mask) | set); +} diff --git a/include/phy.h b/include/phy.h index 807c2932fd..1a30aee542 100644 --- a/include/phy.h +++ b/include/phy.h @@ -526,6 +526,8 @@ int phy_config(struct phy_device *phydev); int phy_shutdown(struct phy_device *phydev); int phy_register(struct phy_driver *drv); int phy_set_supported(struct phy_device *phydev, u32 max_speed); +int phy_modify(struct phy_device *phydev, int devad, int regnum, u16 mask, + u16 set); int genphy_config_aneg(struct phy_device *phydev); int genphy_restart_aneg(struct phy_device *phydev); int genphy_update_link(struct phy_device *phydev); |