[linux.git] / drivers / xen / pci.c

/*
 * Copyright (c) 2009, Intel Corporation.
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms and conditions of the GNU General Public License,
 * version 2, as published by the Free Software Foundation.
 *
 * This program is distributed in the hope it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 *
 * You should have received a copy of the GNU General Public License along with
 * this program; if not, write to the Free Software Foundation, Inc., 59 Temple
 * Place - Suite 330, Boston, MA 02111-1307 USA.
 *
 * Author: Weidong Han <[email protected]>
 */

#include <linux/pci.h>
#include <linux/acpi.h>
#include <linux/pci-acpi.h>
#include <xen/xen.h>
#include <xen/interface/physdev.h>
#include <xen/interface/xen.h>

#include <asm/xen/hypervisor.h>
#include <asm/xen/hypercall.h>
#include "../pci/pci.h"
#ifdef CONFIG_PCI_MMCONFIG
#include <asm/pci_x86.h>
#endif

static bool __read_mostly pci_seg_supported = true;

static int xen_add_device(struct device *dev)
{
	int r;
	struct pci_dev *pci_dev = to_pci_dev(dev);
#ifdef CONFIG_PCI_IOV
	struct pci_dev *physfn = pci_dev->physfn;
#endif

	if (pci_seg_supported) {
		struct {
			struct physdev_pci_device_add add;
			uint32_t pxm;
		} add_ext = {
			.add.seg = pci_domain_nr(pci_dev->bus),
			.add.bus = pci_dev->bus->number,
			.add.devfn = pci_dev->devfn
		};
		struct physdev_pci_device_add *add = &add_ext.add;

#ifdef CONFIG_ACPI
		acpi_handle handle;
#endif

#ifdef CONFIG_PCI_IOV
		if (pci_dev->is_virtfn) {
			add->flags = XEN_PCI_DEV_VIRTFN;
			add->physfn.bus = physfn->bus->number;
			add->physfn.devfn = physfn->devfn;
		} else
#endif
		if (pci_ari_enabled(pci_dev->bus) && PCI_SLOT(pci_dev->devfn))
			add->flags = XEN_PCI_DEV_EXTFN;

#ifdef CONFIG_ACPI
		handle = ACPI_HANDLE(&pci_dev->dev);
#ifdef CONFIG_PCI_IOV
		if (!handle && pci_dev->is_virtfn)
			handle = ACPI_HANDLE(physfn->bus->bridge);
#endif
		if (!handle) {
			/*
			 * This device was not listed in the ACPI name space at
			 * all. Try to get acpi handle of parent pci bus.
			 */
			struct pci_bus *pbus;
			for (pbus = pci_dev->bus; pbus; pbus = pbus->parent) {
				handle = acpi_pci_get_bridge_handle(pbus);
				if (handle)
					break;
			}
		}
		if (handle) {
			acpi_status status;

			do {
				unsigned long long pxm;

				status = acpi_evaluate_integer(handle, "_PXM",
							       NULL, &pxm);
				if (ACPI_SUCCESS(status)) {
					add->optarr[0] = pxm;
					add->flags |= XEN_PCI_DEV_PXM;
					break;
				}
				status = acpi_get_parent(handle, &handle);
			} while (ACPI_SUCCESS(status));
		}
#endif /* CONFIG_ACPI */

		r = HYPERVISOR_physdev_op(PHYSDEVOP_pci_device_add, add);
		if (r != -ENOSYS)
			return r;
		pci_seg_supported = false;
	}

	if (pci_domain_nr(pci_dev->bus))
		r = -ENOSYS;
#ifdef CONFIG_PCI_IOV
	else if (pci_dev->is_virtfn) {
		struct physdev_manage_pci_ext manage_pci_ext = {
			.bus		= pci_dev->bus->number,
			.devfn		= pci_dev->devfn,
			.is_virtfn 	= 1,
			.physfn.bus	= physfn->bus->number,
			.physfn.devfn	= physfn->devfn,
		};

		r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_add_ext,
			&manage_pci_ext);
	}
#endif
	else if (pci_ari_enabled(pci_dev->bus) && PCI_SLOT(pci_dev->devfn)) {
		struct physdev_manage_pci_ext manage_pci_ext = {
			.bus		= pci_dev->bus->number,
			.devfn		= pci_dev->devfn,
			.is_extfn	= 1,
		};

		r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_add_ext,
			&manage_pci_ext);
	} else {
		struct physdev_manage_pci manage_pci = {
			.bus	= pci_dev->bus->number,
			.devfn	= pci_dev->devfn,
		};

		r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_add,
			&manage_pci);
	}

	return r;
}

