net/mlx5: support meter modification operations
[dpdk.git] / drivers / net / mlx5 / mlx5_flow_meter.c
index b11962f..6966ffc 100644 (file)
@@ -34,6 +34,71 @@ mlx5_flow_meter_profile_find(struct mlx5_priv *priv, uint32_t meter_profile_id)
        return NULL;
 }
 
+/**
+ * Validate the MTR profile.
+ *
+ * @param[in] dev
+ *   Pointer to Ethernet device.
+ * @param[in] meter_profile_id
+ *   Meter profile id.
+ * @param[in] profile
+ *   Pointer to meter profile detail.
+ * @param[out] error
+ *   Pointer to the error structure.
+ *
+ * @return
+ *   0 on success, a negative errno value otherwise and rte_errno is set.
+ */
+static int
+mlx5_flow_meter_profile_validate(struct rte_eth_dev *dev,
+                                uint32_t meter_profile_id,
+                                struct rte_mtr_meter_profile *profile,
+                                struct rte_mtr_error *error)
+{
+       struct mlx5_priv *priv = dev->data->dev_private;
+       struct mlx5_flow_meter_profile *fmp;
+
+       /* Profile must not be NULL. */
+       if (profile == NULL)
+               return -rte_mtr_error_set(error, EINVAL,
+                                         RTE_MTR_ERROR_TYPE_METER_PROFILE,
+                                         NULL, "Meter profile is null.");
+       /* Meter profile ID must be valid. */
+       if (meter_profile_id == UINT32_MAX)
+               return -rte_mtr_error_set(error, EINVAL,
+                                         RTE_MTR_ERROR_TYPE_METER_PROFILE_ID,
+                                         NULL, "Meter profile id not valid.");
+       /* Meter profile must not exist. */
+       fmp = mlx5_flow_meter_profile_find(priv, meter_profile_id);
+       if (fmp)
+               return -rte_mtr_error_set(error, EEXIST,
+                                         RTE_MTR_ERROR_TYPE_METER_PROFILE_ID,
+                                         NULL,
+                                         "Meter profile already exists.");
+       if (profile->alg == RTE_MTR_SRTCM_RFC2697) {
+               if (priv->config.hca_attr.qos.srtcm_sup) {
+                       /* Verify support for flow meter parameters. */
+                       if (profile->srtcm_rfc2697.cir > 0 &&
+                           profile->srtcm_rfc2697.cir <= MLX5_SRTCM_CIR_MAX &&
+                           profile->srtcm_rfc2697.cbs > 0 &&
+                           profile->srtcm_rfc2697.cbs <= MLX5_SRTCM_CBS_MAX &&
+                           profile->srtcm_rfc2697.ebs <= MLX5_SRTCM_EBS_MAX)
+                               return 0;
+                       else
+                               return -rte_mtr_error_set
+                                            (error, ENOTSUP,
+                                             RTE_MTR_ERROR_TYPE_MTR_PARAMS,
+                                             NULL,
+                                             profile->srtcm_rfc2697.ebs ?
+                                             "Metering value ebs must be 0." :
+                                             "Invalid metering parameters.");
+               }
+       }
+       return -rte_mtr_error_set(error, ENOTSUP,
+                                 RTE_MTR_ERROR_TYPE_METER_PROFILE,
+                                 NULL, "Metering algorithm not supported.");
+}
+
 /**
  * Calculate mantissa and exponent for cir.
  *
@@ -226,6 +291,11 @@ mlx5_flow_meter_profile_add(struct rte_eth_dev *dev,
                return -rte_mtr_error_set(error, ENOTSUP,
                                          RTE_MTR_ERROR_TYPE_UNSPECIFIED, NULL,
                                          "Meter is not support");
+       /* Check input params. */
+       ret = mlx5_flow_meter_profile_validate(dev, meter_profile_id,
+                                              profile, error);
+       if (ret)
+               return ret;
        /* Meter profile memory allocation. */
        fmp = rte_calloc(__func__, 1, sizeof(struct mlx5_flow_meter_profile),
                         RTE_CACHE_LINE_SIZE);
