1 /* SPDX-License-Identifier: BSD-3-Clause 2 * Copyright(c) 2019 Intel Corporation 3 */ 4 5 #include <rte_cycles.h> 6 #include <rte_bus_pci.h> 7 #include <rte_memzone.h> 8 #include <rte_string_fns.h> 9 #include <rte_rawdev_pmd.h> 10 11 #include "rte_ioat_rawdev.h" 12 #include "ioat_spec.h" 13 #include "ioat_private.h" 14 15 static struct rte_pci_driver ioat_pmd_drv; 16 17 #define IOAT_VENDOR_ID 0x8086 18 #define IOAT_DEVICE_ID_SKX 0x2021 19 #define IOAT_DEVICE_ID_BDX0 0x6f20 20 #define IOAT_DEVICE_ID_BDX1 0x6f21 21 #define IOAT_DEVICE_ID_BDX2 0x6f22 22 #define IOAT_DEVICE_ID_BDX3 0x6f23 23 #define IOAT_DEVICE_ID_BDX4 0x6f24 24 #define IOAT_DEVICE_ID_BDX5 0x6f25 25 #define IOAT_DEVICE_ID_BDX6 0x6f26 26 #define IOAT_DEVICE_ID_BDX7 0x6f27 27 #define IOAT_DEVICE_ID_BDXE 0x6f2E 28 #define IOAT_DEVICE_ID_BDXF 0x6f2F 29 #define IOAT_DEVICE_ID_ICX 0x0b00 30 31 RTE_LOG_REGISTER(ioat_pmd_logtype, rawdev.ioat, INFO); 32 33 #define DESC_SZ sizeof(struct rte_ioat_generic_hw_desc) 34 #define COMPLETION_SZ sizeof(__m128i) 35 36 static int 37 ioat_dev_configure(const struct rte_rawdev *dev, rte_rawdev_obj_t config, 38 size_t config_size) 39 { 40 struct rte_ioat_rawdev_config *params = config; 41 struct rte_ioat_rawdev *ioat = dev->dev_private; 42 char mz_name[RTE_MEMZONE_NAMESIZE]; 43 unsigned short i; 44 45 if (dev->started) 46 return -EBUSY; 47 48 if (params == NULL || config_size != sizeof(*params)) 49 return -EINVAL; 50 51 if (params->ring_size > 4096 || params->ring_size < 64 || 52 !rte_is_power_of_2(params->ring_size)) 53 return -EINVAL; 54 55 ioat->ring_size = params->ring_size; 56 ioat->hdls_disable = params->hdls_disable; 57 if (ioat->desc_ring != NULL) { 58 rte_memzone_free(ioat->desc_mz); 59 ioat->desc_ring = NULL; 60 ioat->desc_mz = NULL; 61 } 62 63 /* allocate one block of memory for both descriptors 64 * and completion handles. 65 */ 66 snprintf(mz_name, sizeof(mz_name), "rawdev%u_desc_ring", dev->dev_id); 67 ioat->desc_mz = rte_memzone_reserve(mz_name, 68 (DESC_SZ + COMPLETION_SZ) * ioat->ring_size, 69 dev->device->numa_node, RTE_MEMZONE_IOVA_CONTIG); 70 if (ioat->desc_mz == NULL) 71 return -ENOMEM; 72 ioat->desc_ring = ioat->desc_mz->addr; 73 ioat->hdls = (void *)&ioat->desc_ring[ioat->ring_size]; 74 75 ioat->ring_addr = ioat->desc_mz->iova; 76 77 /* configure descriptor ring - each one points to next */ 78 for (i = 0; i < ioat->ring_size; i++) { 79 ioat->desc_ring[i].next = ioat->ring_addr + 80 (((i + 1) % ioat->ring_size) * DESC_SZ); 81 } 82 83 return 0; 84 } 85 86 static int 87 ioat_dev_start(struct rte_rawdev *dev) 88 { 89 struct rte_ioat_rawdev *ioat = dev->dev_private; 90 91 if (ioat->ring_size == 0 || ioat->desc_ring == NULL) 92 return -EBUSY; 93 94 /* inform hardware of where the descriptor ring is */ 95 ioat->regs->chainaddr = ioat->ring_addr; 96 /* inform hardware of where to write the status/completions */ 97 ioat->regs->chancmp = ioat->status_addr; 98 99 /* prime the status register to be set to the last element */ 100 ioat->status = ioat->ring_addr + ((ioat->ring_size - 1) * DESC_SZ); 101 return 0; 102 } 103 104 static void 105 ioat_dev_stop(struct rte_rawdev *dev) 106 { 107 RTE_SET_USED(dev); 108 } 109 110 static int 111 ioat_dev_info_get(struct rte_rawdev *dev, rte_rawdev_obj_t dev_info, 112 size_t dev_info_size) 113 { 114 struct rte_ioat_rawdev_config *cfg = dev_info; 115 struct rte_ioat_rawdev *ioat = dev->dev_private; 116 117 if (dev_info == NULL || dev_info_size != sizeof(*cfg)) 118 return -EINVAL; 119 120 cfg->ring_size = ioat->ring_size; 121 cfg->hdls_disable = ioat->hdls_disable; 122 return 0; 123 } 124 125 static int 126 ioat_dev_close(struct rte_rawdev *dev __rte_unused) 127 { 128 return 0; 129 } 130 131 static int 132 ioat_rawdev_create(const char *name, struct rte_pci_device *dev) 133 { 134 static const struct rte_rawdev_ops ioat_rawdev_ops = { 135 .dev_configure = ioat_dev_configure, 136 .dev_start = ioat_dev_start, 137 .dev_stop = ioat_dev_stop, 138 .dev_close = ioat_dev_close, 139 .dev_info_get = ioat_dev_info_get, 140 .xstats_get = ioat_xstats_get, 141 .xstats_get_names = ioat_xstats_get_names, 142 .xstats_reset = ioat_xstats_reset, 143 .dev_selftest = ioat_rawdev_test, 144 }; 145 146 struct rte_rawdev *rawdev = NULL; 147 struct rte_ioat_rawdev *ioat = NULL; 148 const struct rte_memzone *mz = NULL; 149 char mz_name[RTE_MEMZONE_NAMESIZE]; 150 int ret = 0; 151 int retry = 0; 152 153 if (!name) { 154 IOAT_PMD_ERR("Invalid name of the device!"); 155 ret = -EINVAL; 156 goto cleanup; 157 } 158 159 /* Allocate device structure */ 160 rawdev = rte_rawdev_pmd_allocate(name, sizeof(struct rte_ioat_rawdev), 161 dev->device.numa_node); 162 if (rawdev == NULL) { 163 IOAT_PMD_ERR("Unable to allocate raw device"); 164 ret = -ENOMEM; 165 goto cleanup; 166 } 167 168 /* Allocate memory for the primary process or else return the memory 169 * of primary memzone for the secondary process. 170 */ 171 snprintf(mz_name, sizeof(mz_name), "rawdev%u_private", rawdev->dev_id); 172 if (rte_eal_process_type() == RTE_PROC_SECONDARY) { 173 mz = rte_memzone_lookup(mz_name); 174 if (mz == NULL) { 175 IOAT_PMD_ERR("Unable lookup memzone for private data\n"); 176 ret = -ENOMEM; 177 goto cleanup; 178 } 179 rawdev->dev_private = mz->addr; 180 rawdev->dev_ops = &ioat_rawdev_ops; 181 rawdev->device = &dev->device; 182 return 0; 183 } 184 mz = rte_memzone_reserve(mz_name, sizeof(struct rte_ioat_rawdev), 185 dev->device.numa_node, RTE_MEMZONE_IOVA_CONTIG); 186 if (mz == NULL) { 187 IOAT_PMD_ERR("Unable to reserve memzone for private data\n"); 188 ret = -ENOMEM; 189 goto cleanup; 190 } 191 192 rawdev->dev_private = mz->addr; 193 rawdev->dev_ops = &ioat_rawdev_ops; 194 rawdev->device = &dev->device; 195 rawdev->driver_name = dev->device.driver->name; 196 197 ioat = rawdev->dev_private; 198 ioat->type = RTE_IOAT_DEV; 199 ioat->rawdev = rawdev; 200 ioat->mz = mz; 201 ioat->regs = dev->mem_resource[0].addr; 202 ioat->doorbell = &ioat->regs->dmacount; 203 ioat->ring_size = 0; 204 ioat->desc_ring = NULL; 205 ioat->status_addr = ioat->mz->iova + 206 offsetof(struct rte_ioat_rawdev, status); 207 208 /* do device initialization - reset and set error behaviour */ 209 if (ioat->regs->chancnt != 1) 210 IOAT_PMD_ERR("%s: Channel count == %d\n", __func__, 211 ioat->regs->chancnt); 212 213 if (ioat->regs->chanctrl & 0x100) { /* locked by someone else */ 214 IOAT_PMD_WARN("%s: Channel appears locked\n", __func__); 215 ioat->regs->chanctrl = 0; 216 } 217 218 ioat->regs->chancmd = RTE_IOAT_CHANCMD_SUSPEND; 219 rte_delay_ms(1); 220 ioat->regs->chancmd = RTE_IOAT_CHANCMD_RESET; 221 rte_delay_ms(1); 222 while (ioat->regs->chancmd & RTE_IOAT_CHANCMD_RESET) { 223 ioat->regs->chainaddr = 0; 224 rte_delay_ms(1); 225 if (++retry >= 200) { 226 IOAT_PMD_ERR("%s: cannot reset device. CHANCMD=0x%"PRIx8", CHANSTS=0x%"PRIx64", CHANERR=0x%"PRIx32"\n", 227 __func__, 228 ioat->regs->chancmd, 229 ioat->regs->chansts, 230 ioat->regs->chanerr); 231 ret = -EIO; 232 } 233 } 234 ioat->regs->chanctrl = RTE_IOAT_CHANCTRL_ANY_ERR_ABORT_EN | 235 RTE_IOAT_CHANCTRL_ERR_COMPLETION_EN; 236 237 return 0; 238 239 cleanup: 240 if (rawdev) 241 rte_rawdev_pmd_release(rawdev); 242 243 return ret; 244 } 245 246 static int 247 ioat_rawdev_destroy(const char *name) 248 { 249 int ret; 250 struct rte_rawdev *rdev; 251 252 if (!name) { 253 IOAT_PMD_ERR("Invalid device name"); 254 return -EINVAL; 255 } 256 257 rdev = rte_rawdev_pmd_get_named_dev(name); 258 if (!rdev) { 259 IOAT_PMD_ERR("Invalid device name (%s)", name); 260 return -EINVAL; 261 } 262 263 if (rdev->dev_private != NULL) { 264 struct rte_ioat_rawdev *ioat = rdev->dev_private; 265 rdev->dev_private = NULL; 266 rte_memzone_free(ioat->desc_mz); 267 rte_memzone_free(ioat->mz); 268 } 269 270 /* rte_rawdev_close is called by pmd_release */ 271 ret = rte_rawdev_pmd_release(rdev); 272 if (ret) 273 IOAT_PMD_DEBUG("Device cleanup failed"); 274 275 return 0; 276 } 277 278 static int 279 ioat_rawdev_probe(struct rte_pci_driver *drv, struct rte_pci_device *dev) 280 { 281 char name[32]; 282 int ret = 0; 283 284 285 rte_pci_device_name(&dev->addr, name, sizeof(name)); 286 IOAT_PMD_INFO("Init %s on NUMA node %d", name, dev->device.numa_node); 287 288 dev->device.driver = &drv->driver; 289 ret = ioat_rawdev_create(name, dev); 290 return ret; 291 } 292 293 static int 294 ioat_rawdev_remove(struct rte_pci_device *dev) 295 { 296 char name[32]; 297 int ret; 298 299 rte_pci_device_name(&dev->addr, name, sizeof(name)); 300 301 IOAT_PMD_INFO("Closing %s on NUMA node %d", 302 name, dev->device.numa_node); 303 304 ret = ioat_rawdev_destroy(name); 305 return ret; 306 } 307 308 static const struct rte_pci_id pci_id_ioat_map[] = { 309 { RTE_PCI_DEVICE(IOAT_VENDOR_ID, IOAT_DEVICE_ID_SKX) }, 310 { RTE_PCI_DEVICE(IOAT_VENDOR_ID, IOAT_DEVICE_ID_BDX0) }, 311 { RTE_PCI_DEVICE(IOAT_VENDOR_ID, IOAT_DEVICE_ID_BDX1) }, 312 { RTE_PCI_DEVICE(IOAT_VENDOR_ID, IOAT_DEVICE_ID_BDX2) }, 313 { RTE_PCI_DEVICE(IOAT_VENDOR_ID, IOAT_DEVICE_ID_BDX3) }, 314 { RTE_PCI_DEVICE(IOAT_VENDOR_ID, IOAT_DEVICE_ID_BDX4) }, 315 { RTE_PCI_DEVICE(IOAT_VENDOR_ID, IOAT_DEVICE_ID_BDX5) }, 316 { RTE_PCI_DEVICE(IOAT_VENDOR_ID, IOAT_DEVICE_ID_BDX6) }, 317 { RTE_PCI_DEVICE(IOAT_VENDOR_ID, IOAT_DEVICE_ID_BDX7) }, 318 { RTE_PCI_DEVICE(IOAT_VENDOR_ID, IOAT_DEVICE_ID_BDXE) }, 319 { RTE_PCI_DEVICE(IOAT_VENDOR_ID, IOAT_DEVICE_ID_BDXF) }, 320 { RTE_PCI_DEVICE(IOAT_VENDOR_ID, IOAT_DEVICE_ID_ICX) }, 321 { .vendor_id = 0, /* sentinel */ }, 322 }; 323 324 static struct rte_pci_driver ioat_pmd_drv = { 325 .id_table = pci_id_ioat_map, 326 .drv_flags = RTE_PCI_DRV_NEED_MAPPING | RTE_PCI_DRV_INTR_LSC, 327 .probe = ioat_rawdev_probe, 328 .remove = ioat_rawdev_remove, 329 }; 330 331 RTE_PMD_REGISTER_PCI(IOAT_PMD_RAWDEV_NAME, ioat_pmd_drv); 332 RTE_PMD_REGISTER_PCI_TABLE(IOAT_PMD_RAWDEV_NAME, pci_id_ioat_map); 333 RTE_PMD_REGISTER_KMOD_DEP(IOAT_PMD_RAWDEV_NAME, "* igb_uio | uio_pci_generic"); 334