xref: /openbmc/linux/drivers/pci/iov.c (revision 19b6984e)
1d1b054daSYu Zhao /*
2d1b054daSYu Zhao  * drivers/pci/iov.c
3d1b054daSYu Zhao  *
4d1b054daSYu Zhao  * Copyright (C) 2009 Intel Corporation, Yu Zhao <yu.zhao@intel.com>
5d1b054daSYu Zhao  *
6d1b054daSYu Zhao  * PCI Express I/O Virtualization (IOV) support.
7d1b054daSYu Zhao  *   Single Root IOV 1.0
8302b4215SYu Zhao  *   Address Translation Service 1.0
9d1b054daSYu Zhao  */
10d1b054daSYu Zhao 
11d1b054daSYu Zhao #include <linux/pci.h>
125a0e3ad6STejun Heo #include <linux/slab.h>
13d1b054daSYu Zhao #include <linux/mutex.h>
14363c75dbSPaul Gortmaker #include <linux/export.h>
15d1b054daSYu Zhao #include <linux/string.h>
16d1b054daSYu Zhao #include <linux/delay.h>
175cdede24SJoerg Roedel #include <linux/pci-ats.h>
18d1b054daSYu Zhao #include "pci.h"
19d1b054daSYu Zhao 
20dd7cc44dSYu Zhao #define VIRTFN_ID_LEN	16
21d1b054daSYu Zhao 
22a28724b0SYu Zhao static inline u8 virtfn_bus(struct pci_dev *dev, int id)
23a28724b0SYu Zhao {
24a28724b0SYu Zhao 	return dev->bus->number + ((dev->devfn + dev->sriov->offset +
25a28724b0SYu Zhao 				    dev->sriov->stride * id) >> 8);
26a28724b0SYu Zhao }
27a28724b0SYu Zhao 
28a28724b0SYu Zhao static inline u8 virtfn_devfn(struct pci_dev *dev, int id)
29a28724b0SYu Zhao {
30a28724b0SYu Zhao 	return (dev->devfn + dev->sriov->offset +
31a28724b0SYu Zhao 		dev->sriov->stride * id) & 0xff;
32a28724b0SYu Zhao }
33a28724b0SYu Zhao 
34dd7cc44dSYu Zhao static struct pci_bus *virtfn_add_bus(struct pci_bus *bus, int busnr)
35dd7cc44dSYu Zhao {
36dd7cc44dSYu Zhao 	struct pci_bus *child;
37dd7cc44dSYu Zhao 
38dd7cc44dSYu Zhao 	if (bus->number == busnr)
39dd7cc44dSYu Zhao 		return bus;
40dd7cc44dSYu Zhao 
41dd7cc44dSYu Zhao 	child = pci_find_bus(pci_domain_nr(bus), busnr);
42dd7cc44dSYu Zhao 	if (child)
43dd7cc44dSYu Zhao 		return child;
44dd7cc44dSYu Zhao 
45dd7cc44dSYu Zhao 	child = pci_add_new_bus(bus, NULL, busnr);
46dd7cc44dSYu Zhao 	if (!child)
47dd7cc44dSYu Zhao 		return NULL;
48dd7cc44dSYu Zhao 
49b7eac055SYinghai Lu 	pci_bus_insert_busn_res(child, busnr, busnr);
50dd7cc44dSYu Zhao 
51dd7cc44dSYu Zhao 	return child;
52dd7cc44dSYu Zhao }
53dd7cc44dSYu Zhao 
54dc087f2fSJiang Liu static void virtfn_remove_bus(struct pci_bus *physbus, struct pci_bus *virtbus)
55dd7cc44dSYu Zhao {
56dc087f2fSJiang Liu 	if (physbus != virtbus && list_empty(&virtbus->devices))
57dc087f2fSJiang Liu 		pci_remove_bus(virtbus);
58dd7cc44dSYu Zhao }
59dd7cc44dSYu Zhao 
60dd7cc44dSYu Zhao static int virtfn_add(struct pci_dev *dev, int id, int reset)
61dd7cc44dSYu Zhao {
62dd7cc44dSYu Zhao 	int i;
63dc087f2fSJiang Liu 	int rc = -ENOMEM;
64dd7cc44dSYu Zhao 	u64 size;
65dd7cc44dSYu Zhao 	char buf[VIRTFN_ID_LEN];
66dd7cc44dSYu Zhao 	struct pci_dev *virtfn;
67dd7cc44dSYu Zhao 	struct resource *res;
68dd7cc44dSYu Zhao 	struct pci_sriov *iov = dev->sriov;
698b1fce04SGu Zheng 	struct pci_bus *bus;
70dd7cc44dSYu Zhao 
71dd7cc44dSYu Zhao 	mutex_lock(&iov->dev->sriov->lock);
728b1fce04SGu Zheng 	bus = virtfn_add_bus(dev->bus, virtfn_bus(dev, id));
73dc087f2fSJiang Liu 	if (!bus)
74dc087f2fSJiang Liu 		goto failed;
75dc087f2fSJiang Liu 
76dc087f2fSJiang Liu 	virtfn = pci_alloc_dev(bus);
77dc087f2fSJiang Liu 	if (!virtfn)
78dc087f2fSJiang Liu 		goto failed0;
79dc087f2fSJiang Liu 
80dd7cc44dSYu Zhao 	virtfn->devfn = virtfn_devfn(dev, id);
81dd7cc44dSYu Zhao 	virtfn->vendor = dev->vendor;
82dd7cc44dSYu Zhao 	pci_read_config_word(dev, iov->pos + PCI_SRIOV_VF_DID, &virtfn->device);
83dd7cc44dSYu Zhao 	pci_setup_device(virtfn);
84dd7cc44dSYu Zhao 	virtfn->dev.parent = dev->dev.parent;
85fbf33f51SXudong Hao 	virtfn->physfn = pci_dev_get(dev);
86fbf33f51SXudong Hao 	virtfn->is_virtfn = 1;
87dd7cc44dSYu Zhao 
88dd7cc44dSYu Zhao 	for (i = 0; i < PCI_SRIOV_NUM_BARS; i++) {
89dd7cc44dSYu Zhao 		res = dev->resource + PCI_IOV_RESOURCES + i;
90dd7cc44dSYu Zhao 		if (!res->parent)
91dd7cc44dSYu Zhao 			continue;
92dd7cc44dSYu Zhao 		virtfn->resource[i].name = pci_name(virtfn);
93dd7cc44dSYu Zhao 		virtfn->resource[i].flags = res->flags;
94dd7cc44dSYu Zhao 		size = resource_size(res);
956b136724SBjorn Helgaas 		do_div(size, iov->total_VFs);
96dd7cc44dSYu Zhao 		virtfn->resource[i].start = res->start + size * id;
97dd7cc44dSYu Zhao 		virtfn->resource[i].end = virtfn->resource[i].start + size - 1;
98dd7cc44dSYu Zhao 		rc = request_resource(res, &virtfn->resource[i]);
99dd7cc44dSYu Zhao 		BUG_ON(rc);
100dd7cc44dSYu Zhao 	}
101dd7cc44dSYu Zhao 
102dd7cc44dSYu Zhao 	if (reset)
1038c1c699fSYu Zhao 		__pci_reset_function(virtfn);
104dd7cc44dSYu Zhao 
105dd7cc44dSYu Zhao 	pci_device_add(virtfn, virtfn->bus);
106dd7cc44dSYu Zhao 	mutex_unlock(&iov->dev->sriov->lock);
107dd7cc44dSYu Zhao 
108dd7cc44dSYu Zhao 	rc = pci_bus_add_device(virtfn);
109dd7cc44dSYu Zhao 	sprintf(buf, "virtfn%u", id);
110dd7cc44dSYu Zhao 	rc = sysfs_create_link(&dev->dev.kobj, &virtfn->dev.kobj, buf);
111dd7cc44dSYu Zhao 	if (rc)
112dd7cc44dSYu Zhao 		goto failed1;
113dd7cc44dSYu Zhao 	rc = sysfs_create_link(&virtfn->dev.kobj, &dev->dev.kobj, "physfn");
114dd7cc44dSYu Zhao 	if (rc)
115dd7cc44dSYu Zhao 		goto failed2;
116dd7cc44dSYu Zhao 
117dd7cc44dSYu Zhao 	kobject_uevent(&virtfn->dev.kobj, KOBJ_CHANGE);
118dd7cc44dSYu Zhao 
119dd7cc44dSYu Zhao 	return 0;
120dd7cc44dSYu Zhao 
121dd7cc44dSYu Zhao failed2:
122dd7cc44dSYu Zhao 	sysfs_remove_link(&dev->dev.kobj, buf);
123dd7cc44dSYu Zhao failed1:
124dd7cc44dSYu Zhao 	pci_dev_put(dev);
125dd7cc44dSYu Zhao 	mutex_lock(&iov->dev->sriov->lock);
126210647afSYinghai Lu 	pci_stop_and_remove_bus_device(virtfn);
127dc087f2fSJiang Liu failed0:
128dc087f2fSJiang Liu 	virtfn_remove_bus(dev->bus, bus);
129dc087f2fSJiang Liu failed:
130dd7cc44dSYu Zhao 	mutex_unlock(&iov->dev->sriov->lock);
131dd7cc44dSYu Zhao 
132dd7cc44dSYu Zhao 	return rc;
133dd7cc44dSYu Zhao }
134dd7cc44dSYu Zhao 
135dd7cc44dSYu Zhao static void virtfn_remove(struct pci_dev *dev, int id, int reset)
136dd7cc44dSYu Zhao {
137dd7cc44dSYu Zhao 	char buf[VIRTFN_ID_LEN];
138dd7cc44dSYu Zhao 	struct pci_dev *virtfn;
139dd7cc44dSYu Zhao 	struct pci_sriov *iov = dev->sriov;
140dd7cc44dSYu Zhao 
141dc087f2fSJiang Liu 	virtfn = pci_get_domain_bus_and_slot(pci_domain_nr(dev->bus),
142dc087f2fSJiang Liu 					     virtfn_bus(dev, id),
143dc087f2fSJiang Liu 					     virtfn_devfn(dev, id));
144dd7cc44dSYu Zhao 	if (!virtfn)
145dd7cc44dSYu Zhao 		return;
146dd7cc44dSYu Zhao 
147dd7cc44dSYu Zhao 	if (reset) {
148dd7cc44dSYu Zhao 		device_release_driver(&virtfn->dev);
1498c1c699fSYu Zhao 		__pci_reset_function(virtfn);
150dd7cc44dSYu Zhao 	}
151dd7cc44dSYu Zhao 
152dd7cc44dSYu Zhao 	sprintf(buf, "virtfn%u", id);
153dd7cc44dSYu Zhao 	sysfs_remove_link(&dev->dev.kobj, buf);
15409cedbefSYinghai Lu 	/*
15509cedbefSYinghai Lu 	 * pci_stop_dev() could have been called for this virtfn already,
15609cedbefSYinghai Lu 	 * so the directory for the virtfn may have been removed before.
15709cedbefSYinghai Lu 	 * Double check to avoid spurious sysfs warnings.
15809cedbefSYinghai Lu 	 */
15909cedbefSYinghai Lu 	if (virtfn->dev.kobj.sd)
160dd7cc44dSYu Zhao 		sysfs_remove_link(&virtfn->dev.kobj, "physfn");
161dd7cc44dSYu Zhao 
162dd7cc44dSYu Zhao 	mutex_lock(&iov->dev->sriov->lock);
163210647afSYinghai Lu 	pci_stop_and_remove_bus_device(virtfn);
164dc087f2fSJiang Liu 	virtfn_remove_bus(dev->bus, virtfn->bus);
165dd7cc44dSYu Zhao 	mutex_unlock(&iov->dev->sriov->lock);
166dd7cc44dSYu Zhao 
167dc087f2fSJiang Liu 	/* balance pci_get_domain_bus_and_slot() */
168dc087f2fSJiang Liu 	pci_dev_put(virtfn);
169dd7cc44dSYu Zhao 	pci_dev_put(dev);
170dd7cc44dSYu Zhao }
171dd7cc44dSYu Zhao 
17274bb1bccSYu Zhao static int sriov_migration(struct pci_dev *dev)
17374bb1bccSYu Zhao {
17474bb1bccSYu Zhao 	u16 status;
17574bb1bccSYu Zhao 	struct pci_sriov *iov = dev->sriov;
17674bb1bccSYu Zhao 
1776b136724SBjorn Helgaas 	if (!iov->num_VFs)
17874bb1bccSYu Zhao 		return 0;
17974bb1bccSYu Zhao 
18074bb1bccSYu Zhao 	if (!(iov->cap & PCI_SRIOV_CAP_VFM))
18174bb1bccSYu Zhao 		return 0;
18274bb1bccSYu Zhao 
18374bb1bccSYu Zhao 	pci_read_config_word(dev, iov->pos + PCI_SRIOV_STATUS, &status);
18474bb1bccSYu Zhao 	if (!(status & PCI_SRIOV_STATUS_VFM))
18574bb1bccSYu Zhao 		return 0;
18674bb1bccSYu Zhao 
18774bb1bccSYu Zhao 	schedule_work(&iov->mtask);
18874bb1bccSYu Zhao 
18974bb1bccSYu Zhao 	return 1;
19074bb1bccSYu Zhao }
19174bb1bccSYu Zhao 
19274bb1bccSYu Zhao static void sriov_migration_task(struct work_struct *work)
19374bb1bccSYu Zhao {
19474bb1bccSYu Zhao 	int i;
19574bb1bccSYu Zhao 	u8 state;
19674bb1bccSYu Zhao 	u16 status;
19774bb1bccSYu Zhao 	struct pci_sriov *iov = container_of(work, struct pci_sriov, mtask);
19874bb1bccSYu Zhao 
1996b136724SBjorn Helgaas 	for (i = iov->initial_VFs; i < iov->num_VFs; i++) {
20074bb1bccSYu Zhao 		state = readb(iov->mstate + i);
20174bb1bccSYu Zhao 		if (state == PCI_SRIOV_VFM_MI) {
20274bb1bccSYu Zhao 			writeb(PCI_SRIOV_VFM_AV, iov->mstate + i);
20374bb1bccSYu Zhao 			state = readb(iov->mstate + i);
20474bb1bccSYu Zhao 			if (state == PCI_SRIOV_VFM_AV)
20574bb1bccSYu Zhao 				virtfn_add(iov->self, i, 1);
20674bb1bccSYu Zhao 		} else if (state == PCI_SRIOV_VFM_MO) {
20774bb1bccSYu Zhao 			virtfn_remove(iov->self, i, 1);
20874bb1bccSYu Zhao 			writeb(PCI_SRIOV_VFM_UA, iov->mstate + i);
20974bb1bccSYu Zhao 			state = readb(iov->mstate + i);
21074bb1bccSYu Zhao 			if (state == PCI_SRIOV_VFM_AV)
21174bb1bccSYu Zhao 				virtfn_add(iov->self, i, 0);
21274bb1bccSYu Zhao 		}
21374bb1bccSYu Zhao 	}
21474bb1bccSYu Zhao 
21574bb1bccSYu Zhao 	pci_read_config_word(iov->self, iov->pos + PCI_SRIOV_STATUS, &status);
21674bb1bccSYu Zhao 	status &= ~PCI_SRIOV_STATUS_VFM;
21774bb1bccSYu Zhao 	pci_write_config_word(iov->self, iov->pos + PCI_SRIOV_STATUS, status);
21874bb1bccSYu Zhao }
21974bb1bccSYu Zhao 
22074bb1bccSYu Zhao static int sriov_enable_migration(struct pci_dev *dev, int nr_virtfn)
22174bb1bccSYu Zhao {
22274bb1bccSYu Zhao 	int bir;
22374bb1bccSYu Zhao 	u32 table;
22474bb1bccSYu Zhao 	resource_size_t pa;
22574bb1bccSYu Zhao 	struct pci_sriov *iov = dev->sriov;
22674bb1bccSYu Zhao 
2276b136724SBjorn Helgaas 	if (nr_virtfn <= iov->initial_VFs)
22874bb1bccSYu Zhao 		return 0;
22974bb1bccSYu Zhao 
23074bb1bccSYu Zhao 	pci_read_config_dword(dev, iov->pos + PCI_SRIOV_VFM, &table);
23174bb1bccSYu Zhao 	bir = PCI_SRIOV_VFM_BIR(table);
23274bb1bccSYu Zhao 	if (bir > PCI_STD_RESOURCE_END)
23374bb1bccSYu Zhao 		return -EIO;
23474bb1bccSYu Zhao 
23574bb1bccSYu Zhao 	table = PCI_SRIOV_VFM_OFFSET(table);
23674bb1bccSYu Zhao 	if (table + nr_virtfn > pci_resource_len(dev, bir))
23774bb1bccSYu Zhao 		return -EIO;
23874bb1bccSYu Zhao 
23974bb1bccSYu Zhao 	pa = pci_resource_start(dev, bir) + table;
24074bb1bccSYu Zhao 	iov->mstate = ioremap(pa, nr_virtfn);
24174bb1bccSYu Zhao 	if (!iov->mstate)
24274bb1bccSYu Zhao 		return -ENOMEM;
24374bb1bccSYu Zhao 
24474bb1bccSYu Zhao 	INIT_WORK(&iov->mtask, sriov_migration_task);
24574bb1bccSYu Zhao 
24674bb1bccSYu Zhao 	iov->ctrl |= PCI_SRIOV_CTRL_VFM | PCI_SRIOV_CTRL_INTR;
24774bb1bccSYu Zhao 	pci_write_config_word(dev, iov->pos + PCI_SRIOV_CTRL, iov->ctrl);
24874bb1bccSYu Zhao 
24974bb1bccSYu Zhao 	return 0;
25074bb1bccSYu Zhao }
25174bb1bccSYu Zhao 
25274bb1bccSYu Zhao static void sriov_disable_migration(struct pci_dev *dev)
25374bb1bccSYu Zhao {
25474bb1bccSYu Zhao 	struct pci_sriov *iov = dev->sriov;
25574bb1bccSYu Zhao 
25674bb1bccSYu Zhao 	iov->ctrl &= ~(PCI_SRIOV_CTRL_VFM | PCI_SRIOV_CTRL_INTR);
25774bb1bccSYu Zhao 	pci_write_config_word(dev, iov->pos + PCI_SRIOV_CTRL, iov->ctrl);
25874bb1bccSYu Zhao 
25974bb1bccSYu Zhao 	cancel_work_sync(&iov->mtask);
26074bb1bccSYu Zhao 	iounmap(iov->mstate);
26174bb1bccSYu Zhao }
26274bb1bccSYu Zhao 
263dd7cc44dSYu Zhao static int sriov_enable(struct pci_dev *dev, int nr_virtfn)
264dd7cc44dSYu Zhao {
265dd7cc44dSYu Zhao 	int rc;
266dd7cc44dSYu Zhao 	int i, j;
267dd7cc44dSYu Zhao 	int nres;
268dd7cc44dSYu Zhao 	u16 offset, stride, initial;
269dd7cc44dSYu Zhao 	struct resource *res;
270dd7cc44dSYu Zhao 	struct pci_dev *pdev;
271dd7cc44dSYu Zhao 	struct pci_sriov *iov = dev->sriov;
272bbef98abSRam Pai 	int bars = 0;
273dd7cc44dSYu Zhao 
274dd7cc44dSYu Zhao 	if (!nr_virtfn)
275dd7cc44dSYu Zhao 		return 0;
276dd7cc44dSYu Zhao 
2776b136724SBjorn Helgaas 	if (iov->num_VFs)
278dd7cc44dSYu Zhao 		return -EINVAL;
279dd7cc44dSYu Zhao 
280dd7cc44dSYu Zhao 	pci_read_config_word(dev, iov->pos + PCI_SRIOV_INITIAL_VF, &initial);
2816b136724SBjorn Helgaas 	if (initial > iov->total_VFs ||
2826b136724SBjorn Helgaas 	    (!(iov->cap & PCI_SRIOV_CAP_VFM) && (initial != iov->total_VFs)))
283dd7cc44dSYu Zhao 		return -EIO;
284dd7cc44dSYu Zhao 
2856b136724SBjorn Helgaas 	if (nr_virtfn < 0 || nr_virtfn > iov->total_VFs ||
286dd7cc44dSYu Zhao 	    (!(iov->cap & PCI_SRIOV_CAP_VFM) && (nr_virtfn > initial)))
287dd7cc44dSYu Zhao 		return -EINVAL;
288dd7cc44dSYu Zhao 
289dd7cc44dSYu Zhao 	pci_read_config_word(dev, iov->pos + PCI_SRIOV_VF_OFFSET, &offset);
290dd7cc44dSYu Zhao 	pci_read_config_word(dev, iov->pos + PCI_SRIOV_VF_STRIDE, &stride);
291dd7cc44dSYu Zhao 	if (!offset || (nr_virtfn > 1 && !stride))
292dd7cc44dSYu Zhao 		return -EIO;
293dd7cc44dSYu Zhao 
294dd7cc44dSYu Zhao 	nres = 0;
295dd7cc44dSYu Zhao 	for (i = 0; i < PCI_SRIOV_NUM_BARS; i++) {
296bbef98abSRam Pai 		bars |= (1 << (i + PCI_IOV_RESOURCES));
297dd7cc44dSYu Zhao 		res = dev->resource + PCI_IOV_RESOURCES + i;
298dd7cc44dSYu Zhao 		if (res->parent)
299dd7cc44dSYu Zhao 			nres++;
300dd7cc44dSYu Zhao 	}
301dd7cc44dSYu Zhao 	if (nres != iov->nres) {
302dd7cc44dSYu Zhao 		dev_err(&dev->dev, "not enough MMIO resources for SR-IOV\n");
303dd7cc44dSYu Zhao 		return -ENOMEM;
304dd7cc44dSYu Zhao 	}
305dd7cc44dSYu Zhao 
306dd7cc44dSYu Zhao 	iov->offset = offset;
307dd7cc44dSYu Zhao 	iov->stride = stride;
308dd7cc44dSYu Zhao 
309b918c62eSYinghai Lu 	if (virtfn_bus(dev, nr_virtfn - 1) > dev->bus->busn_res.end) {
310dd7cc44dSYu Zhao 		dev_err(&dev->dev, "SR-IOV: bus number out of range\n");
311dd7cc44dSYu Zhao 		return -ENOMEM;
312dd7cc44dSYu Zhao 	}
313dd7cc44dSYu Zhao 
314bbef98abSRam Pai 	if (pci_enable_resources(dev, bars)) {
315bbef98abSRam Pai 		dev_err(&dev->dev, "SR-IOV: IOV BARS not allocated\n");
316bbef98abSRam Pai 		return -ENOMEM;
317bbef98abSRam Pai 	}
318bbef98abSRam Pai 
319dd7cc44dSYu Zhao 	if (iov->link != dev->devfn) {
320dd7cc44dSYu Zhao 		pdev = pci_get_slot(dev->bus, iov->link);
321dd7cc44dSYu Zhao 		if (!pdev)
322dd7cc44dSYu Zhao 			return -ENODEV;
323dd7cc44dSYu Zhao 
324dc087f2fSJiang Liu 		if (!pdev->is_physfn) {
325dd7cc44dSYu Zhao 			pci_dev_put(pdev);
326dd7cc44dSYu Zhao 			return -ENODEV;
327dc087f2fSJiang Liu 		}
328dd7cc44dSYu Zhao 
329dd7cc44dSYu Zhao 		rc = sysfs_create_link(&dev->dev.kobj,
330dd7cc44dSYu Zhao 					&pdev->dev.kobj, "dep_link");
331dc087f2fSJiang Liu 		pci_dev_put(pdev);
332dd7cc44dSYu Zhao 		if (rc)
333dd7cc44dSYu Zhao 			return rc;
334dd7cc44dSYu Zhao 	}
335dd7cc44dSYu Zhao 
33619b6984eSYijing Wang 	pci_write_config_word(dev, iov->pos + PCI_SRIOV_NUM_VF, nr_virtfn);
337dd7cc44dSYu Zhao 	iov->ctrl |= PCI_SRIOV_CTRL_VFE | PCI_SRIOV_CTRL_MSE;
338fb51ccbfSJan Kiszka 	pci_cfg_access_lock(dev);
339dd7cc44dSYu Zhao 	pci_write_config_word(dev, iov->pos + PCI_SRIOV_CTRL, iov->ctrl);
340dd7cc44dSYu Zhao 	msleep(100);
341fb51ccbfSJan Kiszka 	pci_cfg_access_unlock(dev);
342dd7cc44dSYu Zhao 
3436b136724SBjorn Helgaas 	iov->initial_VFs = initial;
344dd7cc44dSYu Zhao 	if (nr_virtfn < initial)
345dd7cc44dSYu Zhao 		initial = nr_virtfn;
346dd7cc44dSYu Zhao 
347dd7cc44dSYu Zhao 	for (i = 0; i < initial; i++) {
348dd7cc44dSYu Zhao 		rc = virtfn_add(dev, i, 0);
349dd7cc44dSYu Zhao 		if (rc)
350dd7cc44dSYu Zhao 			goto failed;
351dd7cc44dSYu Zhao 	}
352dd7cc44dSYu Zhao 
35374bb1bccSYu Zhao 	if (iov->cap & PCI_SRIOV_CAP_VFM) {
35474bb1bccSYu Zhao 		rc = sriov_enable_migration(dev, nr_virtfn);
35574bb1bccSYu Zhao 		if (rc)
35674bb1bccSYu Zhao 			goto failed;
35774bb1bccSYu Zhao 	}
35874bb1bccSYu Zhao 
359dd7cc44dSYu Zhao 	kobject_uevent(&dev->dev.kobj, KOBJ_CHANGE);
3606b136724SBjorn Helgaas 	iov->num_VFs = nr_virtfn;
361dd7cc44dSYu Zhao 
362dd7cc44dSYu Zhao 	return 0;
363dd7cc44dSYu Zhao 
364dd7cc44dSYu Zhao failed:
365dd7cc44dSYu Zhao 	for (j = 0; j < i; j++)
366dd7cc44dSYu Zhao 		virtfn_remove(dev, j, 0);
367dd7cc44dSYu Zhao 
368dd7cc44dSYu Zhao 	iov->ctrl &= ~(PCI_SRIOV_CTRL_VFE | PCI_SRIOV_CTRL_MSE);
369fb51ccbfSJan Kiszka 	pci_cfg_access_lock(dev);
370dd7cc44dSYu Zhao 	pci_write_config_word(dev, iov->pos + PCI_SRIOV_CTRL, iov->ctrl);
37119b6984eSYijing Wang 	pci_write_config_word(dev, iov->pos + PCI_SRIOV_NUM_VF, 0);
372dd7cc44dSYu Zhao 	ssleep(1);
373fb51ccbfSJan Kiszka 	pci_cfg_access_unlock(dev);
374dd7cc44dSYu Zhao 
375dd7cc44dSYu Zhao 	if (iov->link != dev->devfn)
376dd7cc44dSYu Zhao 		sysfs_remove_link(&dev->dev.kobj, "dep_link");
377dd7cc44dSYu Zhao 
378dd7cc44dSYu Zhao 	return rc;
379dd7cc44dSYu Zhao }
380dd7cc44dSYu Zhao 
381dd7cc44dSYu Zhao static void sriov_disable(struct pci_dev *dev)
382dd7cc44dSYu Zhao {
383dd7cc44dSYu Zhao 	int i;
384dd7cc44dSYu Zhao 	struct pci_sriov *iov = dev->sriov;
385dd7cc44dSYu Zhao 
3866b136724SBjorn Helgaas 	if (!iov->num_VFs)
387dd7cc44dSYu Zhao 		return;
388dd7cc44dSYu Zhao 
38974bb1bccSYu Zhao 	if (iov->cap & PCI_SRIOV_CAP_VFM)
39074bb1bccSYu Zhao 		sriov_disable_migration(dev);
39174bb1bccSYu Zhao 
3926b136724SBjorn Helgaas 	for (i = 0; i < iov->num_VFs; i++)
393dd7cc44dSYu Zhao 		virtfn_remove(dev, i, 0);
394dd7cc44dSYu Zhao 
395dd7cc44dSYu Zhao 	iov->ctrl &= ~(PCI_SRIOV_CTRL_VFE | PCI_SRIOV_CTRL_MSE);
396fb51ccbfSJan Kiszka 	pci_cfg_access_lock(dev);
397dd7cc44dSYu Zhao 	pci_write_config_word(dev, iov->pos + PCI_SRIOV_CTRL, iov->ctrl);
398dd7cc44dSYu Zhao 	ssleep(1);
399fb51ccbfSJan Kiszka 	pci_cfg_access_unlock(dev);
400dd7cc44dSYu Zhao 
401dd7cc44dSYu Zhao 	if (iov->link != dev->devfn)
402dd7cc44dSYu Zhao 		sysfs_remove_link(&dev->dev.kobj, "dep_link");
403dd7cc44dSYu Zhao 
4046b136724SBjorn Helgaas 	iov->num_VFs = 0;
40519b6984eSYijing Wang 	pci_write_config_word(dev, iov->pos + PCI_SRIOV_NUM_VF, 0);
406dd7cc44dSYu Zhao }
407dd7cc44dSYu Zhao 
408d1b054daSYu Zhao static int sriov_init(struct pci_dev *dev, int pos)
409d1b054daSYu Zhao {
410d1b054daSYu Zhao 	int i;
411d1b054daSYu Zhao 	int rc;
412d1b054daSYu Zhao 	int nres;
413d1b054daSYu Zhao 	u32 pgsz;
414d1b054daSYu Zhao 	u16 ctrl, total, offset, stride;
415d1b054daSYu Zhao 	struct pci_sriov *iov;
416d1b054daSYu Zhao 	struct resource *res;
417d1b054daSYu Zhao 	struct pci_dev *pdev;
418d1b054daSYu Zhao 
41962f87c0eSYijing Wang 	if (pci_pcie_type(dev) != PCI_EXP_TYPE_RC_END &&
42062f87c0eSYijing Wang 	    pci_pcie_type(dev) != PCI_EXP_TYPE_ENDPOINT)
421d1b054daSYu Zhao 		return -ENODEV;
422d1b054daSYu Zhao 
423d1b054daSYu Zhao 	pci_read_config_word(dev, pos + PCI_SRIOV_CTRL, &ctrl);
424d1b054daSYu Zhao 	if (ctrl & PCI_SRIOV_CTRL_VFE) {
425d1b054daSYu Zhao 		pci_write_config_word(dev, pos + PCI_SRIOV_CTRL, 0);
426d1b054daSYu Zhao 		ssleep(1);
427d1b054daSYu Zhao 	}
428d1b054daSYu Zhao 
429d1b054daSYu Zhao 	pci_read_config_word(dev, pos + PCI_SRIOV_TOTAL_VF, &total);
430d1b054daSYu Zhao 	if (!total)
431d1b054daSYu Zhao 		return 0;
432d1b054daSYu Zhao 
433d1b054daSYu Zhao 	ctrl = 0;
434d1b054daSYu Zhao 	list_for_each_entry(pdev, &dev->bus->devices, bus_list)
435d1b054daSYu Zhao 		if (pdev->is_physfn)
436d1b054daSYu Zhao 			goto found;
437d1b054daSYu Zhao 
438d1b054daSYu Zhao 	pdev = NULL;
439d1b054daSYu Zhao 	if (pci_ari_enabled(dev->bus))
440d1b054daSYu Zhao 		ctrl |= PCI_SRIOV_CTRL_ARI;
441d1b054daSYu Zhao 
442d1b054daSYu Zhao found:
443d1b054daSYu Zhao 	pci_write_config_word(dev, pos + PCI_SRIOV_CTRL, ctrl);
444d1b054daSYu Zhao 	pci_read_config_word(dev, pos + PCI_SRIOV_VF_OFFSET, &offset);
445d1b054daSYu Zhao 	pci_read_config_word(dev, pos + PCI_SRIOV_VF_STRIDE, &stride);
446d1b054daSYu Zhao 	if (!offset || (total > 1 && !stride))
447d1b054daSYu Zhao 		return -EIO;
448d1b054daSYu Zhao 
449d1b054daSYu Zhao 	pci_read_config_dword(dev, pos + PCI_SRIOV_SUP_PGSIZE, &pgsz);
450d1b054daSYu Zhao 	i = PAGE_SHIFT > 12 ? PAGE_SHIFT - 12 : 0;
451d1b054daSYu Zhao 	pgsz &= ~((1 << i) - 1);
452d1b054daSYu Zhao 	if (!pgsz)
453d1b054daSYu Zhao 		return -EIO;
454d1b054daSYu Zhao 
455d1b054daSYu Zhao 	pgsz &= ~(pgsz - 1);
4568161fe91SVaidyanathan Srinivasan 	pci_write_config_dword(dev, pos + PCI_SRIOV_SYS_PGSIZE, pgsz);
457d1b054daSYu Zhao 
458d1b054daSYu Zhao 	nres = 0;
459d1b054daSYu Zhao 	for (i = 0; i < PCI_SRIOV_NUM_BARS; i++) {
460d1b054daSYu Zhao 		res = dev->resource + PCI_IOV_RESOURCES + i;
461d1b054daSYu Zhao 		i += __pci_read_base(dev, pci_bar_unknown, res,
462d1b054daSYu Zhao 				     pos + PCI_SRIOV_BAR + i * 4);
463d1b054daSYu Zhao 		if (!res->flags)
464d1b054daSYu Zhao 			continue;
465d1b054daSYu Zhao 		if (resource_size(res) & (PAGE_SIZE - 1)) {
466d1b054daSYu Zhao 			rc = -EIO;
467d1b054daSYu Zhao 			goto failed;
468d1b054daSYu Zhao 		}
469d1b054daSYu Zhao 		res->end = res->start + resource_size(res) * total - 1;
470d1b054daSYu Zhao 		nres++;
471d1b054daSYu Zhao 	}
472d1b054daSYu Zhao 
473d1b054daSYu Zhao 	iov = kzalloc(sizeof(*iov), GFP_KERNEL);
474d1b054daSYu Zhao 	if (!iov) {
475d1b054daSYu Zhao 		rc = -ENOMEM;
476d1b054daSYu Zhao 		goto failed;
477d1b054daSYu Zhao 	}
478d1b054daSYu Zhao 
479d1b054daSYu Zhao 	iov->pos = pos;
480d1b054daSYu Zhao 	iov->nres = nres;
481d1b054daSYu Zhao 	iov->ctrl = ctrl;
4826b136724SBjorn Helgaas 	iov->total_VFs = total;
483d1b054daSYu Zhao 	iov->offset = offset;
484d1b054daSYu Zhao 	iov->stride = stride;
485d1b054daSYu Zhao 	iov->pgsz = pgsz;
486d1b054daSYu Zhao 	iov->self = dev;
487d1b054daSYu Zhao 	pci_read_config_dword(dev, pos + PCI_SRIOV_CAP, &iov->cap);
488d1b054daSYu Zhao 	pci_read_config_byte(dev, pos + PCI_SRIOV_FUNC_LINK, &iov->link);
48962f87c0eSYijing Wang 	if (pci_pcie_type(dev) == PCI_EXP_TYPE_RC_END)
4904d135dbeSYu Zhao 		iov->link = PCI_DEVFN(PCI_SLOT(dev->devfn), iov->link);
491d1b054daSYu Zhao 
492d1b054daSYu Zhao 	if (pdev)
493d1b054daSYu Zhao 		iov->dev = pci_dev_get(pdev);
494e277d2fcSYu Zhao 	else
495d1b054daSYu Zhao 		iov->dev = dev;
496e277d2fcSYu Zhao 
497d1b054daSYu Zhao 	mutex_init(&iov->lock);
498d1b054daSYu Zhao 
499d1b054daSYu Zhao 	dev->sriov = iov;
500d1b054daSYu Zhao 	dev->is_physfn = 1;
501d1b054daSYu Zhao 
502d1b054daSYu Zhao 	return 0;
503d1b054daSYu Zhao 
504d1b054daSYu Zhao failed:
505d1b054daSYu Zhao 	for (i = 0; i < PCI_SRIOV_NUM_BARS; i++) {
506d1b054daSYu Zhao 		res = dev->resource + PCI_IOV_RESOURCES + i;
507d1b054daSYu Zhao 		res->flags = 0;
508d1b054daSYu Zhao 	}
509d1b054daSYu Zhao 
510d1b054daSYu Zhao 	return rc;
511d1b054daSYu Zhao }
512d1b054daSYu Zhao 
513d1b054daSYu Zhao static void sriov_release(struct pci_dev *dev)
514d1b054daSYu Zhao {
5156b136724SBjorn Helgaas 	BUG_ON(dev->sriov->num_VFs);
516dd7cc44dSYu Zhao 
517e277d2fcSYu Zhao 	if (dev != dev->sriov->dev)
518d1b054daSYu Zhao 		pci_dev_put(dev->sriov->dev);
519d1b054daSYu Zhao 
520e277d2fcSYu Zhao 	mutex_destroy(&dev->sriov->lock);
521e277d2fcSYu Zhao 
522d1b054daSYu Zhao 	kfree(dev->sriov);
523d1b054daSYu Zhao 	dev->sriov = NULL;
524d1b054daSYu Zhao }
525d1b054daSYu Zhao 
5268c5cdb6aSYu Zhao static void sriov_restore_state(struct pci_dev *dev)
5278c5cdb6aSYu Zhao {
5288c5cdb6aSYu Zhao 	int i;
5298c5cdb6aSYu Zhao 	u16 ctrl;
5308c5cdb6aSYu Zhao 	struct pci_sriov *iov = dev->sriov;
5318c5cdb6aSYu Zhao 
5328c5cdb6aSYu Zhao 	pci_read_config_word(dev, iov->pos + PCI_SRIOV_CTRL, &ctrl);
5338c5cdb6aSYu Zhao 	if (ctrl & PCI_SRIOV_CTRL_VFE)
5348c5cdb6aSYu Zhao 		return;
5358c5cdb6aSYu Zhao 
5368c5cdb6aSYu Zhao 	for (i = PCI_IOV_RESOURCES; i <= PCI_IOV_RESOURCE_END; i++)
5378c5cdb6aSYu Zhao 		pci_update_resource(dev, i);
5388c5cdb6aSYu Zhao 
5398c5cdb6aSYu Zhao 	pci_write_config_dword(dev, iov->pos + PCI_SRIOV_SYS_PGSIZE, iov->pgsz);
5406b136724SBjorn Helgaas 	pci_write_config_word(dev, iov->pos + PCI_SRIOV_NUM_VF, iov->num_VFs);
5418c5cdb6aSYu Zhao 	pci_write_config_word(dev, iov->pos + PCI_SRIOV_CTRL, iov->ctrl);
5428c5cdb6aSYu Zhao 	if (iov->ctrl & PCI_SRIOV_CTRL_VFE)
5438c5cdb6aSYu Zhao 		msleep(100);
5448c5cdb6aSYu Zhao }
5458c5cdb6aSYu Zhao 
546d1b054daSYu Zhao /**
547d1b054daSYu Zhao  * pci_iov_init - initialize the IOV capability
548d1b054daSYu Zhao  * @dev: the PCI device
549d1b054daSYu Zhao  *
550d1b054daSYu Zhao  * Returns 0 on success, or negative on failure.
551d1b054daSYu Zhao  */
552d1b054daSYu Zhao int pci_iov_init(struct pci_dev *dev)
553d1b054daSYu Zhao {
554d1b054daSYu Zhao 	int pos;
555d1b054daSYu Zhao 
5565f4d91a1SKenji Kaneshige 	if (!pci_is_pcie(dev))
557d1b054daSYu Zhao 		return -ENODEV;
558d1b054daSYu Zhao 
559d1b054daSYu Zhao 	pos = pci_find_ext_capability(dev, PCI_EXT_CAP_ID_SRIOV);
560d1b054daSYu Zhao 	if (pos)
561d1b054daSYu Zhao 		return sriov_init(dev, pos);
562d1b054daSYu Zhao 
563d1b054daSYu Zhao 	return -ENODEV;
564d1b054daSYu Zhao }
565d1b054daSYu Zhao 
566d1b054daSYu Zhao /**
567d1b054daSYu Zhao  * pci_iov_release - release resources used by the IOV capability
568d1b054daSYu Zhao  * @dev: the PCI device
569d1b054daSYu Zhao  */
570d1b054daSYu Zhao void pci_iov_release(struct pci_dev *dev)
571d1b054daSYu Zhao {
572d1b054daSYu Zhao 	if (dev->is_physfn)
573d1b054daSYu Zhao 		sriov_release(dev);
574d1b054daSYu Zhao }
575d1b054daSYu Zhao 
576d1b054daSYu Zhao /**
577d1b054daSYu Zhao  * pci_iov_resource_bar - get position of the SR-IOV BAR
578d1b054daSYu Zhao  * @dev: the PCI device
579d1b054daSYu Zhao  * @resno: the resource number
580d1b054daSYu Zhao  * @type: the BAR type to be filled in
581d1b054daSYu Zhao  *
582d1b054daSYu Zhao  * Returns position of the BAR encapsulated in the SR-IOV capability.
583d1b054daSYu Zhao  */
584d1b054daSYu Zhao int pci_iov_resource_bar(struct pci_dev *dev, int resno,
585d1b054daSYu Zhao 			 enum pci_bar_type *type)
586d1b054daSYu Zhao {
587d1b054daSYu Zhao 	if (resno < PCI_IOV_RESOURCES || resno > PCI_IOV_RESOURCE_END)
588d1b054daSYu Zhao 		return 0;
589d1b054daSYu Zhao 
590d1b054daSYu Zhao 	BUG_ON(!dev->is_physfn);
591d1b054daSYu Zhao 
592d1b054daSYu Zhao 	*type = pci_bar_unknown;
593d1b054daSYu Zhao 
594d1b054daSYu Zhao 	return dev->sriov->pos + PCI_SRIOV_BAR +
595d1b054daSYu Zhao 		4 * (resno - PCI_IOV_RESOURCES);
596d1b054daSYu Zhao }
5978c5cdb6aSYu Zhao 
5988c5cdb6aSYu Zhao /**
5996faf17f6SChris Wright  * pci_sriov_resource_alignment - get resource alignment for VF BAR
6006faf17f6SChris Wright  * @dev: the PCI device
6016faf17f6SChris Wright  * @resno: the resource number
6026faf17f6SChris Wright  *
6036faf17f6SChris Wright  * Returns the alignment of the VF BAR found in the SR-IOV capability.
6046faf17f6SChris Wright  * This is not the same as the resource size which is defined as
6056faf17f6SChris Wright  * the VF BAR size multiplied by the number of VFs.  The alignment
6066faf17f6SChris Wright  * is just the VF BAR size.
6076faf17f6SChris Wright  */
6080e52247aSCam Macdonell resource_size_t pci_sriov_resource_alignment(struct pci_dev *dev, int resno)
6096faf17f6SChris Wright {
6106faf17f6SChris Wright 	struct resource tmp;
6116faf17f6SChris Wright 	enum pci_bar_type type;
6126faf17f6SChris Wright 	int reg = pci_iov_resource_bar(dev, resno, &type);
6136faf17f6SChris Wright 
6146faf17f6SChris Wright 	if (!reg)
6156faf17f6SChris Wright 		return 0;
6166faf17f6SChris Wright 
6176faf17f6SChris Wright 	 __pci_read_base(dev, type, &tmp, reg);
6186faf17f6SChris Wright 	return resource_alignment(&tmp);
6196faf17f6SChris Wright }
6206faf17f6SChris Wright 
6216faf17f6SChris Wright /**
6228c5cdb6aSYu Zhao  * pci_restore_iov_state - restore the state of the IOV capability
6238c5cdb6aSYu Zhao  * @dev: the PCI device
6248c5cdb6aSYu Zhao  */
6258c5cdb6aSYu Zhao void pci_restore_iov_state(struct pci_dev *dev)
6268c5cdb6aSYu Zhao {
6278c5cdb6aSYu Zhao 	if (dev->is_physfn)
6288c5cdb6aSYu Zhao 		sriov_restore_state(dev);
6298c5cdb6aSYu Zhao }
630a28724b0SYu Zhao 
631a28724b0SYu Zhao /**
632a28724b0SYu Zhao  * pci_iov_bus_range - find bus range used by Virtual Function
633a28724b0SYu Zhao  * @bus: the PCI bus
634a28724b0SYu Zhao  *
635a28724b0SYu Zhao  * Returns max number of buses (exclude current one) used by Virtual
636a28724b0SYu Zhao  * Functions.
637a28724b0SYu Zhao  */
638a28724b0SYu Zhao int pci_iov_bus_range(struct pci_bus *bus)
639a28724b0SYu Zhao {
640a28724b0SYu Zhao 	int max = 0;
641a28724b0SYu Zhao 	u8 busnr;
642a28724b0SYu Zhao 	struct pci_dev *dev;
643a28724b0SYu Zhao 
644a28724b0SYu Zhao 	list_for_each_entry(dev, &bus->devices, bus_list) {
645a28724b0SYu Zhao 		if (!dev->is_physfn)
646a28724b0SYu Zhao 			continue;
6476b136724SBjorn Helgaas 		busnr = virtfn_bus(dev, dev->sriov->total_VFs - 1);
648a28724b0SYu Zhao 		if (busnr > max)
649a28724b0SYu Zhao 			max = busnr;
650a28724b0SYu Zhao 	}
651a28724b0SYu Zhao 
652a28724b0SYu Zhao 	return max ? max - bus->number : 0;
653a28724b0SYu Zhao }
654dd7cc44dSYu Zhao 
655dd7cc44dSYu Zhao /**
656dd7cc44dSYu Zhao  * pci_enable_sriov - enable the SR-IOV capability
657dd7cc44dSYu Zhao  * @dev: the PCI device
65852a8873bSRandy Dunlap  * @nr_virtfn: number of virtual functions to enable
659dd7cc44dSYu Zhao  *
660dd7cc44dSYu Zhao  * Returns 0 on success, or negative on failure.
661dd7cc44dSYu Zhao  */
662dd7cc44dSYu Zhao int pci_enable_sriov(struct pci_dev *dev, int nr_virtfn)
663dd7cc44dSYu Zhao {
664dd7cc44dSYu Zhao 	might_sleep();
665dd7cc44dSYu Zhao 
666dd7cc44dSYu Zhao 	if (!dev->is_physfn)
667dd7cc44dSYu Zhao 		return -ENODEV;
668dd7cc44dSYu Zhao 
669dd7cc44dSYu Zhao 	return sriov_enable(dev, nr_virtfn);
670dd7cc44dSYu Zhao }
671dd7cc44dSYu Zhao EXPORT_SYMBOL_GPL(pci_enable_sriov);
672dd7cc44dSYu Zhao 
673dd7cc44dSYu Zhao /**
674dd7cc44dSYu Zhao  * pci_disable_sriov - disable the SR-IOV capability
675dd7cc44dSYu Zhao  * @dev: the PCI device
676dd7cc44dSYu Zhao  */
677dd7cc44dSYu Zhao void pci_disable_sriov(struct pci_dev *dev)
678dd7cc44dSYu Zhao {
679dd7cc44dSYu Zhao 	might_sleep();
680dd7cc44dSYu Zhao 
681dd7cc44dSYu Zhao 	if (!dev->is_physfn)
682dd7cc44dSYu Zhao 		return;
683dd7cc44dSYu Zhao 
684dd7cc44dSYu Zhao 	sriov_disable(dev);
685dd7cc44dSYu Zhao }
686dd7cc44dSYu Zhao EXPORT_SYMBOL_GPL(pci_disable_sriov);
68774bb1bccSYu Zhao 
68874bb1bccSYu Zhao /**
68974bb1bccSYu Zhao  * pci_sriov_migration - notify SR-IOV core of Virtual Function Migration
69074bb1bccSYu Zhao  * @dev: the PCI device
69174bb1bccSYu Zhao  *
69274bb1bccSYu Zhao  * Returns IRQ_HANDLED if the IRQ is handled, or IRQ_NONE if not.
69374bb1bccSYu Zhao  *
69474bb1bccSYu Zhao  * Physical Function driver is responsible to register IRQ handler using
69574bb1bccSYu Zhao  * VF Migration Interrupt Message Number, and call this function when the
69674bb1bccSYu Zhao  * interrupt is generated by the hardware.
69774bb1bccSYu Zhao  */
69874bb1bccSYu Zhao irqreturn_t pci_sriov_migration(struct pci_dev *dev)
69974bb1bccSYu Zhao {
70074bb1bccSYu Zhao 	if (!dev->is_physfn)
70174bb1bccSYu Zhao 		return IRQ_NONE;
70274bb1bccSYu Zhao 
70374bb1bccSYu Zhao 	return sriov_migration(dev) ? IRQ_HANDLED : IRQ_NONE;
70474bb1bccSYu Zhao }
70574bb1bccSYu Zhao EXPORT_SYMBOL_GPL(pci_sriov_migration);
706302b4215SYu Zhao 
707fb8a0d9dSWilliams, Mitch A /**
708fb8a0d9dSWilliams, Mitch A  * pci_num_vf - return number of VFs associated with a PF device_release_driver
709fb8a0d9dSWilliams, Mitch A  * @dev: the PCI device
710fb8a0d9dSWilliams, Mitch A  *
711fb8a0d9dSWilliams, Mitch A  * Returns number of VFs, or 0 if SR-IOV is not enabled.
712fb8a0d9dSWilliams, Mitch A  */
713fb8a0d9dSWilliams, Mitch A int pci_num_vf(struct pci_dev *dev)
714fb8a0d9dSWilliams, Mitch A {
7151452cd76SBjorn Helgaas 	if (!dev->is_physfn)
716fb8a0d9dSWilliams, Mitch A 		return 0;
7171452cd76SBjorn Helgaas 
7186b136724SBjorn Helgaas 	return dev->sriov->num_VFs;
719fb8a0d9dSWilliams, Mitch A }
720fb8a0d9dSWilliams, Mitch A EXPORT_SYMBOL_GPL(pci_num_vf);
721bff73156SDonald Dutile 
722bff73156SDonald Dutile /**
7235a8eb242SAlexander Duyck  * pci_vfs_assigned - returns number of VFs are assigned to a guest
7245a8eb242SAlexander Duyck  * @dev: the PCI device
7255a8eb242SAlexander Duyck  *
7265a8eb242SAlexander Duyck  * Returns number of VFs belonging to this device that are assigned to a guest.
7275a8eb242SAlexander Duyck  * If device is not a physical function returns -ENODEV.
7285a8eb242SAlexander Duyck  */
7295a8eb242SAlexander Duyck int pci_vfs_assigned(struct pci_dev *dev)
7305a8eb242SAlexander Duyck {
7315a8eb242SAlexander Duyck 	struct pci_dev *vfdev;
7325a8eb242SAlexander Duyck 	unsigned int vfs_assigned = 0;
7335a8eb242SAlexander Duyck 	unsigned short dev_id;
7345a8eb242SAlexander Duyck 
7355a8eb242SAlexander Duyck 	/* only search if we are a PF */
7365a8eb242SAlexander Duyck 	if (!dev->is_physfn)
7375a8eb242SAlexander Duyck 		return 0;
7385a8eb242SAlexander Duyck 
7395a8eb242SAlexander Duyck 	/*
7405a8eb242SAlexander Duyck 	 * determine the device ID for the VFs, the vendor ID will be the
7415a8eb242SAlexander Duyck 	 * same as the PF so there is no need to check for that one
7425a8eb242SAlexander Duyck 	 */
7435a8eb242SAlexander Duyck 	pci_read_config_word(dev, dev->sriov->pos + PCI_SRIOV_VF_DID, &dev_id);
7445a8eb242SAlexander Duyck 
7455a8eb242SAlexander Duyck 	/* loop through all the VFs to see if we own any that are assigned */
7465a8eb242SAlexander Duyck 	vfdev = pci_get_device(dev->vendor, dev_id, NULL);
7475a8eb242SAlexander Duyck 	while (vfdev) {
7485a8eb242SAlexander Duyck 		/*
7495a8eb242SAlexander Duyck 		 * It is considered assigned if it is a virtual function with
7505a8eb242SAlexander Duyck 		 * our dev as the physical function and the assigned bit is set
7515a8eb242SAlexander Duyck 		 */
7525a8eb242SAlexander Duyck 		if (vfdev->is_virtfn && (vfdev->physfn == dev) &&
7535a8eb242SAlexander Duyck 		    (vfdev->dev_flags & PCI_DEV_FLAGS_ASSIGNED))
7545a8eb242SAlexander Duyck 			vfs_assigned++;
7555a8eb242SAlexander Duyck 
7565a8eb242SAlexander Duyck 		vfdev = pci_get_device(dev->vendor, dev_id, vfdev);
7575a8eb242SAlexander Duyck 	}
7585a8eb242SAlexander Duyck 
7595a8eb242SAlexander Duyck 	return vfs_assigned;
7605a8eb242SAlexander Duyck }
7615a8eb242SAlexander Duyck EXPORT_SYMBOL_GPL(pci_vfs_assigned);
7625a8eb242SAlexander Duyck 
7635a8eb242SAlexander Duyck /**
764bff73156SDonald Dutile  * pci_sriov_set_totalvfs -- reduce the TotalVFs available
765bff73156SDonald Dutile  * @dev: the PCI PF device
7662094f167SRandy Dunlap  * @numvfs: number that should be used for TotalVFs supported
767bff73156SDonald Dutile  *
768bff73156SDonald Dutile  * Should be called from PF driver's probe routine with
769bff73156SDonald Dutile  * device's mutex held.
770bff73156SDonald Dutile  *
771bff73156SDonald Dutile  * Returns 0 if PF is an SRIOV-capable device and
772bff73156SDonald Dutile  * value of numvfs valid. If not a PF with VFS, return -EINVAL;
773bff73156SDonald Dutile  * if VFs already enabled, return -EBUSY.
774bff73156SDonald Dutile  */
775bff73156SDonald Dutile int pci_sriov_set_totalvfs(struct pci_dev *dev, u16 numvfs)
776bff73156SDonald Dutile {
7771452cd76SBjorn Helgaas 	if (!dev->is_physfn || (numvfs > dev->sriov->total_VFs))
778bff73156SDonald Dutile 		return -EINVAL;
779bff73156SDonald Dutile 
780bff73156SDonald Dutile 	/* Shouldn't change if VFs already enabled */
781bff73156SDonald Dutile 	if (dev->sriov->ctrl & PCI_SRIOV_CTRL_VFE)
782bff73156SDonald Dutile 		return -EBUSY;
783bff73156SDonald Dutile 	else
7846b136724SBjorn Helgaas 		dev->sriov->driver_max_VFs = numvfs;
785bff73156SDonald Dutile 
786bff73156SDonald Dutile 	return 0;
787bff73156SDonald Dutile }
788bff73156SDonald Dutile EXPORT_SYMBOL_GPL(pci_sriov_set_totalvfs);
789bff73156SDonald Dutile 
790bff73156SDonald Dutile /**
791ddc191f5SJonghwan Choi  * pci_sriov_get_totalvfs -- get total VFs supported on this device
792bff73156SDonald Dutile  * @dev: the PCI PF device
793bff73156SDonald Dutile  *
794bff73156SDonald Dutile  * For a PCIe device with SRIOV support, return the PCIe
7956b136724SBjorn Helgaas  * SRIOV capability value of TotalVFs or the value of driver_max_VFs
796bff73156SDonald Dutile  * if the driver reduced it.  Otherwise, -EINVAL.
797bff73156SDonald Dutile  */
798bff73156SDonald Dutile int pci_sriov_get_totalvfs(struct pci_dev *dev)
799bff73156SDonald Dutile {
8001452cd76SBjorn Helgaas 	if (!dev->is_physfn)
801bff73156SDonald Dutile 		return -EINVAL;
802bff73156SDonald Dutile 
8036b136724SBjorn Helgaas 	if (dev->sriov->driver_max_VFs)
8046b136724SBjorn Helgaas 		return dev->sriov->driver_max_VFs;
8051452cd76SBjorn Helgaas 
8066b136724SBjorn Helgaas 	return dev->sriov->total_VFs;
807bff73156SDonald Dutile }
808bff73156SDonald Dutile EXPORT_SYMBOL_GPL(pci_sriov_get_totalvfs);
809