static int xen_remove_device(struct device *dev)
{
	int r;
	struct pci_dev *pci_dev = to_pci_dev(dev);

	if (pci_seg_supported) {
		struct physdev_pci_device device = {
			.seg = pci_domain_nr(pci_dev->bus),
			.bus = pci_dev->bus->number,
			.devfn = pci_dev->devfn
		};

		r = HYPERVISOR_physdev_op(PHYSDEVOP_pci_device_remove,
					  &device);
	} else if (pci_domain_nr(pci_dev->bus))
		r = -ENOSYS;
	else {
		struct physdev_manage_pci manage_pci = {
			.bus = pci_dev->bus->number,
			.devfn = pci_dev->devfn
		};

		r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_remove,
					  &manage_pci);
	}

	return r;
}

static int xen_pci_notifier(struct notifier_block *nb,
			    unsigned long action, void *data)
{
	struct device *dev = data;
	int r = 0;

	switch (action) {
	case BUS_NOTIFY_ADD_DEVICE:
		r = xen_add_device(dev);
		break;
	case BUS_NOTIFY_DEL_DEVICE:
		r = xen_remove_device(dev);
		break;
	default:
		return NOTIFY_DONE;
	}
	if (r)
		dev_err(dev, "Failed to %s - passthrough or MSI/MSI-X might fail!\n",
			action == BUS_NOTIFY_ADD_DEVICE ? "add" :
			(action == BUS_NOTIFY_DEL_DEVICE ? "delete" : "?"));
	return NOTIFY_OK;
}

static struct notifier_block device_nb = {
	.notifier_call = xen_pci_notifier,
};

static int __init register_xen_pci_notifier(void)
{
	if (!xen_initial_domain())
		return 0;

	return bus_register_notifier(&pci_bus_type, &device_nb);
}

arch_initcall(register_xen_pci_notifier);

#ifdef CONFIG_PCI_MMCONFIG
static int __init xen_mcfg_late(void)
{
	struct pci_mmcfg_region *cfg;
	int rc;

	if (!xen_initial_domain())
		return 0;

	if ((pci_probe & PCI_PROBE_MMCONF) == 0)
		return 0;

	if (list_empty(&pci_mmcfg_list))
		return 0;

	/* Check whether they are in the right area. */
	list_for_each_entry(cfg, &pci_mmcfg_list, list) {
		struct physdev_pci_mmcfg_reserved r;

		r.address = cfg->address;
		r.segment = cfg->segment;
		r.start_bus = cfg->start_bus;
		r.end_bus = cfg->end_bus;
		r.flags = XEN_PCI_MMCFG_RESERVED;

		rc = HYPERVISOR_physdev_op(PHYSDEVOP_pci_mmcfg_reserved, &r);
		switch (rc) {
		case 0:
		case -ENOSYS:
			continue;

		default:
			pr_warn("Failed to report MMCONFIG reservation"
				" state for %s to hypervisor"
				" (%d)\n",
				cfg->name, rc);
		}
	}
	return 0;
}
/*
 * Needs to be done after acpi_init which are subsys_initcall.
 */
subsys_initcall_sync(xen_mcfg_late);
#endif
Commit	Line	Data
e28c31a9 WH	1	/*
	2	* Copyright (c) 2009, Intel Corporation.
	3	*
	4	* This program is free software; you can redistribute it and/or modify it
	5	* under the terms and conditions of the GNU General Public License,
	6	* version 2, as published by the Free Software Foundation.
	7	*
	8	* This program is distributed in the hope it will be useful, but WITHOUT
	9	* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
	10	* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
	11	* more details.
	12	*
	13	* You should have received a copy of the GNU General Public License along with
	14	* this program; if not, write to the Free Software Foundation, Inc., 59 Temple
	15	* Place - Suite 330, Boston, MA 02111-1307 USA.
	16	*
	17	* Author: Weidong Han <[email protected]>
	18	*/
	19
	20	#include <linux/pci.h>
55e901fc	21	#include <linux/acpi.h>
0b97b03d	22	#include <linux/pci-acpi.h>
e28c31a9 WH	23	#include <xen/xen.h>
	24	#include <xen/interface/physdev.h>
	25	#include <xen/interface/xen.h>
	26
	27	#include <asm/xen/hypervisor.h>
	28	#include <asm/xen/hypercall.h>
	29	#include "../pci/pci.h"
