1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * Intel IFC VF NIC driver for virtio dataplane offloading 4 * 5 * Copyright (C) 2020 Intel Corporation. 6 * 7 * Author: Zhu Lingshan <lingshan.zhu@intel.com> 8 * 9 */ 10 11 #include <linux/interrupt.h> 12 #include <linux/module.h> 13 #include <linux/pci.h> 14 #include <linux/sysfs.h> 15 #include "ifcvf_base.h" 16 17 #define DRIVER_AUTHOR "Intel Corporation" 18 #define IFCVF_DRIVER_NAME "ifcvf" 19 20 static irqreturn_t ifcvf_config_changed(int irq, void *arg) 21 { 22 struct ifcvf_hw *vf = arg; 23 24 if (vf->config_cb.callback) 25 return vf->config_cb.callback(vf->config_cb.private); 26 27 return IRQ_HANDLED; 28 } 29 30 static irqreturn_t ifcvf_vq_intr_handler(int irq, void *arg) 31 { 32 struct vring_info *vring = arg; 33 34 if (vring->cb.callback) 35 return vring->cb.callback(vring->cb.private); 36 37 return IRQ_HANDLED; 38 } 39 40 static irqreturn_t ifcvf_vqs_reused_intr_handler(int irq, void *arg) 41 { 42 struct ifcvf_hw *vf = arg; 43 struct vring_info *vring; 44 int i; 45 46 for (i = 0; i < vf->nr_vring; i++) { 47 vring = &vf->vring[i]; 48 if (vring->cb.callback) 49 vring->cb.callback(vring->cb.private); 50 } 51 52 return IRQ_HANDLED; 53 } 54 55 static irqreturn_t ifcvf_dev_intr_handler(int irq, void *arg) 56 { 57 struct ifcvf_hw *vf = arg; 58 u8 isr; 59 60 isr = vp_ioread8(vf->isr); 61 if (isr & VIRTIO_PCI_ISR_CONFIG) 62 ifcvf_config_changed(irq, arg); 63 64 return ifcvf_vqs_reused_intr_handler(irq, arg); 65 } 66 67 static void ifcvf_free_irq_vectors(void *data) 68 { 69 pci_free_irq_vectors(data); 70 } 71 72 static void ifcvf_free_per_vq_irq(struct ifcvf_hw *vf) 73 { 74 struct pci_dev *pdev = vf->pdev; 75 int i; 76 77 for (i = 0; i < vf->nr_vring; i++) { 78 if (vf->vring[i].irq != -EINVAL) { 79 devm_free_irq(&pdev->dev, vf->vring[i].irq, &vf->vring[i]); 80 vf->vring[i].irq = -EINVAL; 81 } 82 } 83 } 84 85 static void ifcvf_free_vqs_reused_irq(struct ifcvf_hw *vf) 86 { 87 struct pci_dev *pdev = vf->pdev; 88 89 if (vf->vqs_reused_irq != -EINVAL) { 90 devm_free_irq(&pdev->dev, vf->vqs_reused_irq, vf); 91 vf->vqs_reused_irq = -EINVAL; 92 } 93 94 } 95 96 static void ifcvf_free_vq_irq(struct ifcvf_hw *vf) 97 { 98 if (vf->msix_vector_status == MSIX_VECTOR_PER_VQ_AND_CONFIG) 99 ifcvf_free_per_vq_irq(vf); 100 else 101 ifcvf_free_vqs_reused_irq(vf); 102 } 103 104 static void ifcvf_free_config_irq(struct ifcvf_hw *vf) 105 { 106 struct pci_dev *pdev = vf->pdev; 107 108 if (vf->config_irq == -EINVAL) 109 return; 110 111 /* If the irq is shared by all vqs and the config interrupt, 112 * it is already freed in ifcvf_free_vq_irq, so here only 113 * need to free config irq when msix_vector_status != MSIX_VECTOR_DEV_SHARED 114 */ 115 if (vf->msix_vector_status != MSIX_VECTOR_DEV_SHARED) { 116 devm_free_irq(&pdev->dev, vf->config_irq, vf); 117 vf->config_irq = -EINVAL; 118 } 119 } 120 121 static void ifcvf_free_irq(struct ifcvf_hw *vf) 122 { 123 struct pci_dev *pdev = vf->pdev; 124 125 ifcvf_free_vq_irq(vf); 126 ifcvf_free_config_irq(vf); 127 ifcvf_free_irq_vectors(pdev); 128 vf->num_msix_vectors = 0; 129 } 130 131 /* ifcvf MSIX vectors allocator, this helper tries to allocate 132 * vectors for all virtqueues and the config interrupt. 133 * It returns the number of allocated vectors, negative 134 * return value when fails. 135 */ 136 static int ifcvf_alloc_vectors(struct ifcvf_hw *vf) 137 { 138 struct pci_dev *pdev = vf->pdev; 139 int max_intr, ret; 140 141 /* all queues and config interrupt */ 142 max_intr = vf->nr_vring + 1; 143 ret = pci_alloc_irq_vectors(pdev, 1, max_intr, PCI_IRQ_MSIX | PCI_IRQ_AFFINITY); 144 145 if (ret < 0) { 146 IFCVF_ERR(pdev, "Failed to alloc IRQ vectors\n"); 147 return ret; 148 } 149 150 if (ret < max_intr) 151 IFCVF_INFO(pdev, 152 "Requested %u vectors, however only %u allocated, lower performance\n", 153 max_intr, ret); 154 155 return ret; 156 } 157 158 static int ifcvf_request_per_vq_irq(struct ifcvf_hw *vf) 159 { 160 struct pci_dev *pdev = vf->pdev; 161 int i, vector, ret, irq; 162 163 vf->vqs_reused_irq = -EINVAL; 164 for (i = 0; i < vf->nr_vring; i++) { 165 snprintf(vf->vring[i].msix_name, 256, "ifcvf[%s]-%d\n", pci_name(pdev), i); 166 vector = i; 167 irq = pci_irq_vector(pdev, vector); 168 ret = devm_request_irq(&pdev->dev, irq, 169 ifcvf_vq_intr_handler, 0, 170 vf->vring[i].msix_name, 171 &vf->vring[i]); 172 if (ret) { 173 IFCVF_ERR(pdev, "Failed to request irq for vq %d\n", i); 174 goto err; 175 } 176 177 vf->vring[i].irq = irq; 178 ret = ifcvf_set_vq_vector(vf, i, vector); 179 if (ret == VIRTIO_MSI_NO_VECTOR) { 180 IFCVF_ERR(pdev, "No msix vector for vq %u\n", i); 181 goto err; 182 } 183 } 184 185 return 0; 186 err: 187 ifcvf_free_irq(vf); 188 189 return -EFAULT; 190 } 191 192 static int ifcvf_request_vqs_reused_irq(struct ifcvf_hw *vf) 193 { 194 struct pci_dev *pdev = vf->pdev; 195 int i, vector, ret, irq; 196 197 vector = 0; 198 snprintf(vf->vring[0].msix_name, 256, "ifcvf[%s]-vqs-reused-irq\n", pci_name(pdev)); 199 irq = pci_irq_vector(pdev, vector); 200 ret = devm_request_irq(&pdev->dev, irq, 201 ifcvf_vqs_reused_intr_handler, 0, 202 vf->vring[0].msix_name, vf); 203 if (ret) { 204 IFCVF_ERR(pdev, "Failed to request reused irq for the device\n"); 205 goto err; 206 } 207 208 vf->vqs_reused_irq = irq; 209 for (i = 0; i < vf->nr_vring; i++) { 210 vf->vring[i].irq = -EINVAL; 211 ret = ifcvf_set_vq_vector(vf, i, vector); 212 if (ret == VIRTIO_MSI_NO_VECTOR) { 213 IFCVF_ERR(pdev, "No msix vector for vq %u\n", i); 214 goto err; 215 } 216 } 217 218 return 0; 219 err: 220 ifcvf_free_irq(vf); 221 222 return -EFAULT; 223 } 224 225 static int ifcvf_request_dev_irq(struct ifcvf_hw *vf) 226 { 227 struct pci_dev *pdev = vf->pdev; 228 int i, vector, ret, irq; 229 230 vector = 0; 231 snprintf(vf->vring[0].msix_name, 256, "ifcvf[%s]-dev-irq\n", pci_name(pdev)); 232 irq = pci_irq_vector(pdev, vector); 233 ret = devm_request_irq(&pdev->dev, irq, 234 ifcvf_dev_intr_handler, 0, 235 vf->vring[0].msix_name, vf); 236 if (ret) { 237 IFCVF_ERR(pdev, "Failed to request irq for the device\n"); 238 goto err; 239 } 240 241 vf->vqs_reused_irq = irq; 242 for (i = 0; i < vf->nr_vring; i++) { 243 vf->vring[i].irq = -EINVAL; 244 ret = ifcvf_set_vq_vector(vf, i, vector); 245 if (ret == VIRTIO_MSI_NO_VECTOR) { 246 IFCVF_ERR(pdev, "No msix vector for vq %u\n", i); 247 goto err; 248 } 249 } 250 251 vf->config_irq = irq; 252 ret = ifcvf_set_config_vector(vf, vector); 253 if (ret == VIRTIO_MSI_NO_VECTOR) { 254 IFCVF_ERR(pdev, "No msix vector for device config\n"); 255 goto err; 256 } 257 258 return 0; 259 err: 260 ifcvf_free_irq(vf); 261 262 return -EFAULT; 263 264 } 265 266 static int ifcvf_request_vq_irq(struct ifcvf_hw *vf) 267 { 268 int ret; 269 270 if (vf->msix_vector_status == MSIX_VECTOR_PER_VQ_AND_CONFIG) 271 ret = ifcvf_request_per_vq_irq(vf); 272 else 273 ret = ifcvf_request_vqs_reused_irq(vf); 274 275 return ret; 276 } 277 278 static int ifcvf_request_config_irq(struct ifcvf_hw *vf) 279 { 280 struct pci_dev *pdev = vf->pdev; 281 int config_vector, ret; 282 283 if (vf->msix_vector_status == MSIX_VECTOR_PER_VQ_AND_CONFIG) 284 config_vector = vf->nr_vring; 285 else if (vf->msix_vector_status == MSIX_VECTOR_SHARED_VQ_AND_CONFIG) 286 /* vector 0 for vqs and 1 for config interrupt */ 287 config_vector = 1; 288 else if (vf->msix_vector_status == MSIX_VECTOR_DEV_SHARED) 289 /* re-use the vqs vector */ 290 return 0; 291 else 292 return -EINVAL; 293 294 snprintf(vf->config_msix_name, 256, "ifcvf[%s]-config\n", 295 pci_name(pdev)); 296 vf->config_irq = pci_irq_vector(pdev, config_vector); 297 ret = devm_request_irq(&pdev->dev, vf->config_irq, 298 ifcvf_config_changed, 0, 299 vf->config_msix_name, vf); 300 if (ret) { 301 IFCVF_ERR(pdev, "Failed to request config irq\n"); 302 goto err; 303 } 304 305 ret = ifcvf_set_config_vector(vf, config_vector); 306 if (ret == VIRTIO_MSI_NO_VECTOR) { 307 IFCVF_ERR(pdev, "No msix vector for device config\n"); 308 goto err; 309 } 310 311 return 0; 312 err: 313 ifcvf_free_irq(vf); 314 315 return -EFAULT; 316 } 317 318 static int ifcvf_request_irq(struct ifcvf_hw *vf) 319 { 320 int nvectors, ret, max_intr; 321 322 nvectors = ifcvf_alloc_vectors(vf); 323 if (nvectors <= 0) 324 return -EFAULT; 325 326 vf->msix_vector_status = MSIX_VECTOR_PER_VQ_AND_CONFIG; 327 max_intr = vf->nr_vring + 1; 328 if (nvectors < max_intr) 329 vf->msix_vector_status = MSIX_VECTOR_SHARED_VQ_AND_CONFIG; 330 331 if (nvectors == 1) { 332 vf->msix_vector_status = MSIX_VECTOR_DEV_SHARED; 333 ret = ifcvf_request_dev_irq(vf); 334 335 return ret; 336 } 337 338 ret = ifcvf_request_vq_irq(vf); 339 if (ret) 340 return ret; 341 342 ret = ifcvf_request_config_irq(vf); 343 344 if (ret) 345 return ret; 346 347 vf->num_msix_vectors = nvectors; 348 349 return 0; 350 } 351 352 static struct ifcvf_adapter *vdpa_to_adapter(struct vdpa_device *vdpa_dev) 353 { 354 return container_of(vdpa_dev, struct ifcvf_adapter, vdpa); 355 } 356 357 static struct ifcvf_hw *vdpa_to_vf(struct vdpa_device *vdpa_dev) 358 { 359 struct ifcvf_adapter *adapter = vdpa_to_adapter(vdpa_dev); 360 361 return adapter->vf; 362 } 363 364 static u64 ifcvf_vdpa_get_device_features(struct vdpa_device *vdpa_dev) 365 { 366 struct ifcvf_adapter *adapter = vdpa_to_adapter(vdpa_dev); 367 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 368 struct pci_dev *pdev = adapter->pdev; 369 u32 type = vf->dev_type; 370 u64 features; 371 372 if (type == VIRTIO_ID_NET || type == VIRTIO_ID_BLOCK) 373 features = ifcvf_get_dev_features(vf); 374 else { 375 features = 0; 376 IFCVF_ERR(pdev, "VIRTIO ID %u not supported\n", vf->dev_type); 377 } 378 379 return features; 380 } 381 382 static int ifcvf_vdpa_set_driver_features(struct vdpa_device *vdpa_dev, u64 features) 383 { 384 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 385 int ret; 386 387 ret = ifcvf_verify_min_features(vf, features); 388 if (ret) 389 return ret; 390 391 ifcvf_set_driver_features(vf, features); 392 393 return 0; 394 } 395 396 static u64 ifcvf_vdpa_get_driver_features(struct vdpa_device *vdpa_dev) 397 { 398 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 399 u64 features; 400 401 features = ifcvf_get_driver_features(vf); 402 403 return features; 404 } 405 406 static u8 ifcvf_vdpa_get_status(struct vdpa_device *vdpa_dev) 407 { 408 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 409 410 return ifcvf_get_status(vf); 411 } 412 413 static void ifcvf_vdpa_set_status(struct vdpa_device *vdpa_dev, u8 status) 414 { 415 struct ifcvf_hw *vf; 416 u8 status_old; 417 int ret; 418 419 vf = vdpa_to_vf(vdpa_dev); 420 status_old = ifcvf_get_status(vf); 421 422 if (status_old == status) 423 return; 424 425 if ((status & VIRTIO_CONFIG_S_DRIVER_OK) && 426 !(status_old & VIRTIO_CONFIG_S_DRIVER_OK)) { 427 ret = ifcvf_request_irq(vf); 428 if (ret) { 429 IFCVF_ERR(vf->pdev, "failed to request irq with error %d\n", ret); 430 return; 431 } 432 } 433 434 ifcvf_set_status(vf, status); 435 } 436 437 static int ifcvf_vdpa_reset(struct vdpa_device *vdpa_dev) 438 { 439 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 440 u8 status = ifcvf_get_status(vf); 441 442 ifcvf_stop(vf); 443 444 if (status & VIRTIO_CONFIG_S_DRIVER_OK) 445 ifcvf_free_irq(vf); 446 447 ifcvf_reset(vf); 448 449 return 0; 450 } 451 452 static u16 ifcvf_vdpa_get_vq_num_max(struct vdpa_device *vdpa_dev) 453 { 454 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 455 456 return ifcvf_get_max_vq_size(vf); 457 } 458 459 static u16 ifcvf_vdpa_get_vq_num_min(struct vdpa_device *vdpa_dev) 460 { 461 return IFCVF_MIN_VQ_SIZE; 462 } 463 464 static int ifcvf_vdpa_get_vq_state(struct vdpa_device *vdpa_dev, u16 qid, 465 struct vdpa_vq_state *state) 466 { 467 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 468 469 state->split.avail_index = ifcvf_get_vq_state(vf, qid); 470 return 0; 471 } 472 473 static int ifcvf_vdpa_set_vq_state(struct vdpa_device *vdpa_dev, u16 qid, 474 const struct vdpa_vq_state *state) 475 { 476 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 477 478 return ifcvf_set_vq_state(vf, qid, state->split.avail_index); 479 } 480 481 static void ifcvf_vdpa_set_vq_cb(struct vdpa_device *vdpa_dev, u16 qid, 482 struct vdpa_callback *cb) 483 { 484 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 485 486 vf->vring[qid].cb = *cb; 487 } 488 489 static void ifcvf_vdpa_set_vq_ready(struct vdpa_device *vdpa_dev, 490 u16 qid, bool ready) 491 { 492 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 493 494 ifcvf_set_vq_ready(vf, qid, ready); 495 } 496 497 static bool ifcvf_vdpa_get_vq_ready(struct vdpa_device *vdpa_dev, u16 qid) 498 { 499 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 500 501 return ifcvf_get_vq_ready(vf, qid); 502 } 503 504 static void ifcvf_vdpa_set_vq_num(struct vdpa_device *vdpa_dev, u16 qid, 505 u32 num) 506 { 507 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 508 509 ifcvf_set_vq_num(vf, qid, num); 510 } 511 512 static int ifcvf_vdpa_set_vq_address(struct vdpa_device *vdpa_dev, u16 qid, 513 u64 desc_area, u64 driver_area, 514 u64 device_area) 515 { 516 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 517 518 return ifcvf_set_vq_address(vf, qid, desc_area, driver_area, device_area); 519 } 520 521 static void ifcvf_vdpa_kick_vq(struct vdpa_device *vdpa_dev, u16 qid) 522 { 523 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 524 525 ifcvf_notify_queue(vf, qid); 526 } 527 528 static u32 ifcvf_vdpa_get_generation(struct vdpa_device *vdpa_dev) 529 { 530 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 531 532 return vp_ioread8(&vf->common_cfg->config_generation); 533 } 534 535 static u32 ifcvf_vdpa_get_device_id(struct vdpa_device *vdpa_dev) 536 { 537 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 538 539 return vf->dev_type; 540 } 541 542 static u32 ifcvf_vdpa_get_vendor_id(struct vdpa_device *vdpa_dev) 543 { 544 struct ifcvf_adapter *adapter = vdpa_to_adapter(vdpa_dev); 545 struct pci_dev *pdev = adapter->pdev; 546 547 return pdev->subsystem_vendor; 548 } 549 550 static u32 ifcvf_vdpa_get_vq_align(struct vdpa_device *vdpa_dev) 551 { 552 return IFCVF_QUEUE_ALIGNMENT; 553 } 554 555 static size_t ifcvf_vdpa_get_config_size(struct vdpa_device *vdpa_dev) 556 { 557 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 558 559 return vf->config_size; 560 } 561 562 static u32 ifcvf_vdpa_get_vq_group(struct vdpa_device *vdpa, u16 idx) 563 { 564 return 0; 565 } 566 567 static void ifcvf_vdpa_get_config(struct vdpa_device *vdpa_dev, 568 unsigned int offset, 569 void *buf, unsigned int len) 570 { 571 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 572 573 ifcvf_read_dev_config(vf, offset, buf, len); 574 } 575 576 static void ifcvf_vdpa_set_config(struct vdpa_device *vdpa_dev, 577 unsigned int offset, const void *buf, 578 unsigned int len) 579 { 580 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 581 582 ifcvf_write_dev_config(vf, offset, buf, len); 583 } 584 585 static void ifcvf_vdpa_set_config_cb(struct vdpa_device *vdpa_dev, 586 struct vdpa_callback *cb) 587 { 588 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 589 590 vf->config_cb.callback = cb->callback; 591 vf->config_cb.private = cb->private; 592 } 593 594 static int ifcvf_vdpa_get_vq_irq(struct vdpa_device *vdpa_dev, 595 u16 qid) 596 { 597 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 598 599 if (vf->vqs_reused_irq < 0) 600 return vf->vring[qid].irq; 601 else 602 return -EINVAL; 603 } 604 605 static u16 ifcvf_vdpa_get_vq_size(struct vdpa_device *vdpa_dev, 606 u16 qid) 607 { 608 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 609 610 return ifcvf_get_vq_size(vf, qid); 611 } 612 613 static struct vdpa_notification_area ifcvf_get_vq_notification(struct vdpa_device *vdpa_dev, 614 u16 idx) 615 { 616 struct ifcvf_hw *vf = vdpa_to_vf(vdpa_dev); 617 struct vdpa_notification_area area; 618 619 area.addr = vf->vring[idx].notify_pa; 620 if (!vf->notify_off_multiplier) 621 area.size = PAGE_SIZE; 622 else 623 area.size = vf->notify_off_multiplier; 624 625 return area; 626 } 627 628 /* 629 * IFCVF currently doesn't have on-chip IOMMU, so not 630 * implemented set_map()/dma_map()/dma_unmap() 631 */ 632 static const struct vdpa_config_ops ifc_vdpa_ops = { 633 .get_device_features = ifcvf_vdpa_get_device_features, 634 .set_driver_features = ifcvf_vdpa_set_driver_features, 635 .get_driver_features = ifcvf_vdpa_get_driver_features, 636 .get_status = ifcvf_vdpa_get_status, 637 .set_status = ifcvf_vdpa_set_status, 638 .reset = ifcvf_vdpa_reset, 639 .get_vq_num_max = ifcvf_vdpa_get_vq_num_max, 640 .get_vq_num_min = ifcvf_vdpa_get_vq_num_min, 641 .get_vq_state = ifcvf_vdpa_get_vq_state, 642 .set_vq_state = ifcvf_vdpa_set_vq_state, 643 .set_vq_cb = ifcvf_vdpa_set_vq_cb, 644 .set_vq_ready = ifcvf_vdpa_set_vq_ready, 645 .get_vq_ready = ifcvf_vdpa_get_vq_ready, 646 .set_vq_num = ifcvf_vdpa_set_vq_num, 647 .set_vq_address = ifcvf_vdpa_set_vq_address, 648 .get_vq_irq = ifcvf_vdpa_get_vq_irq, 649 .get_vq_size = ifcvf_vdpa_get_vq_size, 650 .kick_vq = ifcvf_vdpa_kick_vq, 651 .get_generation = ifcvf_vdpa_get_generation, 652 .get_device_id = ifcvf_vdpa_get_device_id, 653 .get_vendor_id = ifcvf_vdpa_get_vendor_id, 654 .get_vq_align = ifcvf_vdpa_get_vq_align, 655 .get_vq_group = ifcvf_vdpa_get_vq_group, 656 .get_config_size = ifcvf_vdpa_get_config_size, 657 .get_config = ifcvf_vdpa_get_config, 658 .set_config = ifcvf_vdpa_set_config, 659 .set_config_cb = ifcvf_vdpa_set_config_cb, 660 .get_vq_notification = ifcvf_get_vq_notification, 661 }; 662 663 static struct virtio_device_id id_table_net[] = { 664 {VIRTIO_ID_NET, VIRTIO_DEV_ANY_ID}, 665 {0}, 666 }; 667 668 static struct virtio_device_id id_table_blk[] = { 669 {VIRTIO_ID_BLOCK, VIRTIO_DEV_ANY_ID}, 670 {0}, 671 }; 672 673 static u32 get_dev_type(struct pci_dev *pdev) 674 { 675 u32 dev_type; 676 677 /* This drirver drives both modern virtio devices and transitional 678 * devices in modern mode. 679 * vDPA requires feature bit VIRTIO_F_ACCESS_PLATFORM, 680 * so legacy devices and transitional devices in legacy 681 * mode will not work for vDPA, this driver will not 682 * drive devices with legacy interface. 683 */ 684 685 if (pdev->device < 0x1040) 686 dev_type = pdev->subsystem_device; 687 else 688 dev_type = pdev->device - 0x1040; 689 690 return dev_type; 691 } 692 693 static int ifcvf_vdpa_dev_add(struct vdpa_mgmt_dev *mdev, const char *name, 694 const struct vdpa_dev_set_config *config) 695 { 696 struct ifcvf_vdpa_mgmt_dev *ifcvf_mgmt_dev; 697 struct ifcvf_adapter *adapter; 698 struct vdpa_device *vdpa_dev; 699 struct pci_dev *pdev; 700 struct ifcvf_hw *vf; 701 u64 device_features; 702 int ret; 703 704 ifcvf_mgmt_dev = container_of(mdev, struct ifcvf_vdpa_mgmt_dev, mdev); 705 vf = &ifcvf_mgmt_dev->vf; 706 pdev = vf->pdev; 707 adapter = vdpa_alloc_device(struct ifcvf_adapter, vdpa, 708 &pdev->dev, &ifc_vdpa_ops, 1, 1, NULL, false); 709 if (IS_ERR(adapter)) { 710 IFCVF_ERR(pdev, "Failed to allocate vDPA structure"); 711 return PTR_ERR(adapter); 712 } 713 714 ifcvf_mgmt_dev->adapter = adapter; 715 adapter->pdev = pdev; 716 adapter->vdpa.dma_dev = &pdev->dev; 717 adapter->vdpa.mdev = mdev; 718 adapter->vf = vf; 719 vdpa_dev = &adapter->vdpa; 720 721 device_features = vf->hw_features; 722 if (config->mask & BIT_ULL(VDPA_ATTR_DEV_FEATURES)) { 723 if (config->device_features & ~device_features) { 724 IFCVF_ERR(pdev, "The provisioned features 0x%llx are not supported by this device with features 0x%llx\n", 725 config->device_features, device_features); 726 return -EINVAL; 727 } 728 device_features &= config->device_features; 729 } 730 vf->dev_features = device_features; 731 732 if (name) 733 ret = dev_set_name(&vdpa_dev->dev, "%s", name); 734 else 735 ret = dev_set_name(&vdpa_dev->dev, "vdpa%u", vdpa_dev->index); 736 737 ret = _vdpa_register_device(&adapter->vdpa, vf->nr_vring); 738 if (ret) { 739 put_device(&adapter->vdpa.dev); 740 IFCVF_ERR(pdev, "Failed to register to vDPA bus"); 741 return ret; 742 } 743 744 return 0; 745 } 746 747 static void ifcvf_vdpa_dev_del(struct vdpa_mgmt_dev *mdev, struct vdpa_device *dev) 748 { 749 struct ifcvf_vdpa_mgmt_dev *ifcvf_mgmt_dev; 750 751 ifcvf_mgmt_dev = container_of(mdev, struct ifcvf_vdpa_mgmt_dev, mdev); 752 _vdpa_unregister_device(dev); 753 ifcvf_mgmt_dev->adapter = NULL; 754 } 755 756 static const struct vdpa_mgmtdev_ops ifcvf_vdpa_mgmt_dev_ops = { 757 .dev_add = ifcvf_vdpa_dev_add, 758 .dev_del = ifcvf_vdpa_dev_del 759 }; 760 761 static int ifcvf_probe(struct pci_dev *pdev, const struct pci_device_id *id) 762 { 763 struct ifcvf_vdpa_mgmt_dev *ifcvf_mgmt_dev; 764 struct device *dev = &pdev->dev; 765 struct ifcvf_hw *vf; 766 u32 dev_type; 767 int ret, i; 768 769 ret = pcim_enable_device(pdev); 770 if (ret) { 771 IFCVF_ERR(pdev, "Failed to enable device\n"); 772 return ret; 773 } 774 ret = pcim_iomap_regions(pdev, BIT(0) | BIT(2) | BIT(4), 775 IFCVF_DRIVER_NAME); 776 if (ret) { 777 IFCVF_ERR(pdev, "Failed to request MMIO region\n"); 778 return ret; 779 } 780 781 ret = dma_set_mask_and_coherent(dev, DMA_BIT_MASK(64)); 782 if (ret) { 783 IFCVF_ERR(pdev, "No usable DMA configuration\n"); 784 return ret; 785 } 786 787 ret = devm_add_action_or_reset(dev, ifcvf_free_irq_vectors, pdev); 788 if (ret) { 789 IFCVF_ERR(pdev, 790 "Failed for adding devres for freeing irq vectors\n"); 791 return ret; 792 } 793 794 pci_set_master(pdev); 795 ifcvf_mgmt_dev = kzalloc(sizeof(struct ifcvf_vdpa_mgmt_dev), GFP_KERNEL); 796 if (!ifcvf_mgmt_dev) { 797 IFCVF_ERR(pdev, "Failed to alloc memory for the vDPA management device\n"); 798 return -ENOMEM; 799 } 800 801 vf = &ifcvf_mgmt_dev->vf; 802 vf->dev_type = get_dev_type(pdev); 803 vf->base = pcim_iomap_table(pdev); 804 vf->pdev = pdev; 805 806 ret = ifcvf_init_hw(vf, pdev); 807 if (ret) { 808 IFCVF_ERR(pdev, "Failed to init IFCVF hw\n"); 809 goto err; 810 } 811 812 for (i = 0; i < vf->nr_vring; i++) 813 vf->vring[i].irq = -EINVAL; 814 815 vf->hw_features = ifcvf_get_hw_features(vf); 816 vf->config_size = ifcvf_get_config_size(vf); 817 818 dev_type = get_dev_type(pdev); 819 switch (dev_type) { 820 case VIRTIO_ID_NET: 821 ifcvf_mgmt_dev->mdev.id_table = id_table_net; 822 break; 823 case VIRTIO_ID_BLOCK: 824 ifcvf_mgmt_dev->mdev.id_table = id_table_blk; 825 break; 826 default: 827 IFCVF_ERR(pdev, "VIRTIO ID %u not supported\n", dev_type); 828 ret = -EOPNOTSUPP; 829 goto err; 830 } 831 832 ifcvf_mgmt_dev->mdev.ops = &ifcvf_vdpa_mgmt_dev_ops; 833 ifcvf_mgmt_dev->mdev.device = dev; 834 ifcvf_mgmt_dev->mdev.max_supported_vqs = vf->nr_vring; 835 ifcvf_mgmt_dev->mdev.supported_features = vf->hw_features; 836 ifcvf_mgmt_dev->mdev.config_attr_mask = (1 << VDPA_ATTR_DEV_FEATURES); 837 838 ret = vdpa_mgmtdev_register(&ifcvf_mgmt_dev->mdev); 839 if (ret) { 840 IFCVF_ERR(pdev, 841 "Failed to initialize the management interfaces\n"); 842 goto err; 843 } 844 845 pci_set_drvdata(pdev, ifcvf_mgmt_dev); 846 847 return 0; 848 849 err: 850 kfree(ifcvf_mgmt_dev->vf.vring); 851 kfree(ifcvf_mgmt_dev); 852 return ret; 853 } 854 855 static void ifcvf_remove(struct pci_dev *pdev) 856 { 857 struct ifcvf_vdpa_mgmt_dev *ifcvf_mgmt_dev; 858 859 ifcvf_mgmt_dev = pci_get_drvdata(pdev); 860 vdpa_mgmtdev_unregister(&ifcvf_mgmt_dev->mdev); 861 kfree(ifcvf_mgmt_dev->vf.vring); 862 kfree(ifcvf_mgmt_dev); 863 } 864 865 static struct pci_device_id ifcvf_pci_ids[] = { 866 /* N3000 network device */ 867 { PCI_DEVICE_SUB(PCI_VENDOR_ID_REDHAT_QUMRANET, 868 N3000_DEVICE_ID, 869 PCI_VENDOR_ID_INTEL, 870 N3000_SUBSYS_DEVICE_ID) }, 871 /* C5000X-PL network device 872 * F2000X-PL network device 873 */ 874 { PCI_DEVICE_SUB(PCI_VENDOR_ID_REDHAT_QUMRANET, 875 VIRTIO_TRANS_ID_NET, 876 PCI_VENDOR_ID_INTEL, 877 VIRTIO_ID_NET) }, 878 /* C5000X-PL block device */ 879 { PCI_DEVICE_SUB(PCI_VENDOR_ID_REDHAT_QUMRANET, 880 VIRTIO_TRANS_ID_BLOCK, 881 PCI_VENDOR_ID_INTEL, 882 VIRTIO_ID_BLOCK) }, 883 884 { 0 }, 885 }; 886 MODULE_DEVICE_TABLE(pci, ifcvf_pci_ids); 887 888 static struct pci_driver ifcvf_driver = { 889 .name = IFCVF_DRIVER_NAME, 890 .id_table = ifcvf_pci_ids, 891 .probe = ifcvf_probe, 892 .remove = ifcvf_remove, 893 }; 894 895 module_pci_driver(ifcvf_driver); 896 897 MODULE_LICENSE("GPL v2"); 898