@@ -292,14 +362,458 @@ mlx5_flow_meter_profile_delete(struct rte_eth_dev *dev,
        return 0;
 }
 
+/**
+ * Convert wrong color setting action to verbose error.
+ *
+ * @param[in] action
+ *   Policy color action.
+ *
+ * @return
+ *   Verbose meter color error type.
+ */
+static inline enum rte_mtr_error_type
+action2error(enum rte_mtr_policer_action action)
+{
+       switch (action) {
+       case MTR_POLICER_ACTION_COLOR_GREEN:
+               return RTE_MTR_ERROR_TYPE_POLICER_ACTION_GREEN;
+       case MTR_POLICER_ACTION_COLOR_YELLOW:
+               return RTE_MTR_ERROR_TYPE_POLICER_ACTION_YELLOW;
+       case MTR_POLICER_ACTION_COLOR_RED:
+               return RTE_MTR_ERROR_TYPE_POLICER_ACTION_RED;
+       default:
+               break;
+       }
+       return RTE_MTR_ERROR_TYPE_UNSPECIFIED;
+}
+
+/**
+ * Check meter validation.
+ *
+ * @param[in] priv
+ *   Pointer to mlx5 private data structure.
+ * @param[in] meter_id
+ *   Meter id.
+ * @param[in] params
+ *   Pointer to rte meter parameters.
+ * @param[out] error
+ *   Pointer to rte meter error structure.
+ *
+ * @return
+ *   0 on success, a negative errno value otherwise and rte_errno is set.
+ */
+static int
+mlx5_flow_meter_validate(struct mlx5_priv *priv, uint32_t meter_id,
+                        struct rte_mtr_params *params,
+                        struct rte_mtr_error *error)
+{
+       static enum rte_mtr_policer_action
+                               valid_recol_action[RTE_COLORS] = {
+                                              MTR_POLICER_ACTION_COLOR_GREEN,
+                                              MTR_POLICER_ACTION_COLOR_YELLOW,
+                                              MTR_POLICER_ACTION_COLOR_RED };
+       int i;
+
+       /* Meter params must not be NULL. */
+       if (params == NULL)
+               return -rte_mtr_error_set(error, EINVAL,
+                                         RTE_MTR_ERROR_TYPE_MTR_PARAMS,
+                                         NULL, "Meter object params null.");
+       /* Previous meter color is not supported. */
+       if (params->use_prev_mtr_color)
+               return -rte_mtr_error_set(error, ENOTSUP,
+                                         RTE_MTR_ERROR_TYPE_MTR_PARAMS,
+                                         NULL,
+                                         "Previous meter color "
+                                         "not supported.");
+       /* Validate policer settings. */
+       for (i = 0; i < RTE_COLORS; i++)
+               if (params->action[i] != valid_recol_action[i] &&
+                   params->action[i] != MTR_POLICER_ACTION_DROP)
+                       return -rte_mtr_error_set
+                                       (error, ENOTSUP,
+                                        action2error(params->action[i]), NULL,
+                                        "Recolor action not supported.");
+       /* Validate meter id. */
+       if (mlx5_flow_meter_find(priv, meter_id))
+               return -rte_mtr_error_set(error, EEXIST,
+                                         RTE_MTR_ERROR_TYPE_MTR_ID, NULL,
+                                         "Meter object already exists.");
+       return 0;
+}
+
+/**
+ * Modify the flow meter action.
+ *
+ * @param[in] priv
+ *   Pointer to mlx5 private data structure.
+ * @param[in] fm
+ *   Pointer to flow meter to be modified.
+ * @param[in] srtcm
+ *   Pointer to meter srtcm description parameter.
+ * @param[in] modify_bits
+ *   The bit in srtcm to be updated.
+ * @param[in] active_state
+ *   The state to be updated.
+ * @return
+ *   0 on success, o negative value otherwise.
+ */
+static int
+mlx5_flow_meter_action_modify(struct mlx5_priv *priv,
+               struct mlx5_flow_meter *fm,
+               const struct mlx5_flow_meter_srtcm_rfc2697_prm *srtcm,
+               uint64_t modify_bits, uint32_t active_state)
+{
+#ifdef HAVE_MLX5_DR_CREATE_ACTION_FLOW_METER
+       uint32_t in[MLX5_ST_SZ_DW(flow_meter_parameters)] = { 0 };
+       uint32_t *attr;
+       struct mlx5dv_dr_flow_meter_attr mod_attr = { 0 };
+       int ret;
+
+       /* Fill command parameters. */
+       mod_attr.reg_c_index = priv->mtr_color_reg - REG_C_0;
+       mod_attr.flow_meter_parameter = in;
+       mod_attr.flow_meter_parameter_sz = fm->mfts->fmp_size;
+       if (modify_bits & MLX5_FLOW_METER_OBJ_MODIFY_FIELD_ACTIVE)
+               mod_attr.active = !!active_state;
+       else
+               mod_attr.active = 0;
+       attr = in;
+       if (modify_bits & MLX5_FLOW_METER_OBJ_MODIFY_FIELD_CBS) {
+               MLX5_SET(flow_meter_parameters,
+                        attr, cbs_exponent, srtcm->cbs_exponent);
+               MLX5_SET(flow_meter_parameters,
+                        attr, cbs_mantissa, srtcm->cbs_mantissa);
+       }
+       if (modify_bits & MLX5_FLOW_METER_OBJ_MODIFY_FIELD_CIR) {
+               MLX5_SET(flow_meter_parameters,
+                        attr, cir_exponent, srtcm->cir_exponent);
+               MLX5_SET(flow_meter_parameters,
+                        attr, cir_mantissa, srtcm->cir_mantissa);
+       }
+       if (modify_bits & MLX5_FLOW_METER_OBJ_MODIFY_FIELD_EBS) {
+               MLX5_SET(flow_meter_parameters,
+                        attr, ebs_exponent, srtcm->ebs_exponent);
+               MLX5_SET(flow_meter_parameters,
+                        attr, ebs_mantissa, srtcm->ebs_mantissa);
+       }
+       /* Apply modifications to meter only if it was created. */
+       if (fm->mfts->meter_action) {
+               ret = mlx5_glue->dv_modify_flow_action_meter
+                                       (fm->mfts->meter_action, &mod_attr,
+                                       rte_cpu_to_be_64(modify_bits));
+               if (ret)
+                       return ret;
+       }
+       /* Update succeedded modify meter parameters. */
+       if (modify_bits & MLX5_FLOW_METER_OBJ_MODIFY_FIELD_ACTIVE)
+               fm->active_state = !!active_state;
+       attr = fm->mfts->fmp;
+       if (modify_bits & MLX5_FLOW_METER_OBJ_MODIFY_FIELD_CBS) {
+               MLX5_SET(flow_meter_parameters,
+                        attr, cbs_exponent, srtcm->cbs_exponent);
+               MLX5_SET(flow_meter_parameters,
+                        attr, cbs_mantissa, srtcm->cbs_mantissa);
+       }
+       if (modify_bits & MLX5_FLOW_METER_OBJ_MODIFY_FIELD_CIR) {
+               MLX5_SET(flow_meter_parameters,
+                        attr, cir_exponent, srtcm->cir_exponent);
+               MLX5_SET(flow_meter_parameters,
+                        attr, cir_mantissa, srtcm->cir_mantissa);
+       }
+       if (modify_bits & MLX5_FLOW_METER_OBJ_MODIFY_FIELD_EBS) {
+               MLX5_SET(flow_meter_parameters,
+                        attr, ebs_exponent, srtcm->ebs_exponent);
+               MLX5_SET(flow_meter_parameters,
+                        attr, ebs_mantissa, srtcm->ebs_mantissa);
+       }
+
+       return 0;
+#else
+       (void)priv;
+       (void)fm;
+       (void)srtcm;
+       (void)modify_bits;
+       (void)active_state;
+       return -ENOTSUP;
+#endif
+}
+
+/**
+ * Create meter rules.
+ *
+ * @param[in] dev
+ *   Pointer to Ethernet device.
+ * @param[in] meter_id
+ *   Meter id.
+ * @param[in] params
+ *   Pointer to rte meter parameters.
+ * @param[in] shared
+ *   Meter shared with other flow or not.
+ * @param[out] error
+ *   Pointer to rte meter error structure.
+ *
+ * @return
+ *   0 on success, a negative errno value otherwise and rte_errno is set.
+ */
+static int
+mlx5_flow_meter_create(struct rte_eth_dev *dev, uint32_t meter_id,
+                      struct rte_mtr_params *params, int shared,
+                      struct rte_mtr_error *error)
+{
+       struct mlx5_priv *priv = dev->data->dev_private;
+       struct mlx5_flow_meters *fms = &priv->flow_meters;
+       struct mlx5_flow_meter_profile *fmp;
+       struct mlx5_flow_meter *fm;
+       const struct rte_flow_attr attr = {
+                               .ingress = 1,
+                               .egress = 1,
+                               .transfer = priv->config.dv_esw_en ? 1 : 0,
+                       };
+       int ret;
+
+       if (!priv->mtr_en)
+               return -rte_mtr_error_set(error, ENOTSUP,
+                                         RTE_MTR_ERROR_TYPE_UNSPECIFIED, NULL,
+                                         "Meter is not support");
+       /* Validate the parameters. */
+       ret = mlx5_flow_meter_validate(priv, meter_id, params, error);
+       if (ret)
+               return ret;
+       /* Meter profile must exist. */
+       fmp = mlx5_flow_meter_profile_find(priv, params->meter_profile_id);
+       if (fmp == NULL)
+               return -rte_mtr_error_set(error, ENOENT,
+                                         RTE_MTR_ERROR_TYPE_METER_PROFILE_ID,
+                                         NULL, "Meter profile id not valid.");
+       /* Allocate the flow meter memory. */
+       fm = rte_calloc(__func__, 1,
+                       sizeof(struct mlx5_flow_meter), RTE_CACHE_LINE_SIZE);
+       if (fm == NULL)
+               return -rte_mtr_error_set(error, ENOMEM,
+                                         RTE_MTR_ERROR_TYPE_UNSPECIFIED, NULL,
+                                         "Memory alloc failed for meter.");
+       /* Fill the flow meter parameters. */
+       fm->meter_id = meter_id;
+       fm->profile = fmp;
+       fm->params = *params;
+       fm->mfts = mlx5_flow_create_mtr_tbls(dev);
+       if (!fm->mfts)
+               goto error;
+       ret = mlx5_flow_create_policer_rules(dev, fm, &attr);
+       if (ret)
+               goto error;
+       /* Add to the flow meter list. */
+       TAILQ_INSERT_TAIL(fms, fm, next);
+       fm->active_state = 1; /* Config meter starts as active. */
+       fm->shared = !!shared;
+       fm->profile->ref_cnt++;
+       return 0;
+error:
+       mlx5_flow_destroy_policer_rules(dev, fm, &attr);
+       mlx5_flow_destroy_mtr_tbls(dev, fm->mfts);
+       rte_free(fm);
+       return -rte_mtr_error_set(error, -ret,
+                                 RTE_MTR_ERROR_TYPE_UNSPECIFIED,
+                                 NULL, "Failed to create devx meter.");
+}
+
+/**
+ * Destroy meter rules.
+ *
+ * @param[in] dev
+ *   Pointer to Ethernet device.
+ * @param[in] meter_id
+ *   Meter id.
+ * @param[out] error
+ *   Pointer to rte meter error structure.
+ *
+ * @return
+ *   0 on success, a negative errno value otherwise and rte_errno is set.
+ */
+static int
+mlx5_flow_meter_destroy(struct rte_eth_dev *dev, uint32_t meter_id,
+                       struct rte_mtr_error *error)
+{
+       struct mlx5_priv *priv = dev->data->dev_private;
+       struct mlx5_flow_meters *fms = &priv->flow_meters;
+       struct mlx5_flow_meter_profile *fmp;
+       struct mlx5_flow_meter *fm;
+       const struct rte_flow_attr attr = {
+                               .ingress = 1,
+                               .egress = 1,
+                               .transfer = priv->config.dv_esw_en ? 1 : 0,
+                       };
+
+       if (!priv->mtr_en)
+               return -rte_mtr_error_set(error, ENOTSUP,
+                                         RTE_MTR_ERROR_TYPE_UNSPECIFIED, NULL,
+                                         "Meter is not support");
+       /* Meter object must exist. */
+       fm = mlx5_flow_meter_find(priv, meter_id);
+       if (fm == NULL)
+               return -rte_mtr_error_set(error, ENOENT,
+                                         RTE_MTR_ERROR_TYPE_MTR_ID,
+                                         NULL, "Meter object id not valid.");
+       /* Meter object must not have any owner. */
+       if (fm->ref_cnt > 0)
+               return -rte_mtr_error_set(error, EBUSY,
+                                         RTE_MTR_ERROR_TYPE_UNSPECIFIED,
+                                         NULL, "Meter object is being used.");
+       /* Get the meter profile. */
+       fmp = fm->profile;
+       RTE_ASSERT(fmp);
+       /* Update dependencies. */
+       fmp->ref_cnt--;
+       /* Remove from the flow meter list. */
+       TAILQ_REMOVE(fms, fm, next);
+       /* Free meter flow table */
+       mlx5_flow_destroy_policer_rules(dev, fm, &attr);
+       mlx5_flow_destroy_mtr_tbls(dev, fm->mfts);
+       rte_free(fm);
+       return 0;
+}
+
+/**
+ * Modify meter state.
+ *
+ * @param[in] priv
+ *   Pointer to mlx5 private data structure.
+ * @param[in] fm
+ *   Pointer to flow meter.
+ * @param[in] new_state
+ *   New state to update.
+ * @param[out] error
+ *   Pointer to rte meter error structure.
+ *
+ * @return
+ *   0 on success, a negative errno value otherwise and rte_errno is set.
+ */
+static int
+mlx5_flow_meter_modify_state(struct mlx5_priv *priv,
+                            struct mlx5_flow_meter *fm,
+                            uint32_t new_state,
+                            struct rte_mtr_error *error)
+{
+       static const struct mlx5_flow_meter_srtcm_rfc2697_prm srtcm = {
+               .cbs_exponent = 20,
+               .cbs_mantissa = 191,
+               .cir_exponent = 0,
+               .cir_mantissa = 200,
+               .ebs_exponent = 0,
+               .ebs_mantissa = 0,
+       };
+       uint64_t modify_bits = MLX5_FLOW_METER_OBJ_MODIFY_FIELD_CBS |
+                              MLX5_FLOW_METER_OBJ_MODIFY_FIELD_CIR;
+       int ret;
+
+       if (new_state == MLX5_FLOW_METER_DISABLE)
+               ret = mlx5_flow_meter_action_modify(priv, fm, &srtcm,
+                                                   modify_bits, 0);
+       else
+               ret = mlx5_flow_meter_action_modify(priv, fm,
+                                                  &fm->profile->srtcm_prm,
+                                                   modify_bits, 0);
+       if (ret)
+               return -rte_mtr_error_set(error, -ret,
+                                         RTE_MTR_ERROR_TYPE_MTR_PARAMS,
+                                         NULL,
+                                         new_state ?
+                                         "Failed to enable meter." :
+                                         "Failed to disable meter.");
+       return 0;
+}
+
+/**
+ * Callback to enable flow meter.
+ *
+ * @param[in] dev
+ *   Pointer to Ethernet device.
+ * @param[in] meter_id
+ *   Meter id.
+ * @param[out] error
+ *   Pointer to rte meter error structure.
+ *
+ * @return
+ *   0 on success, a negative errno value otherwise and rte_errno is set.
+ */
+static int
+mlx5_flow_meter_enable(struct rte_eth_dev *dev,
+                      uint32_t meter_id,
+                      struct rte_mtr_error *error)
+{
+       struct mlx5_priv *priv = dev->data->dev_private;
+       struct mlx5_flow_meter *fm;
+       int ret;
+
+       if (!priv->mtr_en)
+               return -rte_mtr_error_set(error, ENOTSUP,
+                                         RTE_MTR_ERROR_TYPE_UNSPECIFIED, NULL,
+                                         "Meter is not support");
+       /* Meter object must exist. */
+       fm = mlx5_flow_meter_find(priv, meter_id);
+       if (fm == NULL)
+               return -rte_mtr_error_set(error, ENOENT,
+                                         RTE_MTR_ERROR_TYPE_MTR_ID,
+                                         NULL, "Meter not found.");
+       if (fm->active_state == MLX5_FLOW_METER_ENABLE)
+               return 0;
+       ret = mlx5_flow_meter_modify_state(priv, fm, MLX5_FLOW_METER_ENABLE,
+                                          error);
+       if (!ret)
+               fm->active_state = MLX5_FLOW_METER_ENABLE;
+       return ret;
+}
+
+/**
+ * Callback to disable flow meter.
+ *
+ * @param[in] dev
+ *   Pointer to Ethernet device.
+ * @param[in] meter_id
+ *   Meter id.
+ * @param[out] error
+ *   Pointer to rte meter error structure.
+ *
+ * @return
+ *   0 on success, a negative errno value otherwise and rte_errno is set.
+ */
+static int
+mlx5_flow_meter_disable(struct rte_eth_dev *dev,
+                       uint32_t meter_id,
+                       struct rte_mtr_error *error)
+{
+       struct mlx5_priv *priv = dev->data->dev_private;
+       struct mlx5_flow_meter *fm;
+       int ret;
+
+       if (!priv->mtr_en)
+               return -rte_mtr_error_set(error, ENOTSUP,
+                                         RTE_MTR_ERROR_TYPE_UNSPECIFIED, NULL,
+                                         "Meter is not support");
+       /* Meter object must exist. */
+       fm = mlx5_flow_meter_find(priv, meter_id);
+       if (fm == NULL)
+               return -rte_mtr_error_set(error, ENOENT,
+                                         RTE_MTR_ERROR_TYPE_MTR_ID,
+                                         NULL, "Meter not found.");
+       if (fm->active_state == MLX5_FLOW_METER_DISABLE)
+               return 0;
+       ret = mlx5_flow_meter_modify_state(priv, fm, MLX5_FLOW_METER_DISABLE,
+                                          error);
+       if (!ret)
+               fm->active_state = MLX5_FLOW_METER_DISABLE;
+       return ret;
+}
+
 static const struct rte_mtr_ops mlx5_flow_mtr_ops = {
        .capabilities_get = mlx5_flow_mtr_cap_get,
        .meter_profile_add = mlx5_flow_meter_profile_add,
        .meter_profile_delete = mlx5_flow_meter_profile_delete,
-       .create = NULL,
-       .destroy = NULL,
-       .meter_enable = NULL,
-       .meter_disable = NULL,
+       .create = mlx5_flow_meter_create,
+       .destroy = mlx5_flow_meter_destroy,
+       .meter_enable = mlx5_flow_meter_enable,
+       .meter_disable = mlx5_flow_meter_disable,
        .meter_profile_update = NULL,
        .meter_dscp_table_update = NULL,
        .policer_actions_update = NULL,
@@ -324,3 +838,26 @@ mlx5_flow_meter_ops_get(struct rte_eth_dev *dev __rte_unused, void *arg)
        *(const struct rte_mtr_ops **)arg = &mlx5_flow_mtr_ops;
        return 0;
 }
+
+/**
+ * Find meter by id.
+ *
+ * @param priv
+ *   Pointer to mlx5_priv.
+ * @param meter_id
+ *   Meter id.
+ *
+ * @return
+ *   Pointer to the profile found on success, NULL otherwise.
+ */
+struct mlx5_flow_meter *
+mlx5_flow_meter_find(struct mlx5_priv *priv, uint32_t meter_id)
+{
+       struct mlx5_flow_meters *fms = &priv->flow_meters;
+       struct mlx5_flow_meter *fm;
+
+       TAILQ_FOREACH(fm, fms, next)
+               if (meter_id == fm->meter_id)
+                       return fm;
+       return NULL;
+}