[deliverable/linux.git] / drivers / xen / platform-pci.c

/******************************************************************************
 * platform-pci.c
 *
 * Xen platform PCI device driver
 * Copyright (c) 2005, Intel Corporation.
 * Copyright (c) 2007, XenSource Inc.
 * Copyright (c) 2010, Citrix
 *
 * 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.
 *
 */


#include <linux/interrupt.h>
#include <linux/io.h>
#include <linux/module.h>
#include <linux/pci.h>

#include <xen/platform_pci.h>
#include <xen/grant_table.h>
#include <xen/xenbus.h>
#include <xen/events.h>
#include <xen/hvm.h>
#include <xen/xen-ops.h>

#define DRV_NAME    "xen-platform-pci"

MODULE_AUTHOR("ssmith@xensource.com and stefano.stabellini@eu.citrix.com");
MODULE_DESCRIPTION("Xen platform PCI device");
MODULE_LICENSE("GPL");

static unsigned long platform_mmio;
static unsigned long platform_mmio_alloc;
static unsigned long platform_mmiolen;
static uint64_t callback_via;

unsigned long alloc_xen_mmio(unsigned long len)
{
	unsigned long addr;

	addr = platform_mmio + platform_mmio_alloc;
	platform_mmio_alloc += len;
	BUG_ON(platform_mmio_alloc > platform_mmiolen);

	return addr;
}

static uint64_t get_callback_via(struct pci_dev *pdev)
{
	u8 pin;
	int irq;

	irq = pdev->irq;
	if (irq < 16)
		return irq; /* ISA IRQ */

	pin = pdev->pin;

	/* We don't know the GSI. Specify the PCI INTx line instead. */
	return ((uint64_t)0x01 << 56) | /* PCI INTx identifier */
		((uint64_t)pci_domain_nr(pdev->bus) << 32) |
		((uint64_t)pdev->bus->number << 16) |
		((uint64_t)(pdev->devfn & 0xff) << 8) |
		((uint64_t)(pin - 1) & 3);
}

static irqreturn_t do_hvm_evtchn_intr(int irq, void *dev_id)
{
	xen_hvm_evtchn_do_upcall();
	return IRQ_HANDLED;
}

static int xen_allocate_irq(struct pci_dev *pdev)
{
	return request_irq(pdev->irq, do_hvm_evtchn_intr,
			IRQF_DISABLED | IRQF_NOBALANCING | IRQF_TRIGGER_RISING,
			"xen-platform-pci", pdev);
}

static int platform_pci_resume(struct pci_dev *pdev)
{
	int err;
	if (xen_have_vector_callback)
		return 0;
	err = xen_set_callback_via(callback_via);
	if (err) {
		dev_err(&pdev->dev, "platform_pci_resume failure!\n");
		return err;
	}
	return 0;
}

static void __devinit prepare_shared_info(void)
{
#ifdef CONFIG_KEXEC
	unsigned long addr;
	struct shared_info *hvm_shared_info;

	addr = alloc_xen_mmio(PAGE_SIZE);
	hvm_shared_info = ioremap(addr, PAGE_SIZE);
	memset(hvm_shared_info, 0, PAGE_SIZE);
	xen_hvm_prepare_kexec(hvm_shared_info, addr >> PAGE_SHIFT);
#endif
}

static int __devinit platform_pci_init(struct pci_dev *pdev,
				       const struct pci_device_id *ent)
{
	int i, ret;
	long ioaddr;
	long mmio_addr, mmio_len;
	unsigned int max_nr_gframes;

	if (!xen_domain())
		return -ENODEV;

	i = pci_enable_device(pdev);
	if (i)
		return i;

	ioaddr = pci_resource_start(pdev, 0);

	mmio_addr = pci_resource_start(pdev, 1);
	mmio_len = pci_resource_len(pdev, 1);

	if (mmio_addr == 0 || ioaddr == 0) {
		dev_err(&pdev->dev, "no resources found\n");
		ret = -ENOENT;
		goto pci_out;
	}

	ret = pci_request_region(pdev, 1, DRV_NAME);
	if (ret < 0)
		goto pci_out;

	ret = pci_request_region(pdev, 0, DRV_NAME);
	if (ret < 0)
		goto mem_out;

	platform_mmio = mmio_addr;
	platform_mmiolen = mmio_len;

	prepare_shared_info();

	if (!xen_have_vector_callback) {
		ret = xen_allocate_irq(pdev);
		if (ret) {
			dev_warn(&pdev->dev, "request_irq failed err=%d\n", ret);
			goto out;
		}
		callback_via = get_callback_via(pdev);
		ret = xen_set_callback_via(callback_via);
		if (ret) {
			dev_warn(&pdev->dev, "Unable to set the evtchn callback "
					 "err=%d\n", ret);
			goto out;
		}
	}

	max_nr_gframes = gnttab_max_grant_frames();
	xen_hvm_resume_frames = alloc_xen_mmio(PAGE_SIZE * max_nr_gframes);
	ret = gnttab_init();
	if (ret)
		goto out;
	xenbus_probe(NULL);
	return 0;

out:
	pci_release_region(pdev, 0);
mem_out:
	pci_release_region(pdev, 1);
pci_out:
	pci_disable_device(pdev);
	return ret;
}

