mlxsw: spectrum_ethtool: Add link extended state

Implement .get_down_ext_state() as part of ethtool_ops.
Query link down reason from PDDR register and convert it to ethtool
link_ext_state.

In case that more information than common link_ext_state is provided,
fill link_ext_substate also with the appropriate value.

Signed-off-by: Amit Cohen <amitc@mellanox.com>
Reviewed-by: Jiri Pirko <jiri@mellanox.com>
Signed-off-by: Ido Schimmel <idosch@mellanox.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

diff --git a/drivers/net/ethernet/mellanox/mlxsw/spectrum_ethtool.c b/drivers/net/ethernet/mellanox/mlxsw/spectrum_ethtool.c
index 04e1db6..14c78f7 100644 (file)
--- a/drivers/net/ethernet/mellanox/mlxsw/spectrum_ethtool.c
+++ b/drivers/net/ethernet/mellanox/mlxsw/spectrum_ethtool.c
@@ -26,6 +26,150 @@ static void mlxsw_sp_port_get_drvinfo(struct net_device *dev,
                sizeof(drvinfo->bus_info));
 }
 
+struct mlxsw_sp_ethtool_link_ext_state_opcode_mapping {
+       u32 status_opcode;
+       enum ethtool_link_ext_state link_ext_state;
+       u8 link_ext_substate;
+};
+
+static const struct mlxsw_sp_ethtool_link_ext_state_opcode_mapping
+mlxsw_sp_link_ext_state_opcode_map[] = {
+       {2, ETHTOOL_LINK_EXT_STATE_AUTONEG,
+               ETHTOOL_LINK_EXT_SUBSTATE_AN_NO_PARTNER_DETECTED},
+       {3, ETHTOOL_LINK_EXT_STATE_AUTONEG,
+               ETHTOOL_LINK_EXT_SUBSTATE_AN_ACK_NOT_RECEIVED},
+       {4, ETHTOOL_LINK_EXT_STATE_AUTONEG,
+               ETHTOOL_LINK_EXT_SUBSTATE_AN_NEXT_PAGE_EXCHANGE_FAILED},
+       {36, ETHTOOL_LINK_EXT_STATE_AUTONEG,
+               ETHTOOL_LINK_EXT_SUBSTATE_AN_NO_PARTNER_DETECTED_FORCE_MODE},
+       {38, ETHTOOL_LINK_EXT_STATE_AUTONEG,
+               ETHTOOL_LINK_EXT_SUBSTATE_AN_FEC_MISMATCH_DURING_OVERRIDE},
+       {39, ETHTOOL_LINK_EXT_STATE_AUTONEG,
+               ETHTOOL_LINK_EXT_SUBSTATE_AN_NO_HCD},
+
+       {5, ETHTOOL_LINK_EXT_STATE_LINK_TRAINING_FAILURE,
+               ETHTOOL_LINK_EXT_SUBSTATE_LT_KR_FRAME_LOCK_NOT_ACQUIRED},
+       {6, ETHTOOL_LINK_EXT_STATE_LINK_TRAINING_FAILURE,
+               ETHTOOL_LINK_EXT_SUBSTATE_LT_KR_LINK_INHIBIT_TIMEOUT},
+       {7, ETHTOOL_LINK_EXT_STATE_LINK_TRAINING_FAILURE,
+               ETHTOOL_LINK_EXT_SUBSTATE_LT_KR_LINK_PARTNER_DID_NOT_SET_RECEIVER_READY},
+       {8, ETHTOOL_LINK_EXT_STATE_LINK_TRAINING_FAILURE, 0},
+       {14, ETHTOOL_LINK_EXT_STATE_LINK_TRAINING_FAILURE,
+               ETHTOOL_LINK_EXT_SUBSTATE_LT_REMOTE_FAULT},
+
+       {9, ETHTOOL_LINK_EXT_STATE_LINK_LOGICAL_MISMATCH,
+               ETHTOOL_LINK_EXT_SUBSTATE_LLM_PCS_DID_NOT_ACQUIRE_BLOCK_LOCK},
+       {10, ETHTOOL_LINK_EXT_STATE_LINK_LOGICAL_MISMATCH,
+               ETHTOOL_LINK_EXT_SUBSTATE_LLM_PCS_DID_NOT_ACQUIRE_AM_LOCK},
+       {11, ETHTOOL_LINK_EXT_STATE_LINK_LOGICAL_MISMATCH,
+               ETHTOOL_LINK_EXT_SUBSTATE_LLM_PCS_DID_NOT_GET_ALIGN_STATUS},
+       {12, ETHTOOL_LINK_EXT_STATE_LINK_LOGICAL_MISMATCH,
+               ETHTOOL_LINK_EXT_SUBSTATE_LLM_FC_FEC_IS_NOT_LOCKED},
+       {13, ETHTOOL_LINK_EXT_STATE_LINK_LOGICAL_MISMATCH,
+               ETHTOOL_LINK_EXT_SUBSTATE_LLM_RS_FEC_IS_NOT_LOCKED},
+
+       {15, ETHTOOL_LINK_EXT_STATE_BAD_SIGNAL_INTEGRITY, 0},
+       {17, ETHTOOL_LINK_EXT_STATE_BAD_SIGNAL_INTEGRITY,
+               ETHTOOL_LINK_EXT_SUBSTATE_BSI_LARGE_NUMBER_OF_PHYSICAL_ERRORS},
+       {42, ETHTOOL_LINK_EXT_STATE_BAD_SIGNAL_INTEGRITY,
+               ETHTOOL_LINK_EXT_SUBSTATE_BSI_UNSUPPORTED_RATE},
+
+       {1024, ETHTOOL_LINK_EXT_STATE_NO_CABLE, 0},
+
+       {16, ETHTOOL_LINK_EXT_STATE_CABLE_ISSUE,
+               ETHTOOL_LINK_EXT_SUBSTATE_CI_UNSUPPORTED_CABLE},
+       {20, ETHTOOL_LINK_EXT_STATE_CABLE_ISSUE,
+               ETHTOOL_LINK_EXT_SUBSTATE_CI_UNSUPPORTED_CABLE},
+       {29, ETHTOOL_LINK_EXT_STATE_CABLE_ISSUE,
+               ETHTOOL_LINK_EXT_SUBSTATE_CI_UNSUPPORTED_CABLE},
+       {1025, ETHTOOL_LINK_EXT_STATE_CABLE_ISSUE,
+               ETHTOOL_LINK_EXT_SUBSTATE_CI_UNSUPPORTED_CABLE},
+       {1029, ETHTOOL_LINK_EXT_STATE_CABLE_ISSUE,
+               ETHTOOL_LINK_EXT_SUBSTATE_CI_UNSUPPORTED_CABLE},
+       {1031, ETHTOOL_LINK_EXT_STATE_CABLE_ISSUE, 0},
+
+       {1027, ETHTOOL_LINK_EXT_STATE_EEPROM_ISSUE, 0},
+
+       {23, ETHTOOL_LINK_EXT_STATE_CALIBRATION_FAILURE, 0},
+
+       {1032, ETHTOOL_LINK_EXT_STATE_POWER_BUDGET_EXCEEDED, 0},
+
+       {1030, ETHTOOL_LINK_EXT_STATE_OVERHEAT, 0},
+};
+
+static void
+mlxsw_sp_port_set_link_ext_state(struct mlxsw_sp_ethtool_link_ext_state_opcode_mapping
+                                link_ext_state_mapping,
+                                struct ethtool_link_ext_state_info *link_ext_state_info)
+{
+       switch (link_ext_state_mapping.link_ext_state) {
+       case ETHTOOL_LINK_EXT_STATE_AUTONEG:
+               link_ext_state_info->autoneg =
+                       link_ext_state_mapping.link_ext_substate;
+               break;
+       case ETHTOOL_LINK_EXT_STATE_LINK_TRAINING_FAILURE:
+               link_ext_state_info->link_training =
+                       link_ext_state_mapping.link_ext_substate;
+               break;
+       case ETHTOOL_LINK_EXT_STATE_LINK_LOGICAL_MISMATCH:
+               link_ext_state_info->link_logical_mismatch =
+                       link_ext_state_mapping.link_ext_substate;
+               break;
+       case ETHTOOL_LINK_EXT_STATE_BAD_SIGNAL_INTEGRITY:
+               link_ext_state_info->bad_signal_integrity =
+                       link_ext_state_mapping.link_ext_substate;
+               break;
+       case ETHTOOL_LINK_EXT_STATE_CABLE_ISSUE:
+               link_ext_state_info->cable_issue =
+                       link_ext_state_mapping.link_ext_substate;
+               break;
+       default:
+               break;
+       }
+
+       link_ext_state_info->link_ext_state = link_ext_state_mapping.link_ext_state;
+}
+
+static int
+mlxsw_sp_port_get_link_ext_state(struct net_device *dev,
+                                struct ethtool_link_ext_state_info *link_ext_state_info)
+{
+       struct mlxsw_sp_ethtool_link_ext_state_opcode_mapping link_ext_state_mapping;
+       struct mlxsw_sp_port *mlxsw_sp_port = netdev_priv(dev);
+       char pddr_pl[MLXSW_REG_PDDR_LEN];
+       int opcode, err, i;
+       u32 status_opcode;
+
+       if (netif_carrier_ok(dev))
+               return -ENODATA;
+
+       mlxsw_reg_pddr_pack(pddr_pl, mlxsw_sp_port->local_port,
+                           MLXSW_REG_PDDR_PAGE_SELECT_TROUBLESHOOTING_INFO);
+
+       opcode = MLXSW_REG_PDDR_TRBLSH_GROUP_OPCODE_MONITOR;
+       mlxsw_reg_pddr_trblsh_group_opcode_set(pddr_pl, opcode);
+
+       err = mlxsw_reg_query(mlxsw_sp_port->mlxsw_sp->core, MLXSW_REG(pddr),
+                             pddr_pl);
+       if (err)
+               return err;
+
+       status_opcode = mlxsw_reg_pddr_trblsh_status_opcode_get(pddr_pl);
+       if (!status_opcode)
+               return -ENODATA;
+
+       for (i = 0; i < ARRAY_SIZE(mlxsw_sp_link_ext_state_opcode_map); i++) {
+               link_ext_state_mapping = mlxsw_sp_link_ext_state_opcode_map[i];
+               if (link_ext_state_mapping.status_opcode == status_opcode) {
+                       mlxsw_sp_port_set_link_ext_state(link_ext_state_mapping,
+                                                        link_ext_state_info);
+                       return 0;
+               }
+       }
+
+       return -ENODATA;
+}
+
 static void mlxsw_sp_port_get_pauseparam(struct net_device *dev,
                                         struct ethtool_pauseparam *pause)
 {
@@ -827,6 +971,7 @@ mlxsw_sp_get_ts_info(struct net_device *netdev, struct ethtool_ts_info *info)
 const struct ethtool_ops mlxsw_sp_port_ethtool_ops = {
        .get_drvinfo            = mlxsw_sp_port_get_drvinfo,
        .get_link               = ethtool_op_get_link,
+       .get_link_ext_state     = mlxsw_sp_port_get_link_ext_state,
        .get_pauseparam         = mlxsw_sp_port_get_pauseparam,
        .set_pauseparam         = mlxsw_sp_port_set_pauseparam,
        .get_strings            = mlxsw_sp_port_get_strings,