^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Copyright IBM Corp. 2020
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Author(s):
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * Niklas Schnelle <schnelle@linux.ibm.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #define KMSG_COMPONENT "zpci"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/pci.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include "pci_iov.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) static struct resource iov_res = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) .name = "PCI IOV res",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) .start = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) .end = -1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) .flags = IORESOURCE_MEM,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) void zpci_iov_map_resources(struct pci_dev *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) resource_size_t len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) for (i = 0; i < PCI_SRIOV_NUM_BARS; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) int bar = i + PCI_IOV_RESOURCES;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) len = pci_resource_len(pdev, bar);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) if (!len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) pdev->resource[bar].parent = &iov_res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) void zpci_iov_remove_virtfn(struct pci_dev *pdev, int vfn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) pci_lock_rescan_remove();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) /* Linux' vfid's start at 0 vfn at 1 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) pci_iov_remove_virtfn(pdev->physfn, vfn - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) pci_unlock_rescan_remove();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) static int zpci_iov_link_virtfn(struct pci_dev *pdev, struct pci_dev *virtfn, int vfid)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) rc = pci_iov_sysfs_link(pdev, virtfn, vfid);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) virtfn->is_virtfn = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) virtfn->multifunction = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) virtfn->physfn = pci_dev_get(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) int zpci_iov_setup_virtfn(struct zpci_bus *zbus, struct pci_dev *virtfn, int vfn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) int i, cand_devfn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) struct zpci_dev *zdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) struct pci_dev *pdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) int vfid = vfn - 1; /* Linux' vfid's start at 0 vfn at 1*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) int rc = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) if (!zbus->multifunction)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) /* If the parent PF for the given VF is also configured in the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) * instance, it must be on the same zbus.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) * We can then identify the parent PF by checking what
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) * devfn the VF would have if it belonged to that PF using the PF's
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) * stride and offset. Only if this candidate devfn matches the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) * actual devfn will we link both functions.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) for (i = 0; i < ZPCI_FUNCTIONS_PER_BUS; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) zdev = zbus->function[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) if (zdev && zdev->is_physfn) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) pdev = pci_get_slot(zbus->bus, zdev->devfn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) if (!pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) cand_devfn = pci_iov_virtfn_devfn(pdev, vfid);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) if (cand_devfn == virtfn->devfn) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) rc = zpci_iov_link_virtfn(pdev, virtfn, vfid);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) /* balance pci_get_slot() */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) pci_dev_put(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) /* balance pci_get_slot() */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) pci_dev_put(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) }
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags