[AMD Public Use]
Acked-by: Ravi Kumar <ravi1.ku...@amd.com> > > >-----Original Message----- >From: Somalapuram, Amaranath <amaranath.somalapu...@amd.com> >Sent: Wednesday, April 8, 2020 12:38 PM >To: dev@dpdk.org >Cc: Kumar, Ravi1 <ravi1.ku...@amd.com> >Subject: [PATCH v1] net/axgbe: support sfp module EEPROM > >From: Amaranath Somalapuram <amaranath.somalapu...@amd.com> > >Adding API for get_module_eeprom and get_module_info. > >Signed-off-by: Amaranath Somalapuram <amaranath.somalapu...@amd.com> >--- > drivers/net/axgbe/axgbe_ethdev.c | 2 + > drivers/net/axgbe/axgbe_phy.h | 4 ++ > drivers/net/axgbe/axgbe_phy_impl.c | 107 +++++++++++++++++++++++++++++ > 3 files changed, 113 insertions(+) > >diff --git a/drivers/net/axgbe/axgbe_ethdev.c >b/drivers/net/axgbe/axgbe_ethdev.c >index 867058845..ea2f9bba1 100644 >--- a/drivers/net/axgbe/axgbe_ethdev.c >+++ b/drivers/net/axgbe/axgbe_ethdev.c >@@ -214,6 +214,8 @@ static const struct eth_dev_ops axgbe_eth_dev_ops = { > .dev_supported_ptypes_get = axgbe_dev_supported_ptypes_get, > .rx_descriptor_status = axgbe_dev_rx_descriptor_status, > .tx_descriptor_status = axgbe_dev_tx_descriptor_status, >+ .get_module_info = axgbe_get_module_info, >+ .get_module_eeprom = axgbe_get_module_eeprom, > }; > > static int axgbe_phy_reset(struct axgbe_port *pdata) diff --git > a/drivers/net/axgbe/axgbe_phy.h b/drivers/net/axgbe/axgbe_phy.h index > 77ee20a31..d9d7fde41 100644 >--- a/drivers/net/axgbe/axgbe_phy.h >+++ b/drivers/net/axgbe/axgbe_phy.h >@@ -188,5 +188,9 @@ > #define DUPLEX_FULL 0x01 > #define DUPLEX_UNKNOWN 0xff > >+int axgbe_get_module_info(struct rte_eth_dev *dev, >+ struct rte_eth_dev_module_info *modinfo); int >+axgbe_get_module_eeprom(struct rte_eth_dev *dev, >+ struct rte_dev_eeprom_info *info); > #endif > /* PHY */ >diff --git a/drivers/net/axgbe/axgbe_phy_impl.c >b/drivers/net/axgbe/axgbe_phy_impl.c >index 02236ec19..53716071f 100644 >--- a/drivers/net/axgbe/axgbe_phy_impl.c >+++ b/drivers/net/axgbe/axgbe_phy_impl.c >@@ -141,12 +141,18 @@ enum axgbe_sfp_speed { > > #define AXGBE_SFP_EXTD_CC 31 > >+#define AXGBE_SFP_EEPROM_PAGE_SIZE 256 >+ > struct axgbe_sfp_eeprom { > u8 base[64]; > u8 extd[32]; > u8 vendor[32]; > }; > >+struct axgbe_sfp_eeprom_module { >+ u8 base[256]; >+}; >+ > #define AXGBE_BEL_FUSE_VENDOR "BEL-FUSE" > #define AXGBE_BEL_FUSE_PARTNO "1GBT-SFP06" > >@@ -734,6 +740,106 @@ static int axgbe_phy_sfp_read_eeprom(struct axgbe_port >*pdata) > return ret; > } > >+int axgbe_get_module_info(struct rte_eth_dev *dev, >+ struct rte_eth_dev_module_info *modinfo) { >+ struct axgbe_port *pdata = dev->data->dev_private; >+ struct axgbe_sfp_eeprom sfp_eeprom; >+ uint8_t eeprom_addr; >+ int ret; >+ >+ ret = axgbe_phy_get_comm_ownership(pdata); >+ >+ if (ret) >+ return -EIO; >+ >+ ret = axgbe_phy_sfp_get_mux(pdata); >+ >+ if (ret) { >+ PMD_DRV_LOG(ERR, "I2C error setting SFP MUX\n"); >+ return ret; >+ } >+ >+ eeprom_addr = 0; >+ ret = axgbe_phy_i2c_read(pdata, AXGBE_SFP_SERIAL_ID_ADDRESS, >+ &eeprom_addr, sizeof(eeprom_addr), >+ &sfp_eeprom, sizeof(sfp_eeprom)); >+ >+ if (ret) { >+ PMD_DRV_LOG(ERR, "I2C error reading SFP EEPROM\n"); >+ goto put; >+ } >+ >+ if (sfp_eeprom.extd[AXGBE_SFP_EXTD_SFF_8472] != 0xff) { >+ if (sfp_eeprom.extd[AXGBE_SFP_EXTD_SFF_8472] == 0) { >+ modinfo->type = RTE_ETH_MODULE_SFF_8079; >+ modinfo->eeprom_len = RTE_ETH_MODULE_SFF_8079_LEN; >+ } else { >+ modinfo->type = RTE_ETH_MODULE_SFF_8472; >+ modinfo->eeprom_len = RTE_ETH_MODULE_SFF_8472_LEN; >+ } >+ } >+ >+ >+put: >+ axgbe_phy_sfp_put_mux(pdata); >+ axgbe_phy_put_comm_ownership(pdata); >+ return 0; >+} >+ >+int axgbe_get_module_eeprom(struct rte_eth_dev *dev, >+ struct rte_dev_eeprom_info *info) >+{ >+ struct axgbe_port *pdata = dev->data->dev_private; >+ struct axgbe_sfp_eeprom_module sfp_eeprom; >+ uint8_t eeprom_addr; >+ uint8_t *data; >+ uint32_t i; >+ int ret; >+ >+ ret = axgbe_phy_get_comm_ownership(pdata); >+ >+ if (ret) >+ return -EIO; >+ >+ if (!info || !info->length || !info->data) >+ return -EINVAL; >+ >+ ret = axgbe_phy_sfp_get_mux(pdata); >+ if (ret) { >+ PMD_DRV_LOG(ERR, "I2C error setting SFP MUX\n"); >+ return ret; >+ } >+ >+ eeprom_addr = 0; >+ ret = axgbe_phy_i2c_read(pdata, AXGBE_SFP_SERIAL_ID_ADDRESS, >+ &eeprom_addr, sizeof(eeprom_addr), >+ &sfp_eeprom, sizeof(sfp_eeprom)); >+ if (ret) { >+ PMD_DRV_LOG(ERR, "I2C error reading SFP EEPROM\n"); >+ goto put; >+ } >+ data = info->data; >+ >+ /* for AXGBE_SFP_SERIAL_ID_ADDRESS */ >+ for (i = 0; i < AXGBE_SFP_EEPROM_PAGE_SIZE; i++) >+ data[i] = sfp_eeprom.base[i]; >+ >+ eeprom_addr = 0; >+ ret = axgbe_phy_i2c_read(pdata, AXGBE_SFP_DIAG_INFO_ADDRESS, >+ &eeprom_addr, sizeof(eeprom_addr), >+ &sfp_eeprom, sizeof(sfp_eeprom)); >+ >+ /* for AXGBE_SFP_DIAG_INFO_ADDRESS */ >+ for (i = 0; i < info->length - AXGBE_SFP_EEPROM_PAGE_SIZE; i++) >+ data[i + AXGBE_SFP_EEPROM_PAGE_SIZE] = sfp_eeprom.base[i]; >+ >+put: >+ axgbe_phy_sfp_put_mux(pdata); >+ axgbe_phy_put_comm_ownership(pdata); >+ return 0; >+} >+ > static void axgbe_phy_sfp_signals(struct axgbe_port *pdata) { > struct axgbe_phy_data *phy_data = pdata->phy_data; @@ -741,6 +847,7 @@ > static void axgbe_phy_sfp_signals(struct axgbe_port *pdata) > u8 gpio_reg, gpio_ports[2]; > int ret; > >+ > /* Read the input port registers */ > gpio_reg = 0; > ret = axgbe_phy_i2c_read(pdata, phy_data->sfp_gpio_address, >-- >2.17.1 >