[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / pci / ioapic.c

/*
 * IOAPIC/IOxAPIC/IOSAPIC driver
 *
 * Copyright (C) 2009 Fujitsu Limited.
 * (c) Copyright 2009 Hewlett-Packard Development Company, L.P.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

/*
 * This driver manages PCI I/O APICs added by hotplug after boot.  We try to
 * claim all I/O APIC PCI devices, but those present at boot were registered
 * when we parsed the ACPI MADT, so we'll fail when we try to re-register
 * them.
 */

#include <linux/pci.h>
#include <linux/module.h>
#include <linux/acpi.h>
#include <linux/slab.h>
#include <acpi/acpi_bus.h>

struct ioapic {
	acpi_handle	handle;
	u32		gsi_base;
};

static int ioapic_probe(struct pci_dev *dev, const struct pci_device_id *ent)
{
	acpi_handle handle;
	acpi_status status;
	unsigned long long gsb;
	struct ioapic *ioapic;
	int ret;
	char *type;
	struct resource *res;

	handle = DEVICE_ACPI_HANDLE(&dev->dev);
	if (!handle)
		return -EINVAL;

	status = acpi_evaluate_integer(handle, "_GSB", NULL, &gsb);
	if (ACPI_FAILURE(status))
		return -EINVAL;

	/*
	 * The previous code in acpiphp evaluated _MAT if _GSB failed, but
	 * ACPI spec 4.0 sec 6.2.2 requires _GSB for hot-pluggable I/O APICs.
	 */

	ioapic = kzalloc(sizeof(*ioapic), GFP_KERNEL);
	if (!ioapic)
		return -ENOMEM;

	ioapic->handle = handle;
	ioapic->gsi_base = (u32) gsb;

	if (dev->class == PCI_CLASS_SYSTEM_PIC_IOAPIC)
		type = "IOAPIC";
	else
		type = "IOxAPIC";

	ret = pci_enable_device(dev);
	if (ret < 0)
		goto exit_free;

	pci_set_master(dev);

	if (pci_request_region(dev, 0, type))
		goto exit_disable;

	res = &dev->resource[0];
	if (acpi_register_ioapic(ioapic->handle, res->start, ioapic->gsi_base))
		goto exit_release;

	pci_set_drvdata(dev, ioapic);
	dev_info(&dev->dev, "%s at %pR, GSI %u\n", type, res, ioapic->gsi_base);
	return 0;

exit_release:
	pci_release_region(dev, 0);
exit_disable:
	pci_disable_device(dev);
exit_free:
	kfree(ioapic);
	return -ENODEV;
}

static void ioapic_remove(struct pci_dev *dev)
{
	struct ioapic *ioapic = pci_get_drvdata(dev);

	acpi_unregister_ioapic(ioapic->handle, ioapic->gsi_base);
	pci_release_region(dev, 0);
	pci_disable_device(dev);
	kfree(ioapic);
}


static DEFINE_PCI_DEVICE_TABLE(ioapic_devices) = {
	{ PCI_DEVICE_CLASS(PCI_CLASS_SYSTEM_PIC_IOAPIC, ~0) },
	{ PCI_DEVICE_CLASS(PCI_CLASS_SYSTEM_PIC_IOXAPIC, ~0) },
	{ }
};
MODULE_DEVICE_TABLE(pci, ioapic_devices);

static struct pci_driver ioapic_driver = {
	.name		= "ioapic",
	.id_table	= ioapic_devices,
	.probe		= ioapic_probe,
	.remove		= ioapic_remove,
};

static int __init ioapic_init(void)
{
	return pci_register_driver(&ioapic_driver);
}

static void __exit ioapic_exit(void)
{
	pci_unregister_driver(&ioapic_driver);
}

module_init(ioapic_init);
module_exit(ioapic_exit);

MODULE_LICENSE("GPL");
Commit	Line	Data
204d49a5 BH	1	/*
	2	* IOAPIC/IOxAPIC/IOSAPIC driver
	3	*
	4	* Copyright (C) 2009 Fujitsu Limited.
	5	* (c) Copyright 2009 Hewlett-Packard Development Company, L.P.
	6	*
	7	* This program is free software; you can redistribute it and/or modify
	8	* it under the terms of the GNU General Public License version 2 as
	9	* published by the Free Software Foundation.
	10	*/
	11
	12	/*
	13	* This driver manages PCI I/O APICs added by hotplug after boot. We try to
	14	* claim all I/O APIC PCI devices, but those present at boot were registered
	15	* when we parsed the ACPI MADT, so we'll fail when we try to re-register
	16	* them.
	17	*/
	18
	19	#include <linux/pci.h>
b95a7bd7	20	#include <linux/module.h>
204d49a5	21	#include <linux/acpi.h>
5a0e3ad6	22	#include <linux/slab.h>
204d49a5 BH	23	#include <acpi/acpi_bus.h>
	24
	25	struct ioapic {
	26	acpi_handle handle;
	27	u32 gsi_base;
	28	};
	29
15856ad5	30	static int ioapic_probe(struct pci_dev dev, const struct pci_device_id ent)
204d49a5 BH	31	{
	32	acpi_handle handle;
	33	acpi_status status;
	34	unsigned long long gsb;
	35	struct ioapic *ioapic;
204d49a5 BH	36	int ret;
204d49a5 BH	37	char *type;
e1944c6b	38	struct resource *res;
204d49a5 BH	39
	40	handle = DEVICE_ACPI_HANDLE(&dev->dev);
	41	if (!handle)
	42	return -EINVAL;
	43
	44	status = acpi_evaluate_integer(handle, "_GSB", NULL, &gsb);
	45	if (ACPI_FAILURE(status))
	46	return -EINVAL;
	47
	48	/*
	49	* The previous code in acpiphp evaluated _MAT if _GSB failed, but
	50	* ACPI spec 4.0 sec 6.2.2 requires _GSB for hot-pluggable I/O APICs.
	51	*/
	52
	53	ioapic = kzalloc(sizeof(*ioapic), GFP_KERNEL);
	54	if (!ioapic)
	55	return -ENOMEM;
	56
	57	ioapic->handle = handle;
	58	ioapic->gsi_base = (u32) gsb;
	59
	60	if (dev->class == PCI_CLASS_SYSTEM_PIC_IOAPIC)
	61	type = "IOAPIC";
	62	else
	63	type = "IOxAPIC";
	64
	65	ret = pci_enable_device(dev);
	66	if (ret < 0)
	67	goto exit_free;
	68
	69	pci_set_master(dev);
	70
	71	if (pci_request_region(dev, 0, type))
	72	goto exit_disable;
	73
e1944c6b BH	74	res = &dev->resource[0];
e1944c6b BH	75	if (acpi_register_ioapic(ioapic->handle, res->start, ioapic->gsi_base))
204d49a5 BH	76	goto exit_release;
	77
	78	pci_set_drvdata(dev, ioapic);
e1944c6b	79	dev_info(&dev->dev, "%s at %pR, GSI %u\n", type, res, ioapic->gsi_base);
204d49a5 BH	80	return 0;
	81
	82	exit_release:
	83	pci_release_region(dev, 0);
	84	exit_disable:
	85	pci_disable_device(dev);
	86	exit_free:
	87	kfree(ioapic);
	88	return -ENODEV;
	89	}
	90
15856ad5	91	static void ioapic_remove(struct pci_dev *dev)
204d49a5 BH	92	{
	93	struct ioapic *ioapic = pci_get_drvdata(dev);
	94
	95	acpi_unregister_ioapic(ioapic->handle, ioapic->gsi_base);
	96	pci_release_region(dev, 0);
	97	pci_disable_device(dev);
	98	kfree(ioapic);
	99	}
	100
	101
b95a7bd7 JB	102	static DEFINE_PCI_DEVICE_TABLE(ioapic_devices) = {
	103	{ PCI_DEVICE_CLASS(PCI_CLASS_SYSTEM_PIC_IOAPIC, ~0) },
	104	{ PCI_DEVICE_CLASS(PCI_CLASS_SYSTEM_PIC_IOXAPIC, ~0) },
204d49a5 BH	105	{ }
204d49a5 BH	106	};
b95a7bd7	107	MODULE_DEVICE_TABLE(pci, ioapic_devices);
204d49a5 BH	108
	109	static struct pci_driver ioapic_driver = {
	110	.name = "ioapic",
	111	.id_table = ioapic_devices,
	112	.probe = ioapic_probe,
15856ad5	113	.remove = ioapic_remove,
204d49a5 BH	114	};
	115
	116	static int __init ioapic_init(void)
	117	{
	118	return pci_register_driver(&ioapic_driver);
	119	}
	120
	121	static void __exit ioapic_exit(void)
	122	{
	123	pci_unregister_driver(&ioapic_driver);
	124	}
	125
	126	module_init(ioapic_init);
	127	module_exit(ioapic_exit);
eba48cd0 AC	128
eba48cd0 AC	129	MODULE_LICENSE("GPL");