static struct pci_device_id platform_pci_tbl[] __devinitdata = {
	{PCI_VENDOR_ID_XEN, PCI_DEVICE_ID_XEN_PLATFORM,
		PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
	{0,}
};

MODULE_DEVICE_TABLE(pci, platform_pci_tbl);

static struct pci_driver platform_driver = {
	.name =           DRV_NAME,
	.probe =          platform_pci_init,
	.id_table =       platform_pci_tbl,
#ifdef CONFIG_PM
	.resume_early =   platform_pci_resume,
#endif
};

static int __init platform_pci_module_init(void)
{
	return pci_register_driver(&platform_driver);
}

module_init(platform_pci_module_init);
Commit	Line	Data
183d03cc SS	1	/******************************************************************************
	2	* platform-pci.c
	3	*
	4	* Xen platform PCI device driver
	5	* Copyright (c) 2005, Intel Corporation.
	6	* Copyright (c) 2007, XenSource Inc.
	7	* Copyright (c) 2010, Citrix
	8	*
	9	* This program is free software; you can redistribute it and/or modify it
	10	* under the terms and conditions of the GNU General Public License,
	11	* version 2, as published by the Free Software Foundation.
	12	*
	13	* This program is distributed in the hope it will be useful, but WITHOUT
	14	* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
	15	* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
	16	* more details.
	17	*
	18	* You should have received a copy of the GNU General Public License along with
	19	* this program; if not, write to the Free Software Foundation, Inc., 59 Temple
	20	* Place - Suite 330, Boston, MA 02111-1307 USA.
	21	*
	22	*/
	23
	24
	25	#include <linux/interrupt.h>
	26	#include <linux/io.h>
	27	#include <linux/module.h>
	28	#include <linux/pci.h>
	29
c1c5413a	30	#include <xen/platform_pci.h>
183d03cc SS	31	#include <xen/grant_table.h>
	32	#include <xen/xenbus.h>
	33	#include <xen/events.h>
	34	#include <xen/hvm.h>
016b6f5f	35	#include <xen/xen-ops.h>
183d03cc SS	36
	37	#define DRV_NAME "xen-platform-pci"
	38
	39	MODULE_AUTHOR("ssmith@xensource.com and stefano.stabellini@eu.citrix.com");
	40	MODULE_DESCRIPTION("Xen platform PCI device");
	41	MODULE_LICENSE("GPL");
	42
	43	static unsigned long platform_mmio;
	44	static unsigned long platform_mmio_alloc;
	45	static unsigned long platform_mmiolen;
016b6f5f	46	static uint64_t callback_via;
183d03cc SS	47
	48	unsigned long alloc_xen_mmio(unsigned long len)
	49	{
	50	unsigned long addr;
	51
	52	addr = platform_mmio + platform_mmio_alloc;
	53	platform_mmio_alloc += len;
	54	BUG_ON(platform_mmio_alloc > platform_mmiolen);
	55
	56	return addr;
	57	}
	58
	59	static uint64_t get_callback_via(struct pci_dev *pdev)
	60	{
	61	u8 pin;
	62	int irq;
	63
	64	irq = pdev->irq;
	65	if (irq < 16)
	66	return irq; /* ISA IRQ */
	67
	68	pin = pdev->pin;
	69
	70	/* We don't know the GSI. Specify the PCI INTx line instead. */
	71	return ((uint64_t)0x01 << 56) \| /* PCI INTx identifier */
	72	((uint64_t)pci_domain_nr(pdev->bus) << 32) \|
	73	((uint64_t)pdev->bus->number << 16) \|
	74	((uint64_t)(pdev->devfn & 0xff) << 8) \|
	75	((uint64_t)(pin - 1) & 3);
	76	}
	77
	78	static irqreturn_t do_hvm_evtchn_intr(int irq, void *dev_id)
	79	{
	80	xen_hvm_evtchn_do_upcall();
	81	return IRQ_HANDLED;
	82	}
	83
	84	static int xen_allocate_irq(struct pci_dev *pdev)
	85	{
	86	return request_irq(pdev->irq, do_hvm_evtchn_intr,
	87	IRQF_DISABLED \| IRQF_NOBALANCING \| IRQF_TRIGGER_RISING,
	88	"xen-platform-pci", pdev);
	89	}
	90
016b6f5f SS	91	static int platform_pci_resume(struct pci_dev *pdev)
	92	{
	93	int err;
	94	if (xen_have_vector_callback)
	95	return 0;
	96	err = xen_set_callback_via(callback_via);
	97	if (err) {
	98	dev_err(&pdev->dev, "platform_pci_resume failure!\n");
	99	return err;
	100	}
	101	return 0;
	102	}
	103
00e37bdb OH	104	static void __devinit prepare_shared_info(void)
	105	{
	106	#ifdef CONFIG_KEXEC
	107	unsigned long addr;
	108	struct shared_info *hvm_shared_info;
	109
	110	addr = alloc_xen_mmio(PAGE_SIZE);
	111	hvm_shared_info = ioremap(addr, PAGE_SIZE);
	112	memset(hvm_shared_info, 0, PAGE_SIZE);
	113	xen_hvm_prepare_kexec(hvm_shared_info, addr >> PAGE_SHIFT);
	114	#endif
	115	}
	116
183d03cc SS	117	static int __devinit platform_pci_init(struct pci_dev *pdev,
	118	const struct pci_device_id *ent)
	119	{
	120	int i, ret;
00f28e40	121	long ioaddr;
183d03cc	122	long mmio_addr, mmio_len;
183d03cc SS	123	unsigned int max_nr_gframes;
183d03cc SS	124
38ad4f4b OH	125	if (!xen_domain())
	126	return -ENODEV;
	127
183d03cc SS	128	i = pci_enable_device(pdev);
	129	if (i)
	130	return i;
	131
	132	ioaddr = pci_resource_start(pdev, 0);
183d03cc SS	133
	134	mmio_addr = pci_resource_start(pdev, 1);
	135	mmio_len = pci_resource_len(pdev, 1);
	136
	137	if (mmio_addr == 0 \|\| ioaddr == 0) {
	138	dev_err(&pdev->dev, "no resources found\n");
	139	ret = -ENOENT;
	140	goto pci_out;
	141	}
	142
00f28e40 IC	143	ret = pci_request_region(pdev, 1, DRV_NAME);
00f28e40 IC	144	if (ret < 0)
183d03cc	145	goto pci_out;
183d03cc	146
00f28e40 IC	147	ret = pci_request_region(pdev, 0, DRV_NAME);
00f28e40 IC	148	if (ret < 0)
183d03cc	149	goto mem_out;
183d03cc SS	150
	151	platform_mmio = mmio_addr;
	152	platform_mmiolen = mmio_len;
	153
00e37bdb OH	154	prepare_shared_info();
00e37bdb OH	155
183d03cc SS	156	if (!xen_have_vector_callback) {
	157	ret = xen_allocate_irq(pdev);
	158	if (ret) {
	159	dev_warn(&pdev->dev, "request_irq failed err=%d\n", ret);
	160	goto out;
	161	}
	162	callback_via = get_callback_via(pdev);
	163	ret = xen_set_callback_via(callback_via);
	164	if (ret) {
	165	dev_warn(&pdev->dev, "Unable to set the evtchn callback "
	166	"err=%d\n", ret);
	167	goto out;
	168	}
	169	}
	170
	171	max_nr_gframes = gnttab_max_grant_frames();
	172	xen_hvm_resume_frames = alloc_xen_mmio(PAGE_SIZE * max_nr_gframes);
	173	ret = gnttab_init();
	174	if (ret)
	175	goto out;
	176	xenbus_probe(NULL);
	177	return 0;
	178
	179	out:
00f28e40	180	pci_release_region(pdev, 0);
183d03cc	181	mem_out:
00f28e40	182	pci_release_region(pdev, 1);
183d03cc SS	183	pci_out:
	184	pci_disable_device(pdev);
	185	return ret;
	186	}
	187
	188	static struct pci_device_id platform_pci_tbl[] __devinitdata = {
	189	{PCI_VENDOR_ID_XEN, PCI_DEVICE_ID_XEN_PLATFORM,
	190	PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
	191	{0,}
	192	};
	193
	194	MODULE_DEVICE_TABLE(pci, platform_pci_tbl);
	195
	196	static struct pci_driver platform_driver = {
	197	.name = DRV_NAME,
	198	.probe = platform_pci_init,
	199	.id_table = platform_pci_tbl,
016b6f5f SS	200	#ifdef CONFIG_PM
	201	.resume_early = platform_pci_resume,
	202	#endif
183d03cc SS	203	};
	204
	205	static int __init platform_pci_module_init(void)
	206	{
	207	return pci_register_driver(&platform_driver);
	208	}
	209
	210	module_init(platform_pci_module_init);