Author: hselasky
Date: Wed May  8 10:41:21 2019
New Revision: 347276
URL: https://svnweb.freebsd.org/changeset/base/347276

Log:
  Add helper functions to set/query MCC/MCDA/MCQI registers in mlx5core.
  
  To be used by the mlx5 callbacks exposed to the mlxfw module.
  
  Linux commit:
  d2ad488b0073bd1a2c3f5d2ea50a7eb632103e5d
  
  Submitted by: slavash@
  MFC after:    3 days
  Sponsored by: Mellanox Technologies

Modified:
  head/sys/dev/mlx5/mlx5_core/mlx5_fw.c

Modified: head/sys/dev/mlx5/mlx5_core/mlx5_fw.c
==============================================================================
--- head/sys/dev/mlx5/mlx5_core/mlx5_fw.c       Wed May  8 10:41:00 2019        
(r347275)
+++ head/sys/dev/mlx5/mlx5_core/mlx5_fw.c       Wed May  8 10:41:21 2019        
(r347276)
@@ -341,3 +341,117 @@ int mlx5_core_set_dc_cnak_trace(struct mlx5_core_dev *
 
        return mlx5_cmd_exec(dev, &in, sizeof(in), &out, sizeof(out));
 }
+
+enum mlxsw_reg_mcc_instruction {
+       MLX5_REG_MCC_INSTRUCTION_LOCK_UPDATE_HANDLE = 0x01,
+       MLX5_REG_MCC_INSTRUCTION_RELEASE_UPDATE_HANDLE = 0x02,
+       MLX5_REG_MCC_INSTRUCTION_UPDATE_COMPONENT = 0x03,
+       MLX5_REG_MCC_INSTRUCTION_VERIFY_COMPONENT = 0x04,
+       MLX5_REG_MCC_INSTRUCTION_ACTIVATE = 0x06,
+       MLX5_REG_MCC_INSTRUCTION_CANCEL = 0x08,
+};
+
+static int mlx5_reg_mcc_set(struct mlx5_core_dev *dev,
+                           enum mlxsw_reg_mcc_instruction instr,
+                           u16 component_index, u32 update_handle,
+                           u32 component_size)
+{
+       u32 out[MLX5_ST_SZ_DW(mcc_reg)];
+       u32 in[MLX5_ST_SZ_DW(mcc_reg)];
+
+       memset(in, 0, sizeof(in));
+
+       MLX5_SET(mcc_reg, in, instruction, instr);
+       MLX5_SET(mcc_reg, in, component_index, component_index);
+       MLX5_SET(mcc_reg, in, update_handle, update_handle);
+       MLX5_SET(mcc_reg, in, component_size, component_size);
+
+       return mlx5_core_access_reg(dev, in, sizeof(in), out,
+                                   sizeof(out), MLX5_REG_MCC, 0, 1);
+}
+
+static int mlx5_reg_mcc_query(struct mlx5_core_dev *dev,
+                             u32 *update_handle, u8 *error_code,
+                             u8 *control_state)
+{
+       u32 out[MLX5_ST_SZ_DW(mcc_reg)];
+       u32 in[MLX5_ST_SZ_DW(mcc_reg)];
+       int err;
+
+       memset(in, 0, sizeof(in));
+       memset(out, 0, sizeof(out));
+       MLX5_SET(mcc_reg, in, update_handle, *update_handle);
+
+       err = mlx5_core_access_reg(dev, in, sizeof(in), out,
+                                  sizeof(out), MLX5_REG_MCC, 0, 0);
+       if (err)
+               goto out;
+
+       *update_handle = MLX5_GET(mcc_reg, out, update_handle);
+       *error_code = MLX5_GET(mcc_reg, out, error_code);
+       *control_state = MLX5_GET(mcc_reg, out, control_state);
+
+out:
+       return err;
+}
+
+static int mlx5_reg_mcda_set(struct mlx5_core_dev *dev,
+                            u32 update_handle,
+                            u32 offset, u16 size,
+                            u8 *data)
+{
+       int err, in_size = MLX5_ST_SZ_BYTES(mcda_reg) + size;
+       u32 out[MLX5_ST_SZ_DW(mcda_reg)];
+       int i, j, dw_size = size >> 2;
+       __be32 data_element;
+       u32 *in;
+
+       in = kzalloc(in_size, GFP_KERNEL);
+       if (!in)
+               return -ENOMEM;
+
+       MLX5_SET(mcda_reg, in, update_handle, update_handle);
+       MLX5_SET(mcda_reg, in, offset, offset);
+       MLX5_SET(mcda_reg, in, size, size);
+
+       for (i = 0; i < dw_size; i++) {
+               j = i * 4;
+               data_element = htonl(*(u32 *)&data[j]);
+               memcpy(MLX5_ADDR_OF(mcda_reg, in, data) + j, &data_element, 4);
+       }
+
+       err = mlx5_core_access_reg(dev, in, in_size, out,
+                                  sizeof(out), MLX5_REG_MCDA, 0, 1);
+       kfree(in);
+       return err;
+}
+
+static int mlx5_reg_mcqi_query(struct mlx5_core_dev *dev,
+                              u16 component_index,
+                              u32 *max_component_size,
+                              u8 *log_mcda_word_size,
+                              u16 *mcda_max_write_size)
+{
+       u32 out[MLX5_ST_SZ_DW(mcqi_reg) + MLX5_ST_SZ_DW(mcqi_cap)];
+       int offset = MLX5_ST_SZ_DW(mcqi_reg);
+       u32 in[MLX5_ST_SZ_DW(mcqi_reg)];
+       int err;
+
+       memset(in, 0, sizeof(in));
+       memset(out, 0, sizeof(out));
+
+       MLX5_SET(mcqi_reg, in, component_index, component_index);
+       MLX5_SET(mcqi_reg, in, data_size, MLX5_ST_SZ_BYTES(mcqi_cap));
+
+       err = mlx5_core_access_reg(dev, in, sizeof(in), out,
+                                  sizeof(out), MLX5_REG_MCQI, 0, 0);
+       if (err)
+               goto out;
+
+       *max_component_size = MLX5_GET(mcqi_cap, out + offset, 
max_component_size);
+       *log_mcda_word_size = MLX5_GET(mcqi_cap, out + offset, 
log_mcda_word_size);
+       *mcda_max_write_size = MLX5_GET(mcqi_cap, out + offset, 
mcda_max_write_size);
+
+out:
+       return err;
+}
_______________________________________________
svn-src-head@freebsd.org mailing list
https://lists.freebsd.org/mailman/listinfo/svn-src-head
To unsubscribe, send any mail to "svn-src-head-unsubscr...@freebsd.org"

Reply via email to