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, ®_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 108