b7ef4a6d	30	#ifdef CONFIG_PCI_MMCONFIG
8deb3eb1	31	#include <asm/pci_x86.h>
b7ef4a6d	32	#endif
e28c31a9	33
55e901fc JB	34	static bool __read_mostly pci_seg_supported = true;
55e901fc JB	35
e28c31a9 WH	36	static int xen_add_device(struct device *dev)
	37	{
	38	int r;
	39	struct pci_dev *pci_dev = to_pci_dev(dev);
55e901fc JB	40	#ifdef CONFIG_PCI_IOV
	41	struct pci_dev *physfn = pci_dev->physfn;
	42	#endif
	43
	44	if (pci_seg_supported) {
486edb24 BO	45	struct {
	46	struct physdev_pci_device_add add;
	47	uint32_t pxm;
	48	} add_ext = {
	49	.add.seg = pci_domain_nr(pci_dev->bus),
	50	.add.bus = pci_dev->bus->number,
	51	.add.devfn = pci_dev->devfn
55e901fc	52	};
486edb24 BO	53	struct physdev_pci_device_add *add = &add_ext.add;
486edb24 BO	54
55e901fc JB	55	#ifdef CONFIG_ACPI
	56	acpi_handle handle;
	57	#endif
e28c31a9 WH	58
e28c31a9 WH	59	#ifdef CONFIG_PCI_IOV
55e901fc	60	if (pci_dev->is_virtfn) {
486edb24 BO	61	add->flags = XEN_PCI_DEV_VIRTFN;
	62	add->physfn.bus = physfn->bus->number;
	63	add->physfn.devfn = physfn->devfn;
55e901fc JB	64	} else
	65	#endif
	66	if (pci_ari_enabled(pci_dev->bus) && PCI_SLOT(pci_dev->devfn))
486edb24	67	add->flags = XEN_PCI_DEV_EXTFN;
55e901fc JB	68
55e901fc JB	69	#ifdef CONFIG_ACPI
3a83f992	70	handle = ACPI_HANDLE(&pci_dev->dev);
55e901fc JB	71	#ifdef CONFIG_PCI_IOV
55e901fc JB	72	if (!handle && pci_dev->is_virtfn)
3a83f992	73	handle = ACPI_HANDLE(physfn->bus->bridge);
55e901fc	74	#endif
0b97b03d RL	75	if (!handle) {
	76	/*
	77	* This device was not listed in the ACPI name space at
	78	* all. Try to get acpi handle of parent pci bus.
	79	*/
	80	struct pci_bus *pbus;
	81	for (pbus = pci_dev->bus; pbus; pbus = pbus->parent) {
	82	handle = acpi_pci_get_bridge_handle(pbus);
	83	if (handle)
	84	break;
	85	}
	86	}
55e901fc JB	87	if (handle) {
	88	acpi_status status;
	89
	90	do {
	91	unsigned long long pxm;
	92
	93	status = acpi_evaluate_integer(handle, "_PXM",
	94	NULL, &pxm);
	95	if (ACPI_SUCCESS(status)) {
486edb24 BO	96	add->optarr[0] = pxm;
486edb24 BO	97	add->flags \|= XEN_PCI_DEV_PXM;
55e901fc JB	98	break;
	99	}
	100	status = acpi_get_parent(handle, &handle);
	101	} while (ACPI_SUCCESS(status));
	102	}
	103	#endif /* CONFIG_ACPI */
	104
486edb24	105	r = HYPERVISOR_physdev_op(PHYSDEVOP_pci_device_add, add);
55e901fc JB	106	if (r != -ENOSYS)
	107	return r;
	108	pci_seg_supported = false;
	109	}
	110
	111	if (pci_domain_nr(pci_dev->bus))
	112	r = -ENOSYS;
	113	#ifdef CONFIG_PCI_IOV
	114	else if (pci_dev->is_virtfn) {
e28c31a9 WH	115	struct physdev_manage_pci_ext manage_pci_ext = {
	116	.bus = pci_dev->bus->number,
	117	.devfn = pci_dev->devfn,
	118	.is_virtfn = 1,
55e901fc JB	119	.physfn.bus = physfn->bus->number,
55e901fc JB	120	.physfn.devfn = physfn->devfn,
e28c31a9 WH	121	};
	122
	123	r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_add_ext,
	124	&manage_pci_ext);
55e901fc	125	}
e28c31a9	126	#endif
55e901fc	127	else if (pci_ari_enabled(pci_dev->bus) && PCI_SLOT(pci_dev->devfn)) {
e28c31a9 WH	128	struct physdev_manage_pci_ext manage_pci_ext = {
	129	.bus = pci_dev->bus->number,
	130	.devfn = pci_dev->devfn,
	131	.is_extfn = 1,
	132	};
	133
	134	r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_add_ext,
	135	&manage_pci_ext);
	136	} else {
	137	struct physdev_manage_pci manage_pci = {
4b010983	138	.bus = pci_dev->bus->number,
e28c31a9 WH	139	.devfn = pci_dev->devfn,
	140	};
	141
	142	r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_add,
	143	&manage_pci);
	144	}
	145
	146	return r;
	147	}
	148
	149	static int xen_remove_device(struct device *dev)
	150	{
	151	int r;
	152	struct pci_dev *pci_dev = to_pci_dev(dev);
e28c31a9	153
55e901fc JB	154	if (pci_seg_supported) {
	155	struct physdev_pci_device device = {
	156	.seg = pci_domain_nr(pci_dev->bus),
	157	.bus = pci_dev->bus->number,
	158	.devfn = pci_dev->devfn
	159	};
e28c31a9	160
55e901fc JB	161	r = HYPERVISOR_physdev_op(PHYSDEVOP_pci_device_remove,
	162	&device);
	163	} else if (pci_domain_nr(pci_dev->bus))
	164	r = -ENOSYS;
	165	else {
	166	struct physdev_manage_pci manage_pci = {
	167	.bus = pci_dev->bus->number,
	168	.devfn = pci_dev->devfn
	169	};
	170
	171	r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_remove,
	172	&manage_pci);
	173	}
