drivers/crypto/bcmfs/bcmfs_vfio.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(C) 2020 Broadcom.
   3  * All rights reserved.
   4  */
   5
   6 #include <errno.h>
   7 #include <sys/mman.h>
   8 #include <sys/ioctl.h>
   9
  10 #include <rte_vfio.h>
  11
  12 #include "bcmfs_device.h"
  13 #include "bcmfs_logs.h"
  14 #include "bcmfs_vfio.h"
  15
  16 #ifdef VFIO_PRESENT
  17 static int
  18 vfio_map_dev_obj(const char *path, const char *dev_obj,
  19                  uint32_t *size, void **addr, int *dev_fd)
  20 {
  21         int32_t ret;
  22         struct vfio_group_status status = { .argsz = sizeof(status) };
  23
  24         struct vfio_device_info d_info = { .argsz = sizeof(d_info) };
  25         struct vfio_region_info reg_info = { .argsz = sizeof(reg_info) };
  26
  27         ret = rte_vfio_setup_device(path, dev_obj, dev_fd, &d_info);
  28         if (ret) {
  29                 BCMFS_LOG(ERR, "VFIO Setting for device failed");
  30                 return ret;
  31         }
  32
  33         /* getting device region info*/
  34         ret = ioctl(*dev_fd, VFIO_DEVICE_GET_REGION_INFO, &reg_info);
  35         if (ret < 0) {
  36                 BCMFS_LOG(ERR, "Error in VFIO getting REGION_INFO");
  37                 goto map_failed;
  38         }
  39
  40         *addr = mmap(NULL, reg_info.size,
  41                      PROT_WRITE | PROT_READ, MAP_SHARED,
  42                      *dev_fd, reg_info.offset);
  43         if (*addr == MAP_FAILED) {
  44                 BCMFS_LOG(ERR, "Error mapping region (errno = %d)", errno);
  45                 ret = errno;
  46                 goto map_failed;
  47         }
  48         *size = reg_info.size;
  49
  50         return 0;
  51
  52 map_failed:
  53         rte_vfio_release_device(path, dev_obj, *dev_fd);
  54
  55         return ret;
  56 }
  57
  58 int
  59 bcmfs_attach_vfio(struct bcmfs_device *dev)
  60 {
  61         int ret;
  62         int vfio_dev_fd;
  63         void  *v_addr = NULL;
  64         uint32_t size = 0;
  65
  66         ret = vfio_map_dev_obj(dev->dirname, dev->name,
  67                                &size, &v_addr, &vfio_dev_fd);
  68         if (ret)
  69                 return -1;
  70
  71         dev->mmap_size = size;
  72         dev->mmap_addr = v_addr;
  73         dev->vfio_dev_fd = vfio_dev_fd;
  74
  75         return 0;
  76 }
  77
  78 void
  79 bcmfs_release_vfio(struct bcmfs_device *dev)
  80 {
  81         int ret;
  82
  83         if (dev == NULL)
  84                 return;
  85
  86         /* unmap the addr */
  87         munmap(dev->mmap_addr, dev->mmap_size);
  88         /* release the device */
  89         ret = rte_vfio_release_device(dev->dirname, dev->name,
  90                                       dev->vfio_dev_fd);
  91         if (ret < 0) {
  92                 BCMFS_LOG(ERR, "cannot release device");
  93                 return;
  94         }
  95 }
  96 #else
  97 int
  98 bcmfs_attach_vfio(struct bcmfs_device *dev __rte_unused)
  99 {
 100         return -1;
 101 }
 102
 103 void
 104 bcmfs_release_vfio(struct bcmfs_device *dev __rte_unused)
 105 {
 106 }
 107 #endif