drivers/raw/ioat/idxd_vdev.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(c) 2020 Intel Corporation
   3  */
   4
   5 #include <fcntl.h>
   6 #include <unistd.h>
   7 #include <limits.h>
   8 #include <sys/mman.h>
   9
  10 #include <rte_memzone.h>
  11 #include <rte_bus_vdev.h>
  12 #include <rte_kvargs.h>
  13 #include <rte_string_fns.h>
  14 #include <rte_rawdev_pmd.h>
  15
  16 #include "ioat_private.h"
  17
  18 /** Name of the device driver */
  19 #define IDXD_PMD_RAWDEV_NAME rawdev_idxd
  20 /* takes a work queue(WQ) as parameter */
  21 #define IDXD_ARG_WQ             "wq"
  22
  23 static const char * const valid_args[] = {
  24         IDXD_ARG_WQ,
  25         NULL
  26 };
  27
  28 struct idxd_vdev_args {
  29         uint8_t device_id;
  30         uint8_t wq_id;
  31 };
  32
  33 static const struct rte_rawdev_ops idxd_vdev_ops = {
  34                 .dev_close = idxd_rawdev_close,
  35                 .dev_selftest = idxd_rawdev_test,
  36                 .dump = idxd_dev_dump,
  37 };
  38
  39 static void *
  40 idxd_vdev_mmap_wq(struct idxd_vdev_args *args)
  41 {
  42         void *addr;
  43         char path[PATH_MAX];
  44         int fd;
  45
  46         snprintf(path, sizeof(path), "/dev/dsa/wq%u.%u",
  47                         args->device_id, args->wq_id);
  48         fd = open(path, O_RDWR);
  49         if (fd < 0) {
  50                 IOAT_PMD_ERR("Failed to open device path");
  51                 return NULL;
  52         }
  53
  54         addr = mmap(NULL, 0x1000, PROT_WRITE, MAP_SHARED, fd, 0);
  55         close(fd);
  56         if (addr == MAP_FAILED) {
  57                 IOAT_PMD_ERR("Failed to mmap device");
  58                 return NULL;
  59         }
  60
  61         return addr;
  62 }
  63
  64 static int
  65 idxd_rawdev_parse_wq(const char *key __rte_unused, const char *value,
  66                           void *extra_args)
  67 {
  68         struct idxd_vdev_args *args = (struct idxd_vdev_args *)extra_args;
  69         int dev, wq, bytes = -1;
  70         int read = sscanf(value, "%d.%d%n", &dev, &wq, &bytes);
  71
  72         if (read != 2 || bytes != (int)strlen(value)) {
  73                 IOAT_PMD_ERR("Error parsing work-queue id. Must be in <dev_id>.<queue_id> format");
  74                 return -EINVAL;
  75         }
  76
  77         if (dev >= UINT8_MAX || wq >= UINT8_MAX) {
  78                 IOAT_PMD_ERR("Device or work queue id out of range");
  79                 return -EINVAL;
  80         }
  81
  82         args->device_id = dev;
  83         args->wq_id = wq;
  84
  85         return 0;
  86 }
  87
  88 static int
  89 idxd_vdev_parse_params(struct rte_kvargs *kvlist, struct idxd_vdev_args *args)
  90 {
  91         if (rte_kvargs_count(kvlist, IDXD_ARG_WQ) == 1) {
  92                 if (rte_kvargs_process(kvlist, IDXD_ARG_WQ,
  93                                 &idxd_rawdev_parse_wq, args) < 0) {
  94                         IOAT_PMD_ERR("Error parsing %s", IDXD_ARG_WQ);
  95                         goto free;
  96                 }
  97         } else {
  98                 IOAT_PMD_ERR("%s is a mandatory arg", IDXD_ARG_WQ);
  99                 return -EINVAL;
 100         }
 101
 102         return 0;
 103
 104 free:
 105         if (kvlist)
 106                 rte_kvargs_free(kvlist);
 107         return -EINVAL;
 108 }
 109
 110 static int
 111 idxd_vdev_get_max_batches(struct idxd_vdev_args *args)
 112 {
 113         char sysfs_path[PATH_MAX];
 114         FILE *f;
 115         int ret;
 116
 117         snprintf(sysfs_path, sizeof(sysfs_path),
 118                         "/sys/bus/dsa/devices/wq%u.%u/size",
 119                         args->device_id, args->wq_id);
 120         f = fopen(sysfs_path, "r");
 121         if (f == NULL)
 122                 return -1;
 123
 124         if (fscanf(f, "%d", &ret) != 1)
 125                 ret = -1;
 126
 127         fclose(f);
 128         return ret;
 129 }
 130
 131 static int
 132 idxd_rawdev_probe_vdev(struct rte_vdev_device *vdev)
 133 {
 134         struct rte_kvargs *kvlist;
 135         struct idxd_rawdev idxd = {{0}}; /* double {} to avoid error on BSD12 */
 136         struct idxd_vdev_args vdev_args;
 137         const char *name;
 138         int ret = 0;
 139
 140         name = rte_vdev_device_name(vdev);
 141         if (name == NULL)
 142                 return -EINVAL;
 143
 144         IOAT_PMD_INFO("Initializing pmd_idxd for %s", name);
 145
 146         kvlist = rte_kvargs_parse(rte_vdev_device_args(vdev), valid_args);
 147         if (kvlist == NULL) {
 148                 IOAT_PMD_ERR("Invalid kvargs key");
 149                 return -EINVAL;
 150         }
 151
 152         ret = idxd_vdev_parse_params(kvlist, &vdev_args);
 153         if (ret) {
 154                 IOAT_PMD_ERR("Failed to parse kvargs");
 155                 return -EINVAL;
 156         }
 157
 158         idxd.qid = vdev_args.wq_id;
 159         idxd.u.vdev.dsa_id = vdev_args.device_id;
 160         idxd.max_batches = idxd_vdev_get_max_batches(&vdev_args);
 161
 162         idxd.public.portal = idxd_vdev_mmap_wq(&vdev_args);
 163         if (idxd.public.portal == NULL) {
 164                 IOAT_PMD_ERR("WQ mmap failed");
 165                 return -ENOENT;
 166         }
 167
 168         ret = idxd_rawdev_create(name, &vdev->device, &idxd, &idxd_vdev_ops);
 169         if (ret) {
 170                 IOAT_PMD_ERR("Failed to create rawdev %s", name);
 171                 return ret;
 172         }
 173
 174         return 0;
 175 }
 176
 177 static int
 178 idxd_rawdev_remove_vdev(struct rte_vdev_device *vdev)
 179 {
 180         struct idxd_rawdev *idxd;
 181         const char *name;
 182         struct rte_rawdev *rdev;
 183         int ret = 0;
 184
 185         name = rte_vdev_device_name(vdev);
 186         if (name == NULL)
 187                 return -EINVAL;
 188
 189         IOAT_PMD_INFO("Remove DSA vdev %p", name);
 190
 191         rdev = rte_rawdev_pmd_get_named_dev(name);
 192         if (!rdev) {
 193                 IOAT_PMD_ERR("Invalid device name (%s)", name);
 194                 return -EINVAL;
 195         }
 196
 197         idxd = rdev->dev_private;
 198
 199         /* free context and memory */
 200         if (rdev->dev_private != NULL) {
 201                 IOAT_PMD_DEBUG("Freeing device driver memory");
 202                 rdev->dev_private = NULL;
 203
 204                 if (munmap(idxd->public.portal, 0x1000) < 0) {
 205                         IOAT_PMD_ERR("Error unmapping portal");
 206                         ret = -errno;
 207                 }
 208
 209                 rte_free(idxd->public.batch_ring);
 210                 rte_free(idxd->public.hdl_ring);
 211
 212                 rte_memzone_free(idxd->mz);
 213         }
 214
 215         if (rte_rawdev_pmd_release(rdev))
 216                 IOAT_PMD_ERR("Device cleanup failed");
 217
 218         return ret;
 219 }
 220
 221 struct rte_vdev_driver idxd_rawdev_drv_vdev = {
 222         .probe = idxd_rawdev_probe_vdev,
 223         .remove = idxd_rawdev_remove_vdev,
 224 };
 225
 226 RTE_PMD_REGISTER_VDEV(IDXD_PMD_RAWDEV_NAME, idxd_rawdev_drv_vdev);
 227 RTE_PMD_REGISTER_PARAM_STRING(IDXD_PMD_RAWDEV_NAME,
 228                               "wq=<string>");