1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * PCI Express I/O Virtualization (IOV) support 4 * Single Root IOV 1.0 5 * Address Translation Service 1.0 6 * 7 * Copyright (C) 2009 Intel Corporation, Yu Zhao <yu.zhao@intel.com> 8 */ 9 10 #include <linux/pci.h> 11 #include <linux/slab.h> 12 #include <linux/export.h> 13 #include <linux/string.h> 14 #include <linux/delay.h> 15 #include "pci.h" 16 17 #define VIRTFN_ID_LEN 16 18 19 int pci_iov_virtfn_bus(struct pci_dev *dev, int vf_id) 20 { 21 if (!dev->is_physfn) 22 return -EINVAL; 23 return dev->bus->number + ((dev->devfn + dev->sriov->offset + 24 dev->sriov->stride * vf_id) >> 8); 25 } 26 27 int pci_iov_virtfn_devfn(struct pci_dev *dev, int vf_id) 28 { 29 if (!dev->is_physfn) 30 return -EINVAL; 31 return (dev->devfn + dev->sriov->offset + 32 dev->sriov->stride * vf_id) & 0xff; 33 } 34 35 /* 36 * Per SR-IOV spec sec 3.3.10 and 3.3.11, First VF Offset and VF Stride may 37 * change when NumVFs changes. 38 * 39 * Update iov->offset and iov->stride when NumVFs is written. 40 */ 41 static inline void pci_iov_set_numvfs(struct pci_dev *dev, int nr_virtfn) 42 { 43 struct pci_sriov *iov = dev->sriov; 44 45 pci_write_config_word(dev, iov->pos + PCI_SRIOV_NUM_VF, nr_virtfn); 46 pci_read_config_word(dev, iov->pos + PCI_SRIOV_VF_OFFSET, &iov->offset); 47 pci_read_config_word(dev, iov->pos + PCI_SRIOV_VF_STRIDE, &iov->stride); 48 } 49 50 /* 51 * The PF consumes one bus number. NumVFs, First VF Offset, and VF Stride 52 * determine how many additional bus numbers will be consumed by VFs. 53 * 54 * Iterate over all valid NumVFs, validate offset and stride, and calculate 55 * the maximum number of bus numbers that could ever be required. 56 */ 57 static int compute_max_vf_buses(struct pci_dev *dev) 58 { 59 struct pci_sriov *iov = dev->sriov; 60 int nr_virtfn, busnr, rc = 0; 61 62 for (nr_virtfn = iov->total_VFs; nr_virtfn; nr_virtfn--) { 63 pci_iov_set_numvfs(dev, nr_virtfn); 64 if (!iov->offset || (nr_virtfn > 1 && !iov->stride)) { 65 rc = -EIO; 66 goto out; 67 } 68 69 busnr = pci_iov_virtfn_bus(dev, nr_virtfn - 1); 70 if (busnr > iov->max_VF_buses) 71 iov->max_VF_buses = busnr; 72 } 73 74 out: 75 pci_iov_set_numvfs(dev, 0); 76 return rc; 77 } 78 79 static struct pci_bus *virtfn_add_bus(struct pci_bus *bus, int busnr) 80 { 81 struct pci_bus *child; 82 83 if (bus->number == busnr) 84 return bus; 85 86 child = pci_find_bus(pci_domain_nr(bus), busnr); 87 if (child) 88 return child; 89 90 child = pci_add_new_bus(bus, NULL, busnr); 91 if (!child) 92 return NULL; 93 94 pci_bus_insert_busn_res(child, busnr, busnr); 95 96 return child; 97 } 98 99 static void virtfn_remove_bus(struct pci_bus *physbus, struct pci_bus *virtbus) 100 { 101 if (physbus != virtbus && list_empty(&virtbus->devices)) 102 pci_remove_bus(virtbus); 103 } 104 105 resource_size_t pci_iov_resource_size(struct pci_dev *dev, int resno) 106 { 107 if (!dev->is_physfn) 108 return 0; 109 110 return dev->sriov->barsz[resno - PCI_IOV_RESOURCES]; 111 } 112 113 static void pci_read_vf_config_common(struct pci_dev *virtfn) 114 { 115 struct pci_dev *physfn = virtfn->physfn; 116 117 /* 118 * Some config registers are the same across all associated VFs. 119 * Read them once from VF0 so we can skip reading them from the 120 * other VFs. 121 * 122 * PCIe r4.0, sec 9.3.4.1, technically doesn't require all VFs to 123 * have the same Revision ID and Subsystem ID, but we assume they 124 * do. 125 */ 126 pci_read_config_dword(virtfn, PCI_CLASS_REVISION, 127 &physfn->sriov->class); 128 pci_read_config_byte(virtfn, PCI_HEADER_TYPE, 129 &physfn->sriov->hdr_type); 130 pci_read_config_word(virtfn, PCI_SUBSYSTEM_VENDOR_ID, 131 &physfn->sriov->subsystem_vendor); 132 pci_read_config_word(virtfn, PCI_SUBSYSTEM_ID, 133 &physfn->sriov->subsystem_device); 134 } 135 136 int pci_iov_add_virtfn(struct pci_dev *dev, int id) 137 { 138 int i; 139 int rc = -ENOMEM; 140 u64 size; 141 char buf[VIRTFN_ID_LEN]; 142 struct pci_dev *virtfn; 143 struct resource *res; 144 struct pci_sriov *iov = dev->sriov; 145 struct pci_bus *bus; 146 147 bus = virtfn_add_bus(dev->bus, pci_iov_virtfn_bus(dev, id)); 148 if (!bus) 149 goto failed; 150 151 virtfn = pci_alloc_dev(bus); 152 if (!virtfn) 153 goto failed0; 154 155 virtfn->devfn = pci_iov_virtfn_devfn(dev, id); 156 virtfn->vendor = dev->vendor; 157 virtfn->device = iov->vf_device; 158 virtfn->is_virtfn = 1; 159 virtfn->physfn = pci_dev_get(dev); 160 161 if (id == 0) 162 pci_read_vf_config_common(virtfn); 163 164 rc = pci_setup_device(virtfn); 165 if (rc) 166 goto failed1; 167 168 virtfn->dev.parent = dev->dev.parent; 169 virtfn->multifunction = 0; 170 171 for (i = 0; i < PCI_SRIOV_NUM_BARS; i++) { 172 res = &dev->resource[i + PCI_IOV_RESOURCES]; 173 if (!res->parent) 174 continue; 175 virtfn->resource[i].name = pci_name(virtfn); 176 virtfn->resource[i].flags = res->flags; 177 size = pci_iov_resource_size(dev, i + PCI_IOV_RESOURCES); 178 virtfn->resource[i].start = res->start + size * id; 179 virtfn->resource[i].end = virtfn->resource[i].start + size - 1; 180 rc = request_resource(res, &virtfn->resource[i]); 181 BUG_ON(rc); 182 } 183 184 pci_device_add(virtfn, virtfn->bus); 185 186 sprintf(buf, "virtfn%u", id); 187 rc = sysfs_create_link(&dev->dev.kobj, &virtfn->dev.kobj, buf); 188 if (rc) 189 goto failed2; 190 rc = sysfs_create_link(&virtfn->dev.kobj, &dev->dev.kobj, "physfn"); 191 if (rc) 192 goto failed3; 193 194 kobject_uevent(&virtfn->dev.kobj, KOBJ_CHANGE); 195 196 pci_bus_add_device(virtfn); 197 198 return 0; 199 200 failed3: 201 sysfs_remove_link(&dev->dev.kobj, buf); 202 failed2: 203 pci_stop_and_remove_bus_device(virtfn); 204 failed1: 205 pci_dev_put(dev); 206 failed0: 207 virtfn_remove_bus(dev->bus, bus); 208 failed: 209 210 return rc; 211 } 212 213 void pci_iov_remove_virtfn(struct pci_dev *dev, int id) 214 { 215 char buf[VIRTFN_ID_LEN]; 216 struct pci_dev *virtfn; 217 218 virtfn = pci_get_domain_bus_and_slot(pci_domain_nr(dev->bus), 219 pci_iov_virtfn_bus(dev, id), 220 pci_iov_virtfn_devfn(dev, id)); 221 if (!virtfn) 222 return; 223 224 sprintf(buf, "virtfn%u", id); 225 sysfs_remove_link(&dev->dev.kobj, buf); 226 /* 227 * pci_stop_dev() could have been called for this virtfn already, 228 * so the directory for the virtfn may have been removed before. 229 * Double check to avoid spurious sysfs warnings. 230 */ 231 if (virtfn->dev.kobj.sd) 232 sysfs_remove_link(&virtfn->dev.kobj, "physfn"); 233 234 pci_stop_and_remove_bus_device(virtfn); 235 virtfn_remove_bus(dev->bus, virtfn->bus); 236 237 /* balance pci_get_domain_bus_and_slot() */ 238 pci_dev_put(virtfn); 239 pci_dev_put(dev); 240 } 241 242 static ssize_t sriov_totalvfs_show(struct device *dev, 243 struct device_attribute *attr, 244 char *buf) 245 { 246 struct pci_dev *pdev = to_pci_dev(dev); 247 248 return sprintf(buf, "%u\n", pci_sriov_get_totalvfs(pdev)); 249 } 250 251 static ssize_t sriov_numvfs_show(struct device *dev, 252 struct device_attribute *attr, 253 char *buf) 254 { 255 struct pci_dev *pdev = to_pci_dev(dev); 256 u16 num_vfs; 257 258 /* Serialize vs sriov_numvfs_store() so readers see valid num_VFs */ 259 device_lock(&pdev->dev); 260 num_vfs = pdev->sriov->num_VFs; 261 device_unlock(&pdev->dev); 262 263 return sprintf(buf, "%u\n", num_vfs); 264 } 265 266 /* 267 * num_vfs > 0; number of VFs to enable 268 * num_vfs = 0; disable all VFs 269 * 270 * Note: SRIOV spec does not allow partial VF 271 * disable, so it's all or none. 272 */ 273 static ssize_t sriov_numvfs_store(struct device *dev, 274 struct device_attribute *attr, 275 const char *buf, size_t count) 276 { 277 struct pci_dev *pdev = to_pci_dev(dev); 278 int ret; 279 u16 num_vfs; 280 281 ret = kstrtou16(buf, 0, &num_vfs); 282 if (ret < 0) 283 return ret; 284 285 if (num_vfs > pci_sriov_get_totalvfs(pdev)) 286 return -ERANGE; 287 288 device_lock(&pdev->dev); 289 290 if (num_vfs == pdev->sriov->num_VFs) 291 goto exit; 292 293 /* is PF driver loaded w/callback */ 294 if (!pdev->driver || !pdev->driver->sriov_configure) { 295 pci_info(pdev, "Driver does not support SRIOV configuration via sysfs\n"); 296 ret = -ENOENT; 297 goto exit; 298 } 299 300 if (num_vfs == 0) { 301 /* disable VFs */ 302 ret = pdev->driver->sriov_configure(pdev, 0); 303 goto exit; 304 } 305 306 /* enable VFs */ 307 if (pdev->sriov->num_VFs) { 308 pci_warn(pdev, "%d VFs already enabled. Disable before enabling %d VFs\n", 309 pdev->sriov->num_VFs, num_vfs); 310 ret = -EBUSY; 311 goto exit; 312 } 313 314 ret = pdev->driver->sriov_configure(pdev, num_vfs); 315 if (ret < 0) 316 goto exit; 317 318 if (ret != num_vfs) 319 pci_warn(pdev, "%d VFs requested; only %d enabled\n", 320 num_vfs, ret); 321 322 exit: 323 device_unlock(&pdev->dev); 324 325 if (ret < 0) 326 return ret; 327 328 return count; 329 } 330 331 static ssize_t sriov_offset_show(struct device *dev, 332 struct device_attribute *attr, 333 char *buf) 334 { 335 struct pci_dev *pdev = to_pci_dev(dev); 336 337 return sprintf(buf, "%u\n", pdev->sriov->offset); 338 } 339 340 static ssize_t sriov_stride_show(struct device *dev, 341 struct device_attribute *attr, 342 char *buf) 343 { 344 struct pci_dev *pdev = to_pci_dev(dev); 345 346 return sprintf(buf, "%u\n", pdev->sriov->stride); 347 } 348 349 static ssize_t sriov_vf_device_show(struct device *dev, 350 struct device_attribute *attr, 351 char *buf) 352 { 353 struct pci_dev *pdev = to_pci_dev(dev); 354 355 return sprintf(buf, "%x\n", pdev->sriov->vf_device); 356 } 357 358 static ssize_t sriov_drivers_autoprobe_show(struct device *dev, 359 struct device_attribute *attr, 360 char *buf) 361 { 362 struct pci_dev *pdev = to_pci_dev(dev); 363 364 return sprintf(buf, "%u\n", pdev->sriov->drivers_autoprobe); 365 } 366 367 static ssize_t sriov_drivers_autoprobe_store(struct device *dev, 368 struct device_attribute *attr, 369 const char *buf, size_t count) 370 { 371 struct pci_dev *pdev = to_pci_dev(dev); 372 bool drivers_autoprobe; 373 374 if (kstrtobool(buf, &drivers_autoprobe) < 0) 375 return -EINVAL; 376 377 pdev->sriov->drivers_autoprobe = drivers_autoprobe; 378 379 return count; 380 } 381 382 static DEVICE_ATTR_RO(sriov_totalvfs); 383 static DEVICE_ATTR_RW(sriov_numvfs); 384 static DEVICE_ATTR_RO(sriov_offset); 385 static DEVICE_ATTR_RO(sriov_stride); 386 static DEVICE_ATTR_RO(sriov_vf_device); 387 static DEVICE_ATTR_RW(sriov_drivers_autoprobe); 388 389 static struct attribute *sriov_dev_attrs[] = { 390 &dev_attr_sriov_totalvfs.attr, 391 &dev_attr_sriov_numvfs.attr, 392 &dev_attr_sriov_offset.attr, 393 &dev_attr_sriov_stride.attr, 394 &dev_attr_sriov_vf_device.attr, 395 &dev_attr_sriov_drivers_autoprobe.attr, 396 NULL, 397 }; 398 399 static umode_t sriov_attrs_are_visible(struct kobject *kobj, 400 struct attribute *a, int n) 401 { 402 struct device *dev = kobj_to_dev(kobj); 403 404 if (!dev_is_pf(dev)) 405 return 0; 406 407 return a->mode; 408 } 409 410 const struct attribute_group sriov_dev_attr_group = { 411 .attrs = sriov_dev_attrs, 412 .is_visible = sriov_attrs_are_visible, 413 }; 414 415 int __weak pcibios_sriov_enable(struct pci_dev *pdev, u16 num_vfs) 416 { 417 return 0; 418 } 419 420 int __weak pcibios_sriov_disable(struct pci_dev *pdev) 421 { 422 return 0; 423 } 424 425 static int sriov_add_vfs(struct pci_dev *dev, u16 num_vfs) 426 { 427 unsigned int i; 428 int rc; 429 430 if (dev->no_vf_scan) 431 return 0; 432 433 for (i = 0; i < num_vfs; i++) { 434 rc = pci_iov_add_virtfn(dev, i); 435 if (rc) 436 goto failed; 437 } 438 return 0; 439 failed: 440 while (i--) 441 pci_iov_remove_virtfn(dev, i); 442 443 return rc; 444 } 445 446 static int sriov_enable(struct pci_dev *dev, int nr_virtfn) 447 { 448 int rc; 449 int i; 450 int nres; 451 u16 initial; 452 struct resource *res; 453 struct pci_dev *pdev; 454 struct pci_sriov *iov = dev->sriov; 455 int bars = 0; 456 int bus; 457 458 if (!nr_virtfn) 459 return 0; 460 461 if (iov->num_VFs) 462 return -EINVAL; 463 464 pci_read_config_word(dev, iov->pos + PCI_SRIOV_INITIAL_VF, &initial); 465 if (initial > iov->total_VFs || 466 (!(iov->cap & PCI_SRIOV_CAP_VFM) && (initial != iov->total_VFs))) 467 return -EIO; 468 469 if (nr_virtfn < 0 || nr_virtfn > iov->total_VFs || 470 (!(iov->cap & PCI_SRIOV_CAP_VFM) && (nr_virtfn > initial))) 471 return -EINVAL; 472 473 nres = 0; 474 for (i = 0; i < PCI_SRIOV_NUM_BARS; i++) { 475 bars |= (1 << (i + PCI_IOV_RESOURCES)); 476 res = &dev->resource[i + PCI_IOV_RESOURCES]; 477 if (res->parent) 478 nres++; 479 } 480 if (nres != iov->nres) { 481 pci_err(dev, "not enough MMIO resources for SR-IOV\n"); 482 return -ENOMEM; 483 } 484 485 bus = pci_iov_virtfn_bus(dev, nr_virtfn - 1); 486 if (bus > dev->bus->busn_res.end) { 487 pci_err(dev, "can't enable %d VFs (bus %02x out of range of %pR)\n", 488 nr_virtfn, bus, &dev->bus->busn_res); 489 return -ENOMEM; 490 } 491 492 if (pci_enable_resources(dev, bars)) { 493 pci_err(dev, "SR-IOV: IOV BARS not allocated\n"); 494 return -ENOMEM; 495 } 496 497 if (iov->link != dev->devfn) { 498 pdev = pci_get_slot(dev->bus, iov->link); 499 if (!pdev) 500 return -ENODEV; 501 502 if (!pdev->is_physfn) { 503 pci_dev_put(pdev); 504 return -ENOSYS; 505 } 506 507 rc = sysfs_create_link(&dev->dev.kobj, 508 &pdev->dev.kobj, "dep_link"); 509 pci_dev_put(pdev); 510 if (rc) 511 return rc; 512 } 513 514 iov->initial_VFs = initial; 515 if (nr_virtfn < initial) 516 initial = nr_virtfn; 517 518 rc = pcibios_sriov_enable(dev, initial); 519 if (rc) { 520 pci_err(dev, "failure %d from pcibios_sriov_enable()\n", rc); 521 goto err_pcibios; 522 } 523 524 pci_iov_set_numvfs(dev, nr_virtfn); 525 iov->ctrl |= PCI_SRIOV_CTRL_VFE | PCI_SRIOV_CTRL_MSE; 526 pci_cfg_access_lock(dev); 527 pci_write_config_word(dev, iov->pos + PCI_SRIOV_CTRL, iov->ctrl); 528 msleep(100); 529 pci_cfg_access_unlock(dev); 530 531 rc = sriov_add_vfs(dev, initial); 532 if (rc) 533 goto err_pcibios; 534 535 kobject_uevent(&dev->dev.kobj, KOBJ_CHANGE); 536 iov->num_VFs = nr_virtfn; 537 538 return 0; 539 540 err_pcibios: 541 iov->ctrl &= ~(PCI_SRIOV_CTRL_VFE | PCI_SRIOV_CTRL_MSE); 542 pci_cfg_access_lock(dev); 543 pci_write_config_word(dev, iov->pos + PCI_SRIOV_CTRL, iov->ctrl); 544 ssleep(1); 545 pci_cfg_access_unlock(dev); 546 547 pcibios_sriov_disable(dev); 548 549 if (iov->link != dev->devfn) 550 sysfs_remove_link(&dev->dev.kobj, "dep_link"); 551 552 pci_iov_set_numvfs(dev, 0); 553 return rc; 554 } 555 556 static void sriov_del_vfs(struct pci_dev *dev) 557 { 558 struct pci_sriov *iov = dev->sriov; 559 int i; 560 561 if (dev->no_vf_scan) 562 return; 563 564 for (i = 0; i < iov->num_VFs; i++) 565 pci_iov_remove_virtfn(dev, i); 566 } 567 568 static void sriov_disable(struct pci_dev *dev) 569 { 570 struct pci_sriov *iov = dev->sriov; 571 572 if (!iov->num_VFs) 573 return; 574 575 sriov_del_vfs(dev); 576 iov->ctrl &= ~(PCI_SRIOV_CTRL_VFE | PCI_SRIOV_CTRL_MSE); 577 pci_cfg_access_lock(dev); 578 pci_write_config_word(dev, iov->pos + PCI_SRIOV_CTRL, iov->ctrl); 579 ssleep(1); 580 pci_cfg_access_unlock(dev); 581 582 pcibios_sriov_disable(dev); 583 584 if (iov->link != dev->devfn) 585 sysfs_remove_link(&dev->dev.kobj, "dep_link"); 586 587 iov->num_VFs = 0; 588 pci_iov_set_numvfs(dev, 0); 589 } 590 591 static int sriov_init(struct pci_dev *dev, int pos) 592 { 593 int i, bar64; 594 int rc; 595 int nres; 596 u32 pgsz; 597 u16 ctrl, total; 598 struct pci_sriov *iov; 599 struct resource *res; 600 struct pci_dev *pdev; 601 602 pci_read_config_word(dev, pos + PCI_SRIOV_CTRL, &ctrl); 603 if (ctrl & PCI_SRIOV_CTRL_VFE) { 604 pci_write_config_word(dev, pos + PCI_SRIOV_CTRL, 0); 605 ssleep(1); 606 } 607 608 ctrl = 0; 609 list_for_each_entry(pdev, &dev->bus->devices, bus_list) 610 if (pdev->is_physfn) 611 goto found; 612 613 pdev = NULL; 614 if (pci_ari_enabled(dev->bus)) 615 ctrl |= PCI_SRIOV_CTRL_ARI; 616 617 found: 618 pci_write_config_word(dev, pos + PCI_SRIOV_CTRL, ctrl); 619 620 pci_read_config_word(dev, pos + PCI_SRIOV_TOTAL_VF, &total); 621 if (!total) 622 return 0; 623 624 pci_read_config_dword(dev, pos + PCI_SRIOV_SUP_PGSIZE, &pgsz); 625 i = PAGE_SHIFT > 12 ? PAGE_SHIFT - 12 : 0; 626 pgsz &= ~((1 << i) - 1); 627 if (!pgsz) 628 return -EIO; 629 630 pgsz &= ~(pgsz - 1); 631 pci_write_config_dword(dev, pos + PCI_SRIOV_SYS_PGSIZE, pgsz); 632 633 iov = kzalloc(sizeof(*iov), GFP_KERNEL); 634 if (!iov) 635 return -ENOMEM; 636 637 nres = 0; 638 for (i = 0; i < PCI_SRIOV_NUM_BARS; i++) { 639 res = &dev->resource[i + PCI_IOV_RESOURCES]; 640 /* 641 * If it is already FIXED, don't change it, something 642 * (perhaps EA or header fixups) wants it this way. 643 */ 644 if (res->flags & IORESOURCE_PCI_FIXED) 645 bar64 = (res->flags & IORESOURCE_MEM_64) ? 1 : 0; 646 else 647 bar64 = __pci_read_base(dev, pci_bar_unknown, res, 648 pos + PCI_SRIOV_BAR + i * 4); 649 if (!res->flags) 650 continue; 651 if (resource_size(res) & (PAGE_SIZE - 1)) { 652 rc = -EIO; 653 goto failed; 654 } 655 iov->barsz[i] = resource_size(res); 656 res->end = res->start + resource_size(res) * total - 1; 657 pci_info(dev, "VF(n) BAR%d space: %pR (contains BAR%d for %d VFs)\n", 658 i, res, i, total); 659 i += bar64; 660 nres++; 661 } 662 663 iov->pos = pos; 664 iov->nres = nres; 665 iov->ctrl = ctrl; 666 iov->total_VFs = total; 667 iov->driver_max_VFs = total; 668 pci_read_config_word(dev, pos + PCI_SRIOV_VF_DID, &iov->vf_device); 669 iov->pgsz = pgsz; 670 iov->self = dev; 671 iov->drivers_autoprobe = true; 672 pci_read_config_dword(dev, pos + PCI_SRIOV_CAP, &iov->cap); 673 pci_read_config_byte(dev, pos + PCI_SRIOV_FUNC_LINK, &iov->link); 674 if (pci_pcie_type(dev) == PCI_EXP_TYPE_RC_END) 675 iov->link = PCI_DEVFN(PCI_SLOT(dev->devfn), iov->link); 676 677 if (pdev) 678 iov->dev = pci_dev_get(pdev); 679 else 680 iov->dev = dev; 681 682 dev->sriov = iov; 683 dev->is_physfn = 1; 684 rc = compute_max_vf_buses(dev); 685 if (rc) 686 goto fail_max_buses; 687 688 return 0; 689 690 fail_max_buses: 691 dev->sriov = NULL; 692 dev->is_physfn = 0; 693 failed: 694 for (i = 0; i < PCI_SRIOV_NUM_BARS; i++) { 695 res = &dev->resource[i + PCI_IOV_RESOURCES]; 696 res->flags = 0; 697 } 698 699 kfree(iov); 700 return rc; 701 } 702 703 static void sriov_release(struct pci_dev *dev) 704 { 705 BUG_ON(dev->sriov->num_VFs); 706 707 if (dev != dev->sriov->dev) 708 pci_dev_put(dev->sriov->dev); 709 710 kfree(dev->sriov); 711 dev->sriov = NULL; 712 } 713 714 static void sriov_restore_state(struct pci_dev *dev) 715 { 716 int i; 717 u16 ctrl; 718 struct pci_sriov *iov = dev->sriov; 719 720 pci_read_config_word(dev, iov->pos + PCI_SRIOV_CTRL, &ctrl); 721 if (ctrl & PCI_SRIOV_CTRL_VFE) 722 return; 723 724 /* 725 * Restore PCI_SRIOV_CTRL_ARI before pci_iov_set_numvfs() because 726 * it reads offset & stride, which depend on PCI_SRIOV_CTRL_ARI. 727 */ 728 ctrl &= ~PCI_SRIOV_CTRL_ARI; 729 ctrl |= iov->ctrl & PCI_SRIOV_CTRL_ARI; 730 pci_write_config_word(dev, iov->pos + PCI_SRIOV_CTRL, ctrl); 731 732 for (i = 0; i < PCI_SRIOV_NUM_BARS; i++) 733 pci_update_resource(dev, i + PCI_IOV_RESOURCES); 734 735 pci_write_config_dword(dev, iov->pos + PCI_SRIOV_SYS_PGSIZE, iov->pgsz); 736 pci_iov_set_numvfs(dev, iov->num_VFs); 737 pci_write_config_word(dev, iov->pos + PCI_SRIOV_CTRL, iov->ctrl); 738 if (iov->ctrl & PCI_SRIOV_CTRL_VFE) 739 msleep(100); 740 } 741 742 /** 743 * pci_iov_init - initialize the IOV capability 744 * @dev: the PCI device 745 * 746 * Returns 0 on success, or negative on failure. 747 */ 748 int pci_iov_init(struct pci_dev *dev) 749 { 750 int pos; 751 752 if (!pci_is_pcie(dev)) 753 return -ENODEV; 754 755 pos = pci_find_ext_capability(dev, PCI_EXT_CAP_ID_SRIOV); 756 if (pos) 757 return sriov_init(dev, pos); 758 759 return -ENODEV; 760 } 761 762 /** 763 * pci_iov_release - release resources used by the IOV capability 764 * @dev: the PCI device 765 */ 766 void pci_iov_release(struct pci_dev *dev) 767 { 768 if (dev->is_physfn) 769 sriov_release(dev); 770 } 771 772 /** 773 * pci_iov_remove - clean up SR-IOV state after PF driver is detached 774 * @dev: the PCI device 775 */ 776 void pci_iov_remove(struct pci_dev *dev) 777 { 778 struct pci_sriov *iov = dev->sriov; 779 780 if (!dev->is_physfn) 781 return; 782 783 iov->driver_max_VFs = iov->total_VFs; 784 if (iov->num_VFs) 785 pci_warn(dev, "driver left SR-IOV enabled after remove\n"); 786 } 787 788 /** 789 * pci_iov_update_resource - update a VF BAR 790 * @dev: the PCI device 791 * @resno: the resource number 792 * 793 * Update a VF BAR in the SR-IOV capability of a PF. 794 */ 795 void pci_iov_update_resource(struct pci_dev *dev, int resno) 796 { 797 struct pci_sriov *iov = dev->is_physfn ? dev->sriov : NULL; 798 struct resource *res = dev->resource + resno; 799 int vf_bar = resno - PCI_IOV_RESOURCES; 800 struct pci_bus_region region; 801 u16 cmd; 802 u32 new; 803 int reg; 804 805 /* 806 * The generic pci_restore_bars() path calls this for all devices, 807 * including VFs and non-SR-IOV devices. If this is not a PF, we 808 * have nothing to do. 809 */ 810 if (!iov) 811 return; 812 813 pci_read_config_word(dev, iov->pos + PCI_SRIOV_CTRL, &cmd); 814 if ((cmd & PCI_SRIOV_CTRL_VFE) && (cmd & PCI_SRIOV_CTRL_MSE)) { 815 dev_WARN(&dev->dev, "can't update enabled VF BAR%d %pR\n", 816 vf_bar, res); 817 return; 818 } 819 820 /* 821 * Ignore unimplemented BARs, unused resource slots for 64-bit 822 * BARs, and non-movable resources, e.g., those described via 823 * Enhanced Allocation. 824 */ 825 if (!res->flags) 826 return; 827 828 if (res->flags & IORESOURCE_UNSET) 829 return; 830 831 if (res->flags & IORESOURCE_PCI_FIXED) 832 return; 833 834 pcibios_resource_to_bus(dev->bus, ®ion, res); 835 new = region.start; 836 new |= res->flags & ~PCI_BASE_ADDRESS_MEM_MASK; 837 838 reg = iov->pos + PCI_SRIOV_BAR + 4 * vf_bar; 839 pci_write_config_dword(dev, reg, new); 840 if (res->flags & IORESOURCE_MEM_64) { 841 new = region.start >> 16 >> 16; 842 pci_write_config_dword(dev, reg + 4, new); 843 } 844 } 845 846 resource_size_t __weak pcibios_iov_resource_alignment(struct pci_dev *dev, 847 int resno) 848 { 849 return pci_iov_resource_size(dev, resno); 850 } 851 852 /** 853 * pci_sriov_resource_alignment - get resource alignment for VF BAR 854 * @dev: the PCI device 855 * @resno: the resource number 856 * 857 * Returns the alignment of the VF BAR found in the SR-IOV capability. 858 * This is not the same as the resource size which is defined as 859 * the VF BAR size multiplied by the number of VFs. The alignment 860 * is just the VF BAR size. 861 */ 862 resource_size_t pci_sriov_resource_alignment(struct pci_dev *dev, int resno) 863 { 864 return pcibios_iov_resource_alignment(dev, resno); 865 } 866 867 /** 868 * pci_restore_iov_state - restore the state of the IOV capability 869 * @dev: the PCI device 870 */ 871 void pci_restore_iov_state(struct pci_dev *dev) 872 { 873 if (dev->is_physfn) 874 sriov_restore_state(dev); 875 } 876 877 /** 878 * pci_vf_drivers_autoprobe - set PF property drivers_autoprobe for VFs 879 * @dev: the PCI device 880 * @auto_probe: set VF drivers auto probe flag 881 */ 882 void pci_vf_drivers_autoprobe(struct pci_dev *dev, bool auto_probe) 883 { 884 if (dev->is_physfn) 885 dev->sriov->drivers_autoprobe = auto_probe; 886 } 887 888 /** 889 * pci_iov_bus_range - find bus range used by Virtual Function 890 * @bus: the PCI bus 891 * 892 * Returns max number of buses (exclude current one) used by Virtual 893 * Functions. 894 */ 895 int pci_iov_bus_range(struct pci_bus *bus) 896 { 897 int max = 0; 898 struct pci_dev *dev; 899 900 list_for_each_entry(dev, &bus->devices, bus_list) { 901 if (!dev->is_physfn) 902 continue; 903 if (dev->sriov->max_VF_buses > max) 904 max = dev->sriov->max_VF_buses; 905 } 906 907 return max ? max - bus->number : 0; 908 } 909 910 /** 911 * pci_enable_sriov - enable the SR-IOV capability 912 * @dev: the PCI device 913 * @nr_virtfn: number of virtual functions to enable 914 * 915 * Returns 0 on success, or negative on failure. 916 */ 917 int pci_enable_sriov(struct pci_dev *dev, int nr_virtfn) 918 { 919 might_sleep(); 920 921 if (!dev->is_physfn) 922 return -ENOSYS; 923 924 return sriov_enable(dev, nr_virtfn); 925 } 926 EXPORT_SYMBOL_GPL(pci_enable_sriov); 927 928 /** 929 * pci_disable_sriov - disable the SR-IOV capability 930 * @dev: the PCI device 931 */ 932 void pci_disable_sriov(struct pci_dev *dev) 933 { 934 might_sleep(); 935 936 if (!dev->is_physfn) 937 return; 938 939 sriov_disable(dev); 940 } 941 EXPORT_SYMBOL_GPL(pci_disable_sriov); 942 943 /** 944 * pci_num_vf - return number of VFs associated with a PF device_release_driver 945 * @dev: the PCI device 946 * 947 * Returns number of VFs, or 0 if SR-IOV is not enabled. 948 */ 949 int pci_num_vf(struct pci_dev *dev) 950 { 951 if (!dev->is_physfn) 952 return 0; 953 954 return dev->sriov->num_VFs; 955 } 956 EXPORT_SYMBOL_GPL(pci_num_vf); 957 958 /** 959 * pci_vfs_assigned - returns number of VFs are assigned to a guest 960 * @dev: the PCI device 961 * 962 * Returns number of VFs belonging to this device that are assigned to a guest. 963 * If device is not a physical function returns 0. 964 */ 965 int pci_vfs_assigned(struct pci_dev *dev) 966 { 967 struct pci_dev *vfdev; 968 unsigned int vfs_assigned = 0; 969 unsigned short dev_id; 970 971 /* only search if we are a PF */ 972 if (!dev->is_physfn) 973 return 0; 974 975 /* 976 * determine the device ID for the VFs, the vendor ID will be the 977 * same as the PF so there is no need to check for that one 978 */ 979 dev_id = dev->sriov->vf_device; 980 981 /* loop through all the VFs to see if we own any that are assigned */ 982 vfdev = pci_get_device(dev->vendor, dev_id, NULL); 983 while (vfdev) { 984 /* 985 * It is considered assigned if it is a virtual function with 986 * our dev as the physical function and the assigned bit is set 987 */ 988 if (vfdev->is_virtfn && (vfdev->physfn == dev) && 989 pci_is_dev_assigned(vfdev)) 990 vfs_assigned++; 991 992 vfdev = pci_get_device(dev->vendor, dev_id, vfdev); 993 } 994 995 return vfs_assigned; 996 } 997 EXPORT_SYMBOL_GPL(pci_vfs_assigned); 998 999 /** 1000 * pci_sriov_set_totalvfs -- reduce the TotalVFs available 1001 * @dev: the PCI PF device 1002 * @numvfs: number that should be used for TotalVFs supported 1003 * 1004 * Should be called from PF driver's probe routine with 1005 * device's mutex held. 1006 * 1007 * Returns 0 if PF is an SRIOV-capable device and 1008 * value of numvfs valid. If not a PF return -ENOSYS; 1009 * if numvfs is invalid return -EINVAL; 1010 * if VFs already enabled, return -EBUSY. 1011 */ 1012 int pci_sriov_set_totalvfs(struct pci_dev *dev, u16 numvfs) 1013 { 1014 if (!dev->is_physfn) 1015 return -ENOSYS; 1016 1017 if (numvfs > dev->sriov->total_VFs) 1018 return -EINVAL; 1019 1020 /* Shouldn't change if VFs already enabled */ 1021 if (dev->sriov->ctrl & PCI_SRIOV_CTRL_VFE) 1022 return -EBUSY; 1023 1024 dev->sriov->driver_max_VFs = numvfs; 1025 return 0; 1026 } 1027 EXPORT_SYMBOL_GPL(pci_sriov_set_totalvfs); 1028 1029 /** 1030 * pci_sriov_get_totalvfs -- get total VFs supported on this device 1031 * @dev: the PCI PF device 1032 * 1033 * For a PCIe device with SRIOV support, return the PCIe 1034 * SRIOV capability value of TotalVFs or the value of driver_max_VFs 1035 * if the driver reduced it. Otherwise 0. 1036 */ 1037 int pci_sriov_get_totalvfs(struct pci_dev *dev) 1038 { 1039 if (!dev->is_physfn) 1040 return 0; 1041 1042 return dev->sriov->driver_max_VFs; 1043 } 1044 EXPORT_SYMBOL_GPL(pci_sriov_get_totalvfs); 1045 1046 /** 1047 * pci_sriov_configure_simple - helper to configure SR-IOV 1048 * @dev: the PCI device 1049 * @nr_virtfn: number of virtual functions to enable, 0 to disable 1050 * 1051 * Enable or disable SR-IOV for devices that don't require any PF setup 1052 * before enabling SR-IOV. Return value is negative on error, or number of 1053 * VFs allocated on success. 1054 */ 1055 int pci_sriov_configure_simple(struct pci_dev *dev, int nr_virtfn) 1056 { 1057 int rc; 1058 1059 might_sleep(); 1060 1061 if (!dev->is_physfn) 1062 return -ENODEV; 1063 1064 if (pci_vfs_assigned(dev)) { 1065 pci_warn(dev, "Cannot modify SR-IOV while VFs are assigned\n"); 1066 return -EPERM; 1067 } 1068 1069 if (nr_virtfn == 0) { 1070 sriov_disable(dev); 1071 return 0; 1072 } 1073 1074 rc = sriov_enable(dev, nr_virtfn); 1075 if (rc < 0) 1076 return rc; 1077 1078 return nr_virtfn; 1079 } 1080 EXPORT_SYMBOL_GPL(pci_sriov_configure_simple); 1081