net/mlx5: QPTS and QPDPM register firmware command support

[linux-2.6-block.git] / drivers / net / ethernet / mellanox / mlx5 / core / port.c

diff --git a/drivers/net/ethernet/mellanox/mlx5/core/port.c b/drivers/net/ethernet/mellanox/mlx5/core/port.c
index b6553be841f97573b4ae941adc9abc13ab3b5a16..c37d00cd472a99226303f799c83d776a2c15d4e9 100644 (file)
--- a/drivers/net/ethernet/mellanox/mlx5/core/port.c
+++ b/drivers/net/ethernet/mellanox/mlx5/core/port.c
@@ -971,3 +971,102 @@ int mlx5_set_mtppse(struct mlx5_core_dev *mdev, u8 pin, u8 arm, u8 mode)
        return mlx5_core_access_reg(mdev, in, sizeof(in), out,
                                    sizeof(out), MLX5_REG_MTPPSE, 0, 1);
 }
+
+int mlx5_set_trust_state(struct mlx5_core_dev *mdev, u8 trust_state)
+{
+       u32 out[MLX5_ST_SZ_DW(qpts_reg)] = {};
+       u32 in[MLX5_ST_SZ_DW(qpts_reg)] = {};
+       int err;
+
+       MLX5_SET(qpts_reg, in, local_port, 1);
+       MLX5_SET(qpts_reg, in, trust_state, trust_state);
+
+       err = mlx5_core_access_reg(mdev, in, sizeof(in), out,
+                                  sizeof(out), MLX5_REG_QPTS, 0, 1);
+       return err;
+}
+
+int mlx5_query_trust_state(struct mlx5_core_dev *mdev, u8 *trust_state)
+{
+       u32 out[MLX5_ST_SZ_DW(qpts_reg)] = {};
+       u32 in[MLX5_ST_SZ_DW(qpts_reg)] = {};
+       int err;
+
+       MLX5_SET(qpts_reg, in, local_port, 1);
+
+       err = mlx5_core_access_reg(mdev, in, sizeof(in), out,
+                                  sizeof(out), MLX5_REG_QPTS, 0, 0);
+       if (!err)
+               *trust_state = MLX5_GET(qpts_reg, out, trust_state);
+
+       return err;
+}
+
+int mlx5_set_dscp2prio(struct mlx5_core_dev *mdev, u8 dscp, u8 prio)
+{
+       int sz = MLX5_ST_SZ_BYTES(qpdpm_reg);
+       void *qpdpm_dscp;
+       void *out;
+       void *in;
+       int err;
+
+       in = kzalloc(sz, GFP_KERNEL);
+       out = kzalloc(sz, GFP_KERNEL);
+       if (!in || !out) {
+               err = -ENOMEM;
+               goto out;
+       }
+
+       MLX5_SET(qpdpm_reg, in, local_port, 1);
+       err = mlx5_core_access_reg(mdev, in, sz, out, sz, MLX5_REG_QPDPM, 0, 0);
+       if (err)
+               goto out;
+
+       memcpy(in, out, sz);
+       MLX5_SET(qpdpm_reg, in, local_port, 1);
+
+       /* Update the corresponding dscp entry */
+       qpdpm_dscp = MLX5_ADDR_OF(qpdpm_reg, in, dscp[dscp]);
+       MLX5_SET16(qpdpm_dscp_reg, qpdpm_dscp, prio, prio);
+       MLX5_SET16(qpdpm_dscp_reg, qpdpm_dscp, e, 1);
+       err = mlx5_core_access_reg(mdev, in, sz, out, sz, MLX5_REG_QPDPM, 0, 1);
+
+out:
+       kfree(in);
+       kfree(out);
+       return err;
+}
+
+/* dscp2prio[i]: priority that dscp i mapped to */
+#define MLX5E_SUPPORTED_DSCP 64
+int mlx5_query_dscp2prio(struct mlx5_core_dev *mdev, u8 *dscp2prio)
+{
+       int sz = MLX5_ST_SZ_BYTES(qpdpm_reg);
+       void *qpdpm_dscp;
+       void *out;
+       void *in;
+       int err;
+       int i;
+
+       in = kzalloc(sz, GFP_KERNEL);
+       out = kzalloc(sz, GFP_KERNEL);
+       if (!in || !out) {
+               err = -ENOMEM;
+               goto out;
+       }
+
+       MLX5_SET(qpdpm_reg, in, local_port, 1);
+       err = mlx5_core_access_reg(mdev, in, sz, out, sz, MLX5_REG_QPDPM, 0, 0);
+       if (err)
+               goto out;
+
+       for (i = 0; i < (MLX5E_SUPPORTED_DSCP); i++) {
+               qpdpm_dscp = MLX5_ADDR_OF(qpdpm_reg, out, dscp[i]);
+               dscp2prio[i] = MLX5_GET16(qpdpm_dscp_reg, qpdpm_dscp, prio);
+       }
+
+out:
+       kfree(in);
+       kfree(out);
+       return err;
+}