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: Shalom Toledo <shalomt@mellanox.com>
Reviewed-by: Petr Machata <petrm@mellanox.com>
Acked-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_ptp.c b/drivers/net/ethernet/mellanox/mlxsw/spectrum_ptp.c
index 437023d67a3bf2b7f5562e0b9932d69b9502e7d8..08e62cb3d7f2be1807ca6c163337a08e962bbc34 100644 (file)
--- a/drivers/net/ethernet/mellanox/mlxsw/spectrum_ptp.c
+++ b/drivers/net/ethernet/mellanox/mlxsw/spectrum_ptp.c
@@ -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);