hinic: add support to get eeprom information
add support to get eeprom information from the plug-in module with ethtool -m cmd. Signed-off-by: Luo bin <luobin9@huawei.com> Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
parent
07afcc7ab4
commit
2ac84cd160
|
@ -25,6 +25,7 @@
|
|||
#include <linux/if_vlan.h>
|
||||
#include <linux/ethtool.h>
|
||||
#include <linux/vmalloc.h>
|
||||
#include <linux/sfp.h>
|
||||
|
||||
#include "hinic_hw_qp.h"
|
||||
#include "hinic_hw_dev.h"
|
||||
|
@ -1717,6 +1718,72 @@ static int hinic_set_phys_id(struct net_device *netdev,
|
|||
return err;
|
||||
}
|
||||
|
||||
static int hinic_get_module_info(struct net_device *netdev,
|
||||
struct ethtool_modinfo *modinfo)
|
||||
{
|
||||
struct hinic_dev *nic_dev = netdev_priv(netdev);
|
||||
u8 sfp_type_ext;
|
||||
u8 sfp_type;
|
||||
int err;
|
||||
|
||||
err = hinic_get_sfp_type(nic_dev->hwdev, &sfp_type, &sfp_type_ext);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
switch (sfp_type) {
|
||||
case SFF8024_ID_SFP:
|
||||
modinfo->type = ETH_MODULE_SFF_8472;
|
||||
modinfo->eeprom_len = ETH_MODULE_SFF_8472_LEN;
|
||||
break;
|
||||
case SFF8024_ID_QSFP_8438:
|
||||
modinfo->type = ETH_MODULE_SFF_8436;
|
||||
modinfo->eeprom_len = ETH_MODULE_SFF_8436_MAX_LEN;
|
||||
break;
|
||||
case SFF8024_ID_QSFP_8436_8636:
|
||||
if (sfp_type_ext >= 0x3) {
|
||||
modinfo->type = ETH_MODULE_SFF_8636;
|
||||
modinfo->eeprom_len = ETH_MODULE_SFF_8636_MAX_LEN;
|
||||
|
||||
} else {
|
||||
modinfo->type = ETH_MODULE_SFF_8436;
|
||||
modinfo->eeprom_len = ETH_MODULE_SFF_8436_MAX_LEN;
|
||||
}
|
||||
break;
|
||||
case SFF8024_ID_QSFP28_8636:
|
||||
modinfo->type = ETH_MODULE_SFF_8636;
|
||||
modinfo->eeprom_len = ETH_MODULE_SFF_8636_MAX_LEN;
|
||||
break;
|
||||
default:
|
||||
netif_warn(nic_dev, drv, netdev,
|
||||
"Optical module unknown: 0x%x\n", sfp_type);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int hinic_get_module_eeprom(struct net_device *netdev,
|
||||
struct ethtool_eeprom *ee, u8 *data)
|
||||
{
|
||||
struct hinic_dev *nic_dev = netdev_priv(netdev);
|
||||
u8 sfp_data[STD_SFP_INFO_MAX_SIZE];
|
||||
u16 len;
|
||||
int err;
|
||||
|
||||
if (!ee->len || ((ee->len + ee->offset) > STD_SFP_INFO_MAX_SIZE))
|
||||
return -EINVAL;
|
||||
|
||||
memset(data, 0, ee->len);
|
||||
|
||||
err = hinic_get_sfp_eeprom(nic_dev->hwdev, sfp_data, &len);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
memcpy(data, sfp_data + ee->offset, ee->len);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct ethtool_ops hinic_ethtool_ops = {
|
||||
.supported_coalesce_params = ETHTOOL_COALESCE_RX_USECS |
|
||||
ETHTOOL_COALESCE_RX_MAX_FRAMES |
|
||||
|
@ -1748,6 +1815,8 @@ static const struct ethtool_ops hinic_ethtool_ops = {
|
|||
.get_strings = hinic_get_strings,
|
||||
.self_test = hinic_diag_test,
|
||||
.set_phys_id = hinic_set_phys_id,
|
||||
.get_module_info = hinic_get_module_info,
|
||||
.get_module_eeprom = hinic_get_module_eeprom,
|
||||
};
|
||||
|
||||
static const struct ethtool_ops hinicvf_ethtool_ops = {
|
||||
|
|
|
@ -130,9 +130,13 @@ enum hinic_port_cmd {
|
|||
|
||||
HINIC_PORT_CMD_SET_AUTONEG = 219,
|
||||
|
||||
HINIC_PORT_CMD_GET_STD_SFP_INFO = 240,
|
||||
|
||||
HINIC_PORT_CMD_SET_LRO_TIMER = 244,
|
||||
|
||||
HINIC_PORT_CMD_SET_VF_MAX_MIN_RATE = 249,
|
||||
|
||||
HINIC_PORT_CMD_GET_SFP_ABS = 251,
|
||||
};
|
||||
|
||||
/* cmd of mgmt CPU message for HILINK module */
|
||||
|
|
|
@ -1323,3 +1323,75 @@ int hinic_reset_led_status(struct hinic_hwdev *hwdev, u8 port)
|
|||
|
||||
return err;
|
||||
}
|
||||
|
||||
static bool hinic_if_sfp_absent(struct hinic_hwdev *hwdev)
|
||||
{
|
||||
struct hinic_cmd_get_light_module_abs sfp_abs = {0};
|
||||
u16 out_size = sizeof(sfp_abs);
|
||||
u8 port_id = hwdev->port_id;
|
||||
int err;
|
||||
|
||||
sfp_abs.port_id = port_id;
|
||||
err = hinic_port_msg_cmd(hwdev, HINIC_PORT_CMD_GET_SFP_ABS,
|
||||
&sfp_abs, sizeof(sfp_abs), &sfp_abs,
|
||||
&out_size);
|
||||
if (sfp_abs.status || err || !out_size) {
|
||||
dev_err(&hwdev->hwif->pdev->dev,
|
||||
"Failed to get port%d sfp absent status, err: %d, status: 0x%x, out size: 0x%x\n",
|
||||
port_id, err, sfp_abs.status, out_size);
|
||||
return true;
|
||||
}
|
||||
|
||||
return ((sfp_abs.abs_status == 0) ? false : true);
|
||||
}
|
||||
|
||||
int hinic_get_sfp_eeprom(struct hinic_hwdev *hwdev, u8 *data, u16 *len)
|
||||
{
|
||||
struct hinic_cmd_get_std_sfp_info sfp_info = {0};
|
||||
u16 out_size = sizeof(sfp_info);
|
||||
u8 port_id;
|
||||
int err;
|
||||
|
||||
if (!hwdev || !data || !len)
|
||||
return -EINVAL;
|
||||
|
||||
port_id = hwdev->port_id;
|
||||
|
||||
if (hinic_if_sfp_absent(hwdev))
|
||||
return -ENXIO;
|
||||
|
||||
sfp_info.port_id = port_id;
|
||||
err = hinic_port_msg_cmd(hwdev, HINIC_PORT_CMD_GET_STD_SFP_INFO,
|
||||
&sfp_info, sizeof(sfp_info), &sfp_info,
|
||||
&out_size);
|
||||
if (sfp_info.status || err || !out_size) {
|
||||
dev_err(&hwdev->hwif->pdev->dev,
|
||||
"Failed to get port%d sfp eeprom information, err: %d, status: 0x%x, out size: 0x%x\n",
|
||||
port_id, err, sfp_info.status, out_size);
|
||||
return -EIO;
|
||||
}
|
||||
|
||||
*len = min_t(u16, sfp_info.eeprom_len, STD_SFP_INFO_MAX_SIZE);
|
||||
memcpy(data, sfp_info.sfp_info, STD_SFP_INFO_MAX_SIZE);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int hinic_get_sfp_type(struct hinic_hwdev *hwdev, u8 *data0, u8 *data1)
|
||||
{
|
||||
u8 sfp_data[STD_SFP_INFO_MAX_SIZE];
|
||||
u16 len;
|
||||
int err;
|
||||
|
||||
if (hinic_if_sfp_absent(hwdev))
|
||||
return -ENXIO;
|
||||
|
||||
err = hinic_get_sfp_eeprom(hwdev, sfp_data, &len);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
*data0 = sfp_data[0];
|
||||
*data1 = sfp_data[1];
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
|
|
@ -677,6 +677,32 @@ struct hinic_led_info {
|
|||
u8 reset;
|
||||
};
|
||||
|
||||
#define STD_SFP_INFO_MAX_SIZE 640
|
||||
|
||||
struct hinic_cmd_get_light_module_abs {
|
||||
u8 status;
|
||||
u8 version;
|
||||
u8 rsvd0[6];
|
||||
|
||||
u8 port_id;
|
||||
u8 abs_status; /* 0:present, 1:absent */
|
||||
u8 rsv[2];
|
||||
};
|
||||
|
||||
#define STD_SFP_INFO_MAX_SIZE 640
|
||||
|
||||
struct hinic_cmd_get_std_sfp_info {
|
||||
u8 status;
|
||||
u8 version;
|
||||
u8 rsvd0[6];
|
||||
|
||||
u8 port_id;
|
||||
u8 wire_type;
|
||||
u16 eeprom_len;
|
||||
u32 rsvd;
|
||||
u8 sfp_info[STD_SFP_INFO_MAX_SIZE];
|
||||
};
|
||||
|
||||
int hinic_port_add_mac(struct hinic_dev *nic_dev, const u8 *addr,
|
||||
u16 vlan_id);
|
||||
|
||||
|
@ -800,6 +826,10 @@ int hinic_reset_led_status(struct hinic_hwdev *hwdev, u8 port);
|
|||
int hinic_set_led_status(struct hinic_hwdev *hwdev, u8 port,
|
||||
enum hinic_led_type type, enum hinic_led_mode mode);
|
||||
|
||||
int hinic_get_sfp_type(struct hinic_hwdev *hwdev, u8 *data0, u8 *data1);
|
||||
|
||||
int hinic_get_sfp_eeprom(struct hinic_hwdev *hwdev, u8 *data, u16 *len);
|
||||
|
||||
int hinic_open(struct net_device *netdev);
|
||||
|
||||
int hinic_close(struct net_device *netdev);
|
||||
|
|
Loading…
Reference in a new issue