From: Selvamani Rajagopal OPEN Alliance 10BASE-T1x Serial Interface specification, table 6 allows vendors to use any memory map select (MMS) value between 10 and 15. This new API interface enables vendor to map one of thes MMS values to MDIO_MMD_VEND1. Signed-off-by: Selvamani Rajagopal --- drivers/net/ethernet/oa_tc6/oa_tc6.c | 20 +++++++++++++++++--- include/linux/oa_tc6.h | 1 + 2 files changed, 18 insertions(+), 3 deletions(-) diff --git a/drivers/net/ethernet/oa_tc6/oa_tc6.c b/drivers/net/ethernet/oa_tc6/oa_tc6.c index 9410cecfdc2a..2f9ace655e81 100644 --- a/drivers/net/ethernet/oa_tc6/oa_tc6.c +++ b/drivers/net/ethernet/oa_tc6/oa_tc6.c @@ -202,6 +202,17 @@ int oa_tc6_ioctl(struct oa_tc6 *tc6, struct ifreq *rq, int cmd) } EXPORT_SYMBOL_GPL(oa_tc6_ioctl); +/** + * Add vendor specific MDIO_MMD to OA TC6 MMS mapper value. + * @tc6: oa_tc6 struct. + * @mms: vendor defined MMS value for VEND1 mdio device. + */ +void oa_tc6_set_vend1_mms(struct oa_tc6 *tc6, int mms) +{ + tc6->vend1_mms = mms; +} +EXPORT_SYMBOL_GPL(oa_tc6_set_vend1_mms); + static __be32 oa_tc6_prepare_ctrl_header(u32 addr, u8 length, enum oa_tc6_register_op reg_op) { @@ -455,7 +466,7 @@ static int oa_tc6_mdiobus_write(struct mii_bus *bus, int addr, int regnum, val); } -static int oa_tc6_get_phy_c45_mms(int devnum) +static int oa_tc6_get_phy_c45_mms(struct oa_tc6 *tc6, int devnum) { switch (devnum) { case MDIO_MMD_PCS: @@ -468,6 +479,8 @@ static int oa_tc6_get_phy_c45_mms(int devnum) return OA_TC6_PHY_C45_AUTO_NEG_MMS5; case MDIO_MMD_POWER_UNIT: return OA_TC6_PHY_C45_POWER_UNIT_MMS6; + case MDIO_MMD_VEND1: + return tc6->vend1_mms; default: return -EOPNOTSUPP; } @@ -480,7 +493,7 @@ static int oa_tc6_mdiobus_read_c45(struct mii_bus *bus, int addr, int devnum, u32 regval; int ret; - ret = oa_tc6_get_phy_c45_mms(devnum); + ret = oa_tc6_get_phy_c45_mms(tc6, devnum); if (ret < 0) return ret; @@ -497,7 +510,7 @@ static int oa_tc6_mdiobus_write_c45(struct mii_bus *bus, int addr, int devnum, struct oa_tc6 *tc6 = bus->priv; int ret; - ret = oa_tc6_get_phy_c45_mms(devnum); + ret = oa_tc6_get_phy_c45_mms(tc6, devnum); if (ret < 0) return ret; @@ -1281,6 +1294,7 @@ struct oa_tc6 *oa_tc6_init(struct spi_device *spi, struct net_device *netdev) SET_NETDEV_DEV(netdev, &spi->dev); mutex_init(&tc6->spi_ctrl_lock); spin_lock_init(&tc6->tx_skb_lock); + tc6->vend1_mms = -EOPNOTSUPP; tc6->tx_ts_idx = OA_TC6_TTSCA_REG_ID; INIT_LIST_HEAD(&tc6->tx_ts_skb_q); diff --git a/include/linux/oa_tc6.h b/include/linux/oa_tc6.h index 4047c22a366a..a89151267713 100644 --- a/include/linux/oa_tc6.h +++ b/include/linux/oa_tc6.h @@ -47,5 +47,6 @@ void oa_tc6_get_ts_stats(struct oa_tc6 *tc6, struct ethtool_ts_stats *ts_stats); int oa_tc6_hwtstamp_set(struct oa_tc6 *tc6, struct kernel_hwtstamp_config *cfg); +void oa_tc6_set_vend1_mms(struct oa_tc6 *tc6, int mms); void oa_tc6_ptp_unregister(struct oa_tc6 *tc6); #endif /* _LINUX_OA_TC6_H */ -- 2.43.0