Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 399569cb authored by Shalom Toledo's avatar Shalom Toledo Committed by David S. Miller
Browse files

mlxsw: spectrum_ptp: Set the PTP shaper parameters 



Set the PTP shaper parameters during the ptp_init(). For different
speeds, there are different parameters.

When the port's speed changes and PTP shaper is enabled, the firmware
changes the ETS shaper values according to the PTP shaper parameters for
this new speed.

The PTP shaper parameters array is left empty for now, will be filled in
a follow-up patch.

Signed-off-by: default avatarShalom Toledo <shalomt@mellanox.com>
Reviewed-by: default avatarPetr Machata <petrm@mellanox.com>
Acked-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 71147506

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

+45 −0
Original line number Diff line number Diff line
@@ -753,12 +753,57 @@ static int mlxsw_sp1_ptp_mtpppc_set(struct mlxsw_sp *mlxsw_sp, 
	return mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(mtpppc), mtpppc_pl);

}



struct mlxsw_sp1_ptp_shaper_params {

	u32 ethtool_speed;

	enum mlxsw_reg_qpsc_port_speed port_speed;

	u8 shaper_time_exp;

	u8 shaper_time_mantissa;

	u8 shaper_inc;

	u8 shaper_bs;

	u8 port_to_shaper_credits;

	int ing_timestamp_inc;

	int egr_timestamp_inc;

};



static const struct mlxsw_sp1_ptp_shaper_params

mlxsw_sp1_ptp_shaper_params[] = {

};



#define MLXSW_SP1_PTP_SHAPER_PARAMS_LEN ARRAY_SIZE(mlxsw_sp1_ptp_shaper_params)



static int mlxsw_sp1_ptp_shaper_params_set(struct mlxsw_sp *mlxsw_sp)

{

	const struct mlxsw_sp1_ptp_shaper_params *params;

	char qpsc_pl[MLXSW_REG_QPSC_LEN];

	int i, err;



	for (i = 0; i < MLXSW_SP1_PTP_SHAPER_PARAMS_LEN; i++) {

		params = &mlxsw_sp1_ptp_shaper_params[i];

		mlxsw_reg_qpsc_pack(qpsc_pl, params->port_speed,

				    params->shaper_time_exp,

				    params->shaper_time_mantissa,

				    params->shaper_inc, params->shaper_bs,

				    params->port_to_shaper_credits,

				    params->ing_timestamp_inc,

				    params->egr_timestamp_inc);

		err = mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(qpsc), qpsc_pl);

		if (err)

			return err;

	}



	return 0;

}



struct mlxsw_sp_ptp_state *mlxsw_sp1_ptp_init(struct mlxsw_sp *mlxsw_sp)

{

	struct mlxsw_sp_ptp_state *ptp_state;

	u16 message_type;

	int err;



	err = mlxsw_sp1_ptp_shaper_params_set(mlxsw_sp);

	if (err)

		return ERR_PTR(err);



	ptp_state = kzalloc(sizeof(*ptp_state), GFP_KERNEL);

	if (!ptp_state)

		return ERR_PTR(-ENOMEM);