drivers/net/ethernet/mellanox/mlx5/core/qos.c

   1 // SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB
   2 /* Copyright (c) 2020, Mellanox Technologies inc. All rights reserved. */
   3
   4 #include "qos.h"
   5
   6 #define MLX5_QOS_DEFAULT_DWRR_UID 0
   7
   8 bool mlx5_qos_is_supported(struct mlx5_core_dev *mdev)
   9 {
  10         if (!MLX5_CAP_GEN(mdev, qos))
  11                 return false;
  12         if (!MLX5_CAP_QOS(mdev, nic_sq_scheduling))
  13                 return false;
  14         if (!MLX5_CAP_QOS(mdev, nic_bw_share))
  15                 return false;
  16         if (!MLX5_CAP_QOS(mdev, nic_rate_limit))
  17                 return false;
  18         return true;
  19 }
  20
  21 int mlx5_qos_max_leaf_nodes(struct mlx5_core_dev *mdev)
  22 {
  23         return 1 << MLX5_CAP_QOS(mdev, log_max_qos_nic_queue_group);
  24 }
  25
  26 int mlx5_qos_create_leaf_node(struct mlx5_core_dev *mdev, u32 parent_id,
  27                               u32 bw_share, u32 max_avg_bw, u32 *id)
  28 {
  29         u32 sched_ctx[MLX5_ST_SZ_DW(scheduling_context)] = {0};
  30
  31         MLX5_SET(scheduling_context, sched_ctx, parent_element_id, parent_id);
  32         MLX5_SET(scheduling_context, sched_ctx, element_type,
  33                  SCHEDULING_CONTEXT_ELEMENT_TYPE_QUEUE_GROUP);
  34         MLX5_SET(scheduling_context, sched_ctx, bw_share, bw_share);
  35         MLX5_SET(scheduling_context, sched_ctx, max_average_bw, max_avg_bw);
  36
  37         return mlx5_create_scheduling_element_cmd(mdev, SCHEDULING_HIERARCHY_NIC,
  38                                                   sched_ctx, id);
  39 }
  40
  41 int mlx5_qos_create_inner_node(struct mlx5_core_dev *mdev, u32 parent_id,
  42                                u32 bw_share, u32 max_avg_bw, u32 *id)
  43 {
  44         u32 sched_ctx[MLX5_ST_SZ_DW(scheduling_context)] = {0};
  45         void *attr;
  46
  47         MLX5_SET(scheduling_context, sched_ctx, parent_element_id, parent_id);
  48         MLX5_SET(scheduling_context, sched_ctx, element_type,
  49                  SCHEDULING_CONTEXT_ELEMENT_TYPE_TSAR);
  50         MLX5_SET(scheduling_context, sched_ctx, bw_share, bw_share);
  51         MLX5_SET(scheduling_context, sched_ctx, max_average_bw, max_avg_bw);
  52
  53         attr = MLX5_ADDR_OF(scheduling_context, sched_ctx, element_attributes);
  54         MLX5_SET(tsar_element, attr, tsar_type, TSAR_ELEMENT_TSAR_TYPE_DWRR);
  55
  56         return mlx5_create_scheduling_element_cmd(mdev, SCHEDULING_HIERARCHY_NIC,
  57                                                   sched_ctx, id);
  58 }
  59
  60 int mlx5_qos_create_root_node(struct mlx5_core_dev *mdev, u32 *id)
  61 {
  62         return mlx5_qos_create_inner_node(mdev, MLX5_QOS_DEFAULT_DWRR_UID, 0, 0, id);
  63 }
  64
  65 int mlx5_qos_update_node(struct mlx5_core_dev *mdev, u32 parent_id,
  66                          u32 bw_share, u32 max_avg_bw, u32 id)
  67 {
  68         u32 sched_ctx[MLX5_ST_SZ_DW(scheduling_context)] = {0};
  69         u32 bitmask = 0;
  70
  71         MLX5_SET(scheduling_context, sched_ctx, parent_element_id, parent_id);
  72         MLX5_SET(scheduling_context, sched_ctx, bw_share, bw_share);
  73         MLX5_SET(scheduling_context, sched_ctx, max_average_bw, max_avg_bw);
  74
  75         bitmask |= MODIFY_SCHEDULING_ELEMENT_IN_MODIFY_BITMASK_BW_SHARE;
  76         bitmask |= MODIFY_SCHEDULING_ELEMENT_IN_MODIFY_BITMASK_MAX_AVERAGE_BW;
  77
  78         return mlx5_modify_scheduling_element_cmd(mdev, SCHEDULING_HIERARCHY_NIC,
  79                                                   sched_ctx, id, bitmask);
  80 }
  81
  82 int mlx5_qos_destroy_node(struct mlx5_core_dev *mdev, u32 id)
  83 {
  84         return mlx5_destroy_scheduling_element_cmd(mdev, SCHEDULING_HIERARCHY_NIC, id);
  85 }