e28c31a9 WH	174
	175	return r;
	176	}
	177
	178	static int xen_pci_notifier(struct notifier_block *nb,
	179	unsigned long action, void *data)
	180	{
	181	struct device *dev = data;
	182	int r = 0;
	183
	184	switch (action) {
	185	case BUS_NOTIFY_ADD_DEVICE:
	186	r = xen_add_device(dev);
	187	break;
	188	case BUS_NOTIFY_DEL_DEVICE:
	189	r = xen_remove_device(dev);
	190	break;
	191	default:
12e13ac8	192	return NOTIFY_DONE;
e28c31a9	193	}
12e13ac8 JB	194	if (r)
	195	dev_err(dev, "Failed to %s - passthrough or MSI/MSI-X might fail!\n",
	196	action == BUS_NOTIFY_ADD_DEVICE ? "add" :
	197	(action == BUS_NOTIFY_DEL_DEVICE ? "delete" : "?"));
	198	return NOTIFY_OK;
e28c31a9 WH	199	}
e28c31a9 WH	200
12e13ac8	201	static struct notifier_block device_nb = {
e28c31a9 WH	202	.notifier_call = xen_pci_notifier,
	203	};
	204
	205	static int __init register_xen_pci_notifier(void)
	206	{
	207	if (!xen_initial_domain())
	208	return 0;
	209
	210	return bus_register_notifier(&pci_bus_type, &device_nb);
	211	}
	212
	213	arch_initcall(register_xen_pci_notifier);
8deb3eb1 KRW	214
	215	#ifdef CONFIG_PCI_MMCONFIG
	216	static int __init xen_mcfg_late(void)
	217	{
	218	struct pci_mmcfg_region *cfg;
	219	int rc;
	220
	221	if (!xen_initial_domain())
	222	return 0;
	223
	224	if ((pci_probe & PCI_PROBE_MMCONF) == 0)
	225	return 0;
	226
	227	if (list_empty(&pci_mmcfg_list))
	228	return 0;
	229
	230	/* Check whether they are in the right area. */
	231	list_for_each_entry(cfg, &pci_mmcfg_list, list) {
	232	struct physdev_pci_mmcfg_reserved r;
	233
	234	r.address = cfg->address;
	235	r.segment = cfg->segment;
	236	r.start_bus = cfg->start_bus;
	237	r.end_bus = cfg->end_bus;
	238	r.flags = XEN_PCI_MMCFG_RESERVED;
	239
	240	rc = HYPERVISOR_physdev_op(PHYSDEVOP_pci_mmcfg_reserved, &r);
	241	switch (rc) {
	242	case 0:
	243	case -ENOSYS:
	244	continue;
	245
	246	default:
	247	pr_warn("Failed to report MMCONFIG reservation"
	248	" state for %s to hypervisor"
	249	" (%d)\n",
	250	cfg->name, rc);
	251	}
	252	}
	253	return 0;
	254	}
	255	/*
	256	* Needs to be done after acpi_init which are subsys_initcall.
	257	*/
	258	subsys_initcall_sync(xen_mcfg_late);
	259	#endif