|
@@ -19,16 +19,20 @@
|
|
|
|
|
|
#define VIRTFN_ID_LEN 16
|
|
#define VIRTFN_ID_LEN 16
|
|
|
|
|
|
-static inline u8 virtfn_bus(struct pci_dev *dev, int id)
|
|
|
|
|
|
+int pci_iov_virtfn_bus(struct pci_dev *dev, int vf_id)
|
|
{
|
|
{
|
|
|
|
+ if (!dev->is_physfn)
|
|
|
|
+ return -EINVAL;
|
|
return dev->bus->number + ((dev->devfn + dev->sriov->offset +
|
|
return dev->bus->number + ((dev->devfn + dev->sriov->offset +
|
|
- dev->sriov->stride * id) >> 8);
|
|
|
|
|
|
+ dev->sriov->stride * vf_id) >> 8);
|
|
}
|
|
}
|
|
|
|
|
|
-static inline u8 virtfn_devfn(struct pci_dev *dev, int id)
|
|
|
|
|
|
+int pci_iov_virtfn_devfn(struct pci_dev *dev, int vf_id)
|
|
{
|
|
{
|
|
|
|
+ if (!dev->is_physfn)
|
|
|
|
+ return -EINVAL;
|
|
return (dev->devfn + dev->sriov->offset +
|
|
return (dev->devfn + dev->sriov->offset +
|
|
- dev->sriov->stride * id) & 0xff;
|
|
|
|
|
|
+ dev->sriov->stride * vf_id) & 0xff;
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
/*
|
|
@@ -58,11 +62,11 @@ static inline u8 virtfn_max_buses(struct pci_dev *dev)
|
|
struct pci_sriov *iov = dev->sriov;
|
|
struct pci_sriov *iov = dev->sriov;
|
|
int nr_virtfn;
|
|
int nr_virtfn;
|
|
u8 max = 0;
|
|
u8 max = 0;
|
|
- u8 busnr;
|
|
|
|
|
|
+ int busnr;
|
|
|
|
|
|
for (nr_virtfn = 1; nr_virtfn <= iov->total_VFs; nr_virtfn++) {
|
|
for (nr_virtfn = 1; nr_virtfn <= iov->total_VFs; nr_virtfn++) {
|
|
pci_iov_set_numvfs(dev, nr_virtfn);
|
|
pci_iov_set_numvfs(dev, nr_virtfn);
|
|
- busnr = virtfn_bus(dev, nr_virtfn - 1);
|
|
|
|
|
|
+ busnr = pci_iov_virtfn_bus(dev, nr_virtfn - 1);
|
|
if (busnr > max)
|
|
if (busnr > max)
|
|
max = busnr;
|
|
max = busnr;
|
|
}
|
|
}
|
|
@@ -116,7 +120,7 @@ static int virtfn_add(struct pci_dev *dev, int id, int reset)
|
|
struct pci_bus *bus;
|
|
struct pci_bus *bus;
|
|
|
|
|
|
mutex_lock(&iov->dev->sriov->lock);
|
|
mutex_lock(&iov->dev->sriov->lock);
|
|
- bus = virtfn_add_bus(dev->bus, virtfn_bus(dev, id));
|
|
|
|
|
|
+ bus = virtfn_add_bus(dev->bus, pci_iov_virtfn_bus(dev, id));
|
|
if (!bus)
|
|
if (!bus)
|
|
goto failed;
|
|
goto failed;
|
|
|
|
|
|
@@ -124,7 +128,7 @@ static int virtfn_add(struct pci_dev *dev, int id, int reset)
|
|
if (!virtfn)
|
|
if (!virtfn)
|
|
goto failed0;
|
|
goto failed0;
|
|
|
|
|
|
- virtfn->devfn = virtfn_devfn(dev, id);
|
|
|
|
|
|
+ virtfn->devfn = pci_iov_virtfn_devfn(dev, id);
|
|
virtfn->vendor = dev->vendor;
|
|
virtfn->vendor = dev->vendor;
|
|
pci_read_config_word(dev, iov->pos + PCI_SRIOV_VF_DID, &virtfn->device);
|
|
pci_read_config_word(dev, iov->pos + PCI_SRIOV_VF_DID, &virtfn->device);
|
|
pci_setup_device(virtfn);
|
|
pci_setup_device(virtfn);
|
|
@@ -186,8 +190,8 @@ static void virtfn_remove(struct pci_dev *dev, int id, int reset)
|
|
struct pci_sriov *iov = dev->sriov;
|
|
struct pci_sriov *iov = dev->sriov;
|
|
|
|
|
|
virtfn = pci_get_domain_bus_and_slot(pci_domain_nr(dev->bus),
|
|
virtfn = pci_get_domain_bus_and_slot(pci_domain_nr(dev->bus),
|
|
- virtfn_bus(dev, id),
|
|
|
|
- virtfn_devfn(dev, id));
|
|
|
|
|
|
+ pci_iov_virtfn_bus(dev, id),
|
|
|
|
+ pci_iov_virtfn_devfn(dev, id));
|
|
if (!virtfn)
|
|
if (!virtfn)
|
|
return;
|
|
return;
|
|
|
|
|
|
@@ -226,7 +230,7 @@ static int sriov_enable(struct pci_dev *dev, int nr_virtfn)
|
|
struct pci_dev *pdev;
|
|
struct pci_dev *pdev;
|
|
struct pci_sriov *iov = dev->sriov;
|
|
struct pci_sriov *iov = dev->sriov;
|
|
int bars = 0;
|
|
int bars = 0;
|
|
- u8 bus;
|
|
|
|
|
|
+ int bus;
|
|
|
|
|
|
if (!nr_virtfn)
|
|
if (!nr_virtfn)
|
|
return 0;
|
|
return 0;
|
|
@@ -263,7 +267,7 @@ static int sriov_enable(struct pci_dev *dev, int nr_virtfn)
|
|
iov->offset = offset;
|
|
iov->offset = offset;
|
|
iov->stride = stride;
|
|
iov->stride = stride;
|
|
|
|
|
|
- bus = virtfn_bus(dev, nr_virtfn - 1);
|
|
|
|
|
|
+ bus = pci_iov_virtfn_bus(dev, nr_virtfn - 1);
|
|
if (bus > dev->bus->busn_res.end) {
|
|
if (bus > dev->bus->busn_res.end) {
|
|
dev_err(&dev->dev, "can't enable %d VFs (bus %02x out of range of %pR)\n",
|
|
dev_err(&dev->dev, "can't enable %d VFs (bus %02x out of range of %pR)\n",
|
|
nr_virtfn, bus, &dev->bus->busn_res);
|
|
nr_virtfn, bus, &dev->bus->busn_res);
|