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         struct mlx5_vdpa_virtq *virtq;
  19
  20         SLIST_FOREACH(virtq, &priv->virtq_list, next) {
  21                 attr.queue_index = virtq->index;
  22                 if (mlx5_devx_cmd_modify_virtq(virtq->virtq, &attr)) {
  23                         DRV_LOG(ERR, "Failed to modify virtq %d logging.",
  24                                 virtq->index);
  25                         return -1;
  26                 }
  27         }
  28         return 0;
  29 }
  30
  31 int
  32 mlx5_vdpa_dirty_bitmap_set(struct mlx5_vdpa_priv *priv, uint64_t log_base,
  33                            uint64_t log_size)
  34 {
  35         struct mlx5_devx_mkey_attr mkey_attr = {
  36                         .addr = (uintptr_t)log_base,
  37                         .size = log_size,
  38                         .pd = priv->pdn,
  39                         .pg_access = 1,
  40                         .klm_array = NULL,
  41                         .klm_num = 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         struct mlx5_vdpa_virtq *virtq;
  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         SLIST_FOREACH(virtq, &priv->virtq_list, next) {
  70                 attr.queue_index = virtq->index;
  71                 if (mlx5_devx_cmd_modify_virtq(virtq->virtq, &attr)) {
  72                         DRV_LOG(ERR, "Failed to modify virtq %d for lm.",
  73                                 virtq->index);
  74                         goto err;
  75                 }
  76         }
  77         mr->is_indirect = 0;
  78         SLIST_INSERT_HEAD(&priv->mr_list, mr, next);
  79         return 0;
  80 err:
  81         if (mr->mkey)
  82                 mlx5_devx_cmd_destroy(mr->mkey);
  83         if (mr->umem)
  84                 mlx5_glue->devx_umem_dereg(mr->umem);
  85         rte_free(mr);
  86         return -1;
  87 }
  88
  89 #define MLX5_VDPA_USED_RING_LEN(size) \
  90         ((size) * sizeof(struct vring_used_elem) + sizeof(uint16_t) * 3)
  91
  92 int
  93 mlx5_vdpa_lm_log(struct mlx5_vdpa_priv *priv)
  94 {
  95         struct mlx5_devx_virtq_attr attr = {0};
  96         struct mlx5_vdpa_virtq *virtq;
  97         uint64_t features;
  98         int ret = rte_vhost_get_negotiated_features(priv->vid, &features);
  99
 100         if (ret) {
 101                 DRV_LOG(ERR, "Failed to get negotiated features.");
 102                 return -1;
 103         }
 104         if (!RTE_VHOST_NEED_LOG(features))
 105                 return 0;
 106         SLIST_FOREACH(virtq, &priv->virtq_list, next) {
 107                 ret = mlx5_vdpa_virtq_modify(virtq, 0);
 108                 if (ret)
 109                         return -1;
 110                 if (mlx5_devx_cmd_query_virtq(virtq->virtq, &attr)) {
 111                         DRV_LOG(ERR, "Failed to query virtq %d.", virtq->index);
 112                         return -1;
 113                 }
 114                 DRV_LOG(INFO, "Query vid %d vring %d: hw_available_idx=%d, "
 115                         "hw_used_index=%d", priv->vid, virtq->index,
 116                         attr.hw_available_index, attr.hw_used_index);
 117                 ret = rte_vhost_set_vring_base(priv->vid, virtq->index,
 118                                                attr.hw_available_index,
 119                                                attr.hw_used_index);
 120                 if (ret) {
 121                         DRV_LOG(ERR, "Failed to set virtq %d base.",
 122                                 virtq->index);
 123                         return -1;
 124                 }
 125                 rte_vhost_log_used_vring(priv->vid, virtq->index, 0,
 126                                        MLX5_VDPA_USED_RING_LEN(virtq->vq_size));
 127         }
 128         return 0;
 129 }