[GitHub/LineageOS/android_kernel_motorola_exynos9610.git] / drivers / xen / platform-pci.c

/******************************************************************************
 * platform-pci.c
 *
 * Xen platform PCI device driver
 *
 * Authors: ssmith@xensource.com and stefano.stabellini@eu.citrix.com
 *
 * 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/init.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"

static unsigned long platform_mmio;
static unsigned long platform_mmio_alloc;
static unsigned long platform_mmiolen;

static 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 int platform_pci_probe(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;
	unsigned long grant_frames;

	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;

	max_nr_gframes = gnttab_max_grant_frames();
	grant_frames = alloc_xen_mmio(PAGE_SIZE * max_nr_gframes);
	ret = gnttab_setup_auto_xlat_frames(grant_frames);
	if (ret)
		goto out;
	ret = gnttab_init();
	if (ret)
		goto grant_out;
	xenbus_probe(NULL);
	return 0;
grant_out:
	gnttab_free_auto_xlat_frames();
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[] = {
	{PCI_VENDOR_ID_XEN, PCI_DEVICE_ID_XEN_PLATFORM,
		PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
	{0,}
};

static struct pci_driver platform_driver = {
	.name =           DRV_NAME,
	.probe =          platform_pci_probe,
	.id_table =       platform_pci_tbl,
};

builtin_pci_driver(platform_driver);
Commit	Line	Data
183d03cc SS	1	/******************************************************************************
	2	* platform-pci.c
	3	*
	4	* Xen platform PCI device driver
e01dc539 PG	5	*
	6	* Authors: ssmith@xensource.com and stefano.stabellini@eu.citrix.com
	7	*
183d03cc SS	8	* Copyright (c) 2005, Intel Corporation.
	9	* Copyright (c) 2007, XenSource Inc.
	10	* Copyright (c) 2010, Citrix
	11	*
	12	* This program is free software; you can redistribute it and/or modify it
	13	* under the terms and conditions of the GNU General Public License,
	14	* version 2, as published by the Free Software Foundation.
	15	*
	16	* This program is distributed in the hope it will be useful, but WITHOUT
	17	* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
	18	* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
	19	* more details.
	20	*
	21	* You should have received a copy of the GNU General Public License along with
	22	* this program; if not, write to the Free Software Foundation, Inc., 59 Temple
	23	* Place - Suite 330, Boston, MA 02111-1307 USA.
	24	*
	25	*/
	26
	27
	28	#include <linux/interrupt.h>
	29	#include <linux/io.h>
e01dc539	30	#include <linux/init.h>
183d03cc SS	31	#include <linux/pci.h>
183d03cc SS	32
c1c5413a	33	#include <xen/platform_pci.h>
183d03cc SS	34	#include <xen/grant_table.h>
	35	#include <xen/xenbus.h>
	36	#include <xen/events.h>
	37	#include <xen/hvm.h>
016b6f5f	38	#include <xen/xen-ops.h>
183d03cc SS	39
	40	#define DRV_NAME "xen-platform-pci"
	41
183d03cc SS	42	static unsigned long platform_mmio;
	43	static unsigned long platform_mmio_alloc;
	44	static unsigned long platform_mmiolen;
	45
598ddb8c	46	static unsigned long alloc_xen_mmio(unsigned long len)
183d03cc SS	47	{
	48	unsigned long addr;
	49
	50	addr = platform_mmio + platform_mmio_alloc;
	51	platform_mmio_alloc += len;
	52	BUG_ON(platform_mmio_alloc > platform_mmiolen);
	53
	54	return addr;
	55	}
	56
e01dc539 PG	57	static int platform_pci_probe(struct pci_dev *pdev,
e01dc539 PG	58	const struct pci_device_id *ent)
183d03cc SS	59	{
183d03cc SS	60	int i, ret;
00f28e40	61	long ioaddr;
183d03cc	62	long mmio_addr, mmio_len;
183d03cc	63	unsigned int max_nr_gframes;
efaf30a3	64	unsigned long grant_frames;
183d03cc	65
38ad4f4b OH	66	if (!xen_domain())
	67	return -ENODEV;
	68
183d03cc SS	69	i = pci_enable_device(pdev);
	70	if (i)
	71	return i;
	72
	73	ioaddr = pci_resource_start(pdev, 0);
183d03cc SS	74
	75	mmio_addr = pci_resource_start(pdev, 1);
	76	mmio_len = pci_resource_len(pdev, 1);
	77
	78	if (mmio_addr == 0 \|\| ioaddr == 0) {
	79	dev_err(&pdev->dev, "no resources found\n");
	80	ret = -ENOENT;
	81	goto pci_out;
	82	}
	83
00f28e40 IC	84	ret = pci_request_region(pdev, 1, DRV_NAME);
00f28e40 IC	85	if (ret < 0)
183d03cc	86	goto pci_out;
183d03cc	87
00f28e40 IC	88	ret = pci_request_region(pdev, 0, DRV_NAME);
00f28e40 IC	89	if (ret < 0)
183d03cc	90	goto mem_out;
183d03cc SS	91
	92	platform_mmio = mmio_addr;
	93	platform_mmiolen = mmio_len;
	94
183d03cc	95	max_nr_gframes = gnttab_max_grant_frames();
efaf30a3	96	grant_frames = alloc_xen_mmio(PAGE_SIZE * max_nr_gframes);
89b9e08f WY	97	ret = gnttab_setup_auto_xlat_frames(grant_frames);
89b9e08f WY	98	if (ret)
efaf30a3	99	goto out;
183d03cc SS	100	ret = gnttab_init();
183d03cc SS	101	if (ret)
efaf30a3	102	goto grant_out;
183d03cc SS	103	xenbus_probe(NULL);
183d03cc SS	104	return 0;
efaf30a3 KRW	105	grant_out:
efaf30a3 KRW	106	gnttab_free_auto_xlat_frames();
183d03cc	107	out:
00f28e40	108	pci_release_region(pdev, 0);
183d03cc	109	mem_out:
00f28e40	110	pci_release_region(pdev, 1);
183d03cc SS	111	pci_out:
	112	pci_disable_device(pdev);
	113	return ret;
	114	}
	115
345a5255	116	static struct pci_device_id platform_pci_tbl[] = {
183d03cc SS	117	{PCI_VENDOR_ID_XEN, PCI_DEVICE_ID_XEN_PLATFORM,
	118	PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
	119	{0,}
	120	};
	121
183d03cc SS	122	static struct pci_driver platform_driver = {
183d03cc SS	123	.name = DRV_NAME,
e01dc539	124	.probe = platform_pci_probe,
183d03cc SS	125	.id_table = platform_pci_tbl,
	126	};
	127
1ea55e80	128	builtin_pci_driver(platform_driver);