Use the new ethtool link down reason api, and expose troubleshooting info regarding the link status.
Signed-off-by: Gal Pressman <g...@mellanox.com> Signed-off-by: Saeed Mahameed <sae...@mellanox.com> --- .../net/ethernet/mellanox/mlx5/core/en_ethtool.c | 107 +++++++++++++++++++++ .../net/ethernet/mellanox/mlx5/core/mlx5_core.h | 4 + drivers/net/ethernet/mellanox/mlx5/core/port.c | 25 +++++ 3 files changed, 136 insertions(+) diff --git a/drivers/net/ethernet/mellanox/mlx5/core/en_ethtool.c b/drivers/net/ethernet/mellanox/mlx5/core/en_ethtool.c index ab46061..a5e9f1f 100644 --- a/drivers/net/ethernet/mellanox/mlx5/core/en_ethtool.c +++ b/drivers/net/ethernet/mellanox/mlx5/core/en_ethtool.c @@ -135,6 +135,88 @@ void mlx5e_build_ptys2ethtool_map(void) ETHTOOL_LINK_MODE_50000baseKR2_Full_BIT); } +static const struct { + u16 pddr; + u32 ethtool; +} pddr2ethtool_table[] = { + { + .pddr = MLX5_LINK_NO_ISSUE_OBSERVED, + .ethtool = ETHTOOL_LINK_NO_ISSUE, + }, + { + .pddr = MLX5_LINK_PORT_CLOSED, + .ethtool = ETHTOOL_LINK_ADMIN_DOWN, + }, + { + .pddr = MLX5_LINK_AN_FAILURE, + .ethtool = ETHTOOL_LINK_AN_FAILED, + }, + { + .pddr = MLX5_LINK_TRAINING_FAILURE, + .ethtool = ETHTOOL_LINK_TRAINING_FAILED, + }, + { + .pddr = MLX5_LINK_REMOTE_FAULT_INDICATION, + .ethtool = ETHTOOL_LINK_RMT_FAULT, + }, + { + .pddr = MLX5_LINK_BAD_SIGNAL_INTEGRITY, + .ethtool = ETHTOOL_LINK_BAD_SIGNAL_INTEGRITY, + }, + { + .pddr = MLX5_LINK_CABLE_COMPLIANCE_CODE_MISMATCH, + .ethtool = ETHTOOL_LINK_CABLE_MISMATCH, + }, + { + .pddr = MLX5_LINK_INTERNAL_ERR, + .ethtool = ETHTOOL_LINK_INTERNAL_ERR, + }, + { + .pddr = MLX5_LINK_INFO_NOT_AVAIL, + .ethtool = ETHTOOL_LINK_REASON_UNKNOWN, + }, + { + .pddr = MLX5_LINK_CABLE_UNPLUGGED, + .ethtool = ETHTOOL_LINK_CABLE_UNPLUGGED, + }, + { + .pddr = MLX5_LINK_LONG_RANGE_FOR_NON_MLX_CABLE, + .ethtool = ETHTOOL_LINK_UNSUPP_MODULE, + }, + { + .pddr = MLX5_LINK_BUS_STUCK, + .ethtool = ETHTOOL_LINK_I2C_BUS_ERR, + }, + { + .pddr = MLX5_LINK_UNSUPP_EEPROM, + .ethtool = ETHTOOL_LINK_UNSUPP_EEPROM, + }, + { + .pddr = MLX5_LINK_MODULE_TEMP_SHUTDOWN, + .ethtool = ETHTOOL_LINK_OVERTEMP, + }, + { + .pddr = MLX5_LINK_POWER_BUDGET_EXCEEDED, + .ethtool = ETHTOOL_LINK_PWR_BUDGET_EXC, + }, + { + .pddr = MLX5_LINK_MNG_FORCED_DOWN, + .ethtool = ETHTOOL_LINK_MODULE_ADMIN_DOWN, + }, +}; + +static u32 mlx5e_pddr2ethtool(u16 pddr) +{ + int i; + + for (i = 0; i < ARRAY_SIZE(pddr2ethtool_table); i++) { + if (pddr2ethtool_table[i].pddr == pddr) + return pddr2ethtool_table[i].ethtool; + } + + return ETHTOOL_LINK_VENDOR_SPECIFIC; +} + static unsigned long mlx5e_query_pfc_combined(struct mlx5e_priv *priv) { struct mlx5_core_dev *mdev = priv->mdev; @@ -1795,6 +1877,30 @@ static int mlx5e_set_rxnfc(struct net_device *dev, struct ethtool_rxnfc *cmd) return err; } +static int mlx5e_get_link_down_reason(struct net_device *netdev, + struct ethtool_link_down_reason *ldr) +{ + struct mlx5e_priv *priv = netdev_priv(netdev); + u16 monitor_opcode; + int err; + + if (!netif_running(netdev)) { + ldr->reason = ETHTOOL_LINK_NETDEV_CARRIER_DOWN; + return 0; + } + + err = mlx5_query_pddr_troubleshooting_info(priv->mdev, + &monitor_opcode, NULL); + if (err) + return err; + + ldr->reason = mlx5e_pddr2ethtool(monitor_opcode); + if (ldr->reason == ETHTOOL_LINK_VENDOR_SPECIFIC) + ldr->vendor_reason = monitor_opcode; + + return 0; +} + const struct ethtool_ops mlx5e_ethtool_ops = { .get_drvinfo = mlx5e_get_drvinfo, .get_link = ethtool_op_get_link, @@ -1828,4 +1934,5 @@ const struct ethtool_ops mlx5e_ethtool_ops = { .get_priv_flags = mlx5e_get_priv_flags, .set_priv_flags = mlx5e_set_priv_flags, .self_test = mlx5e_self_test, + .get_link_down_reason = mlx5e_get_link_down_reason, }; diff --git a/drivers/net/ethernet/mellanox/mlx5/core/mlx5_core.h b/drivers/net/ethernet/mellanox/mlx5/core/mlx5_core.h index cbb6a0e..b4cbaa0 100644 --- a/drivers/net/ethernet/mellanox/mlx5/core/mlx5_core.h +++ b/drivers/net/ethernet/mellanox/mlx5/core/mlx5_core.h @@ -147,6 +147,10 @@ int mlx5_query_pcam_reg(struct mlx5_core_dev *dev, u32 *pcam, u8 feature_group, int mlx5_query_mcam_reg(struct mlx5_core_dev *dev, u32 *mcap, u8 feature_group, u8 access_reg_group); +int mlx5_query_pddr_troubleshooting_info(struct mlx5_core_dev *mdev, + u16 *monitor_opcode, + u8 *status_message); + void mlx5_lag_add(struct mlx5_core_dev *dev, struct net_device *netdev); void mlx5_lag_remove(struct mlx5_core_dev *dev); diff --git a/drivers/net/ethernet/mellanox/mlx5/core/port.c b/drivers/net/ethernet/mellanox/mlx5/core/port.c index 38e97b2..b9e053c 100644 --- a/drivers/net/ethernet/mellanox/mlx5/core/port.c +++ b/drivers/net/ethernet/mellanox/mlx5/core/port.c @@ -803,6 +803,31 @@ static int mlx5_query_pddr(struct mlx5_core_dev *mdev, return mlx5_core_access_reg(mdev, in, sizeof(in), out, outlen, MLX5_REG_PDDR, 0, 0); } +int mlx5_query_pddr_troubleshooting_info(struct mlx5_core_dev *mdev, + u16 *monitor_opcode, + u8 *status_message) +{ + int outlen = MLX5_ST_SZ_BYTES(pddr_reg); + u32 out[MLX5_ST_SZ_DW(pddr_reg)] = {0}; + int err; + + err = mlx5_query_pddr(mdev, MLX5_PDDR_TROUBLESHOOTING_INFO_PAGE, + out, outlen); + if (err) + return err; + + if (monitor_opcode) + *monitor_opcode = MLX5_GET(pddr_reg, out, + page_data.troubleshooting_info_page.status_opcode.monitor_opcodes); + + if (status_message) + memcpy(status_message, + MLX5_ADDR_OF(pddr_reg, out, page_data.troubleshooting_info_page.status_message), + ETH_GSTRING_LEN); + + return 0; +} + static int mlx5_query_ports_check(struct mlx5_core_dev *mdev, u32 *out, int outlen) { -- 2.7.4