Commit 60f30cd6 authored by Amit Cohen's avatar Amit Cohen Committed by David S. Miller
Browse files

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: default avatarAmit Cohen <amitc@mellanox.com>
Reviewed-by: default avatarJiri Pirko <jiri@mellanox.com>
Signed-off-by: default avatarIdo Schimmel <idosch@mellanox.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 1bd06938

drivers/net/ethernet/mellanox/mlxsw/spectrum_ethtool.c

+145 −0
Original line number Diff line number Diff line
@@ -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,

CRA Git | Maintained and supported by SUSTech CRA and CCSE