[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 <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"

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 physdev_pci_device_add add = {
			.seg = pci_domain_nr(pci_dev->bus),
			.bus = pci_dev->bus->number,
			.devfn = pci_dev->devfn
		};
#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 = DEVICE_ACPI_HANDLE(&pci_dev->dev);
		if (!handle)
			handle = DEVICE_ACPI_HANDLE(pci_dev->bus->bridge);
#ifdef CONFIG_PCI_IOV
		if (!handle && pci_dev->is_virtfn)
			handle = DEVICE_ACPI_HANDLE(physfn->bus->bridge);
#endif
		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);
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>
e28c31a9 WH	22	#include <xen/xen.h>
	23	#include <xen/interface/physdev.h>
	24	#include <xen/interface/xen.h>
	25
	26	#include <asm/xen/hypervisor.h>
	27	#include <asm/xen/hypercall.h>
	28	#include "../pci/pci.h"
	29
55e901fc JB	30	static bool __read_mostly pci_seg_supported = true;
55e901fc JB	31
e28c31a9 WH	32	static int xen_add_device(struct device *dev)
	33	{
	34	int r;
	35	struct pci_dev *pci_dev = to_pci_dev(dev);
55e901fc JB	36	#ifdef CONFIG_PCI_IOV
	37	struct pci_dev *physfn = pci_dev->physfn;
	38	#endif
	39
	40	if (pci_seg_supported) {
	41	struct physdev_pci_device_add add = {
	42	.seg = pci_domain_nr(pci_dev->bus),
	43	.bus = pci_dev->bus->number,
	44	.devfn = pci_dev->devfn
	45	};
	46	#ifdef CONFIG_ACPI
	47	acpi_handle handle;
	48	#endif
e28c31a9 WH	49
e28c31a9 WH	50	#ifdef CONFIG_PCI_IOV
55e901fc JB	51	if (pci_dev->is_virtfn) {
	52	add.flags = XEN_PCI_DEV_VIRTFN;
	53	add.physfn.bus = physfn->bus->number;
	54	add.physfn.devfn = physfn->devfn;
	55	} else
	56	#endif
	57	if (pci_ari_enabled(pci_dev->bus) && PCI_SLOT(pci_dev->devfn))
	58	add.flags = XEN_PCI_DEV_EXTFN;
	59
	60	#ifdef CONFIG_ACPI
	61	handle = DEVICE_ACPI_HANDLE(&pci_dev->dev);
	62	if (!handle)
	63	handle = DEVICE_ACPI_HANDLE(pci_dev->bus->bridge);
	64	#ifdef CONFIG_PCI_IOV
	65	if (!handle && pci_dev->is_virtfn)
	66	handle = DEVICE_ACPI_HANDLE(physfn->bus->bridge);
	67	#endif
	68	if (handle) {
	69	acpi_status status;
	70
	71	do {
	72	unsigned long long pxm;
	73
	74	status = acpi_evaluate_integer(handle, "_PXM",
	75	NULL, &pxm);
	76	if (ACPI_SUCCESS(status)) {
	77	add.optarr[0] = pxm;
	78	add.flags \|= XEN_PCI_DEV_PXM;
	79	break;
	80	}
	81	status = acpi_get_parent(handle, &handle);
	82	} while (ACPI_SUCCESS(status));
	83	}
	84	#endif /* CONFIG_ACPI */
	85
	86	r = HYPERVISOR_physdev_op(PHYSDEVOP_pci_device_add, &add);
	87	if (r != -ENOSYS)
	88	return r;
	89	pci_seg_supported = false;
	90	}
	91
	92	if (pci_domain_nr(pci_dev->bus))
	93	r = -ENOSYS;
	94	#ifdef CONFIG_PCI_IOV
	95	else if (pci_dev->is_virtfn) {
e28c31a9 WH	96	struct physdev_manage_pci_ext manage_pci_ext = {
	97	.bus = pci_dev->bus->number,
	98	.devfn = pci_dev->devfn,
	99	.is_virtfn = 1,
55e901fc JB	100	.physfn.bus = physfn->bus->number,
55e901fc JB	101	.physfn.devfn = physfn->devfn,
e28c31a9 WH	102	};
	103
	104	r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_add_ext,
	105	&manage_pci_ext);
55e901fc	106	}
e28c31a9	107	#endif
55e901fc	108	else if (pci_ari_enabled(pci_dev->bus) && PCI_SLOT(pci_dev->devfn)) {
e28c31a9 WH	109	struct physdev_manage_pci_ext manage_pci_ext = {
	110	.bus = pci_dev->bus->number,
	111	.devfn = pci_dev->devfn,
	112	.is_extfn = 1,
	113	};
	114
	115	r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_add_ext,
	116	&manage_pci_ext);
	117	} else {
	118	struct physdev_manage_pci manage_pci = {
4b010983	119	.bus = pci_dev->bus->number,
e28c31a9 WH	120	.devfn = pci_dev->devfn,
	121	};
	122
	123	r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_add,
	124	&manage_pci);
	125	}
	126
	127	return r;
	128	}
	129
	130	static int xen_remove_device(struct device *dev)
	131	{
	132	int r;
	133	struct pci_dev *pci_dev = to_pci_dev(dev);
e28c31a9	134
55e901fc JB	135	if (pci_seg_supported) {
	136	struct physdev_pci_device device = {
	137	.seg = pci_domain_nr(pci_dev->bus),
	138	.bus = pci_dev->bus->number,
	139	.devfn = pci_dev->devfn
	140	};
e28c31a9	141
55e901fc JB	142	r = HYPERVISOR_physdev_op(PHYSDEVOP_pci_device_remove,
	143	&device);
	144	} else if (pci_domain_nr(pci_dev->bus))
	145	r = -ENOSYS;
	146	else {
	147	struct physdev_manage_pci manage_pci = {
	148	.bus = pci_dev->bus->number,
	149	.devfn = pci_dev->devfn
	150	};
	151
	152	r = HYPERVISOR_physdev_op(PHYSDEVOP_manage_pci_remove,
	153	&manage_pci);
	154	}
e28c31a9 WH	155
	156	return r;
	157	}
	158
	159	static int xen_pci_notifier(struct notifier_block *nb,
	160	unsigned long action, void *data)
	161	{
	162	struct device *dev = data;
	163	int r = 0;
	164
	165	switch (action) {
	166	case BUS_NOTIFY_ADD_DEVICE:
	167	r = xen_add_device(dev);
	168	break;
	169	case BUS_NOTIFY_DEL_DEVICE:
	170	r = xen_remove_device(dev);
	171	break;
	172	default:
12e13ac8	173	return NOTIFY_DONE;
e28c31a9	174	}
12e13ac8 JB	175	if (r)
	176	dev_err(dev, "Failed to %s - passthrough or MSI/MSI-X might fail!\n",
	177	action == BUS_NOTIFY_ADD_DEVICE ? "add" :
	178	(action == BUS_NOTIFY_DEL_DEVICE ? "delete" : "?"));
	179	return NOTIFY_OK;
e28c31a9 WH	180	}
e28c31a9 WH	181
12e13ac8	182	static struct notifier_block device_nb = {
e28c31a9 WH	183	.notifier_call = xen_pci_notifier,
	184	};
	185
	186	static int __init register_xen_pci_notifier(void)
	187	{
	188	if (!xen_initial_domain())
	189	return 0;
	190
	191	return bus_register_notifier(&pci_bus_type, &device_nb);
	192	}
	193
	194	arch_initcall(register_xen_pci_notifier);