drivers/vdpa/mlx5/mlx5_vdpa_lm.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright 2019 Mellanox Technologies, Ltd
   3  */
   4 #include <rte_malloc.h>
   5 #include <rte_errno.h>
   6
   7 #include "mlx5_vdpa_utils.h"
   8 #include "mlx5_vdpa.h"
   9
  10
  11 int
  12 mlx5_vdpa_logging_enable(struct mlx5_vdpa_priv *priv, int enable)
  13 {
  14         struct mlx5_devx_virtq_attr attr = {
  15                 .type = MLX5_VIRTQ_MODIFY_TYPE_DIRTY_BITMAP_DUMP_ENABLE,
  16                 .dirty_bitmap_dump_enable = enable,
  17         };
  18         int i;
  19
  20         for (i = 0; i < priv->nr_virtqs; ++i) {
  21                 attr.queue_index = i;
  22                 if (mlx5_devx_cmd_modify_virtq(priv->virtqs[i].virtq, &attr)) {
  23                         DRV_LOG(ERR, "Failed to modify virtq %d logging.", i);
  24                         return -1;
  25                 }
  26         }
  27         return 0;
  28 }
  29
  30 int
  31 mlx5_vdpa_dirty_bitmap_set(struct mlx5_vdpa_priv *priv, uint64_t log_base,
  32                            uint64_t log_size)
  33 {
  34         struct mlx5_devx_mkey_attr mkey_attr = {
  35                         .addr = (uintptr_t)log_base,
  36                         .size = log_size,
  37                         .pd = priv->pdn,
  38                         .pg_access = 1,
  39                         .klm_array = NULL,
  40                         .klm_num = 0,
  41                         .relaxed_ordering = 0,
  42         };
  43         struct mlx5_devx_virtq_attr attr = {
  44                 .type = MLX5_VIRTQ_MODIFY_TYPE_DIRTY_BITMAP_PARAMS,
  45                 .dirty_bitmap_addr = log_base,
  46                 .dirty_bitmap_size = log_size,
  47         };
  48         struct mlx5_vdpa_query_mr *mr = rte_malloc(__func__, sizeof(*mr), 0);
  49         int i;
  50
  51         if (!mr) {
  52                 DRV_LOG(ERR, "Failed to allocate mem for lm mr.");
  53                 return -1;
  54         }
  55         mr->umem = mlx5_glue->devx_umem_reg(priv->ctx,
  56                                             (void *)(uintptr_t)log_base,
  57                                             log_size, IBV_ACCESS_LOCAL_WRITE);
  58         if (!mr->umem) {
  59                 DRV_LOG(ERR, "Failed to register umem for lm mr.");
  60                 goto err;
  61         }
  62         mkey_attr.umem_id = mr->umem->umem_id;
  63         mr->mkey = mlx5_devx_cmd_mkey_create(priv->ctx, &mkey_attr);
  64         if (!mr->mkey) {
  65                 DRV_LOG(ERR, "Failed to create Mkey for lm.");
  66                 goto err;
  67         }
  68         attr.dirty_bitmap_mkey = mr->mkey->id;
  69         for (i = 0; i < priv->nr_virtqs; ++i) {
  70                 attr.queue_index = i;
  71                 if (mlx5_devx_cmd_modify_virtq(priv->virtqs[i].virtq, &attr)) {
  72                         DRV_LOG(ERR, "Failed to modify virtq %d for lm.", i);
  73                         goto err;
  74                 }
  75         }
  76         mr->is_indirect = 0;
  77         SLIST_INSERT_HEAD(&priv->mr_list, mr, next);
  78         return 0;
  79 err:
  80         if (mr->mkey)
  81                 mlx5_devx_cmd_destroy(mr->mkey);
  82         if (mr->umem)
  83                 mlx5_glue->devx_umem_dereg(mr->umem);
  84         rte_free(mr);
  85         return -1;
  86 }
  87
  88 #define MLX5_VDPA_USED_RING_LEN(size) \
  89         ((size) * sizeof(struct vring_used_elem) + sizeof(uint16_t) * 3)
  90
  91 int
  92 mlx5_vdpa_lm_log(struct mlx5_vdpa_priv *priv)
  93 {
  94         struct mlx5_devx_virtq_attr attr = {0};
  95         uint64_t features;
  96         int ret = rte_vhost_get_negotiated_features(priv->vid, &features);
  97         int i;
  98
  99         if (ret) {
 100                 DRV_LOG(ERR, "Failed to get negotiated features.");
 101                 return -1;
 102         }
 103         if (!RTE_VHOST_NEED_LOG(features))
 104                 return 0;
 105         for (i = 0; i < priv->nr_virtqs; ++i) {
 106                 ret = mlx5_vdpa_virtq_modify(&priv->virtqs[i], 0);
 107                 if (ret)
 108                         return -1;
 109                 if (mlx5_devx_cmd_query_virtq(priv->virtqs[i].virtq, &attr)) {
 110                         DRV_LOG(ERR, "Failed to query virtq %d.", i);
 111                         return -1;
 112                 }
 113                 DRV_LOG(INFO, "Query vid %d vring %d: hw_available_idx=%d, "
 114                         "hw_used_index=%d", priv->vid, i,
 115                         attr.hw_available_index, attr.hw_used_index);
 116                 ret = rte_vhost_set_vring_base(priv->vid, i,
 117                                                attr.hw_available_index,
 118                                                attr.hw_used_index);
 119                 if (ret) {
 120                         DRV_LOG(ERR, "Failed to set virtq %d base.", i);
 121                         return -1;
 122                 }
 123                 rte_vhost_log_used_vring(priv->vid, i, 0,
 124                               MLX5_VDPA_USED_RING_LEN(priv->virtqs[i].vq_size));
 125         }
 126         return 0;
 127 }