[deliverable/linux.git] / drivers / pnp / system.c

/*
 * system.c - a driver for reserving pnp system resources
 *
 * Some code is based on pnpbios_core.c
 * Copyright 2002 Adam Belay <ambx1@neo.rr.com>
 * (c) Copyright 2007 Hewlett-Packard Development Company, L.P.
 *	Bjorn Helgaas <bjorn.helgaas@hp.com>
 */

#include <linux/acpi.h>
#include <linux/pnp.h>
#include <linux/device.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/kernel.h>
#include <linux/ioport.h>

static const struct pnp_device_id pnp_dev_table[] = {
	/* General ID for reserving resources */
	{"PNP0c02", 0},
	/* memory controller */
	{"PNP0c01", 0},
	{"", 0}
};

#ifdef CONFIG_ACPI
static bool __reserve_range(u64 start, unsigned int length, bool io, char *desc)
{
	u8 space_id = io ? ACPI_ADR_SPACE_SYSTEM_IO : ACPI_ADR_SPACE_SYSTEM_MEMORY;
	return !acpi_reserve_region(start, length, space_id, IORESOURCE_BUSY, desc);
}
#else
static bool __reserve_range(u64 start, unsigned int length, bool io, char *desc)
{
	struct resource *res;

	res = io ? request_region(start, length, desc) :
		request_mem_region(start, length, desc);
	if (res) {
		res->flags &= ~IORESOURCE_BUSY;
		return true;
	}
	return false;
}
#endif

static void reserve_range(struct pnp_dev *dev, struct resource *r, int port)
{
	char *regionid;
	const char *pnpid = dev_name(&dev->dev);
	resource_size_t start = r->start, end = r->end;
	bool reserved;

	regionid = kmalloc(16, GFP_KERNEL);
	if (!regionid)
		return;

	snprintf(regionid, 16, "pnp %s", pnpid);
	reserved = __reserve_range(start, end - start + 1, !!port, regionid);
	if (!reserved)
		kfree(regionid);

	/*
	 * Failures at this point are usually harmless. pci quirks for
	 * example do reserve stuff they know about too, so we may well
	 * have double reservations.
	 */
	dev_info(&dev->dev, "%pR %s reserved\n", r,
		 reserved ? "has been" : "could not be");
}

static void reserve_resources_of_dev(struct pnp_dev *dev)
{
	struct resource *res;
	int i;

	for (i = 0; (res = pnp_get_resource(dev, IORESOURCE_IO, i)); i++) {
		if (res->flags & IORESOURCE_DISABLED)
			continue;
		if (res->start == 0)
			continue;	/* disabled */
		if (res->start < 0x100)
			/*
			 * Below 0x100 is only standard PC hardware
			 * (pics, kbd, timer, dma, ...)
			 * We should not get resource conflicts there,
			 * and the kernel reserves these anyway
			 * (see arch/i386/kernel/setup.c).
			 * So, do nothing
			 */
			continue;
		if (res->end < res->start)
			continue;	/* invalid */

		reserve_range(dev, res, 1);
	}

	for (i = 0; (res = pnp_get_resource(dev, IORESOURCE_MEM, i)); i++) {
		if (res->flags & IORESOURCE_DISABLED)
			continue;

		reserve_range(dev, res, 0);
	}
}

static int system_pnp_probe(struct pnp_dev *dev,
			    const struct pnp_device_id *dev_id)
{
	reserve_resources_of_dev(dev);
	return 0;
}

static struct pnp_driver system_pnp_driver = {
	.name     = "system",
	.id_table = pnp_dev_table,
	.flags    = PNP_DRIVER_RES_DO_NOT_CHANGE,
	.probe    = system_pnp_probe,
};

static int __init pnp_system_init(void)
{
	return pnp_register_driver(&system_pnp_driver);
}

/**
 * Reserve motherboard resources after PCI claim BARs,
 * but before PCI assign resources for uninitialized PCI devices
 */
fs_initcall(pnp_system_init);
Commit	Line	Data
1da177e4 LT	1	/*
	2	* system.c - a driver for reserving pnp system resources
	3	*
	4	* Some code is based on pnpbios_core.c
	5	* Copyright 2002 Adam Belay <ambx1@neo.rr.com>
a8c78f7f BH	6	* (c) Copyright 2007 Hewlett-Packard Development Company, L.P.
a8c78f7f BH	7	* Bjorn Helgaas <bjorn.helgaas@hp.com>
1da177e4 LT	8	*/
1da177e4 LT	9
0f1b414d	10	#include <linux/acpi.h>
1da177e4 LT	11	#include <linux/pnp.h>
	12	#include <linux/device.h>
	13	#include <linux/init.h>
	14	#include <linux/slab.h>
	15	#include <linux/kernel.h>
	16	#include <linux/ioport.h>
	17
	18	static const struct pnp_device_id pnp_dev_table[] = {
	19	/* General ID for reserving resources */
9dd78466	20	{"PNP0c02", 0},
1da177e4	21	/* memory controller */
9dd78466 BH	22	{"PNP0c01", 0},
9dd78466 BH	23	{"", 0}
1da177e4 LT	24	};
1da177e4 LT	25
0f1b414d RW	26	#ifdef CONFIG_ACPI
	27	static bool __reserve_range(u64 start, unsigned int length, bool io, char *desc)
	28	{
	29	u8 space_id = io ? ACPI_ADR_SPACE_SYSTEM_IO : ACPI_ADR_SPACE_SYSTEM_MEMORY;
	30	return !acpi_reserve_region(start, length, space_id, IORESOURCE_BUSY, desc);
	31	}
	32	#else
	33	static bool __reserve_range(u64 start, unsigned int length, bool io, char *desc)
	34	{
	35	struct resource *res;
	36
	37	res = io ? request_region(start, length, desc) :
	38	request_mem_region(start, length, desc);
	39	if (res) {
	40	res->flags &= ~IORESOURCE_BUSY;
	41	return true;
	42	}
	43	return false;
	44	}
	45	#endif
	46
9a007b37	47	static void reserve_range(struct pnp_dev dev, struct resource r, int port)
1da177e4	48	{
1da177e4	49	char *regionid;
c85e37c5	50	const char *pnpid = dev_name(&dev->dev);
9a007b37	51	resource_size_t start = r->start, end = r->end;
0f1b414d	52	bool reserved;
1da177e4 LT	53
1da177e4 LT	54	regionid = kmalloc(16, GFP_KERNEL);
b933e19d	55	if (!regionid)
1da177e4	56	return;
b933e19d	57
1da177e4	58	snprintf(regionid, 16, "pnp %s", pnpid);
0f1b414d RW	59	reserved = __reserve_range(start, end - start + 1, !!port, regionid);
0f1b414d RW	60	if (!reserved)
b933e19d BH	61	kfree(regionid);
b933e19d BH	62
1da177e4 LT	63	/*
	64	* Failures at this point are usually harmless. pci quirks for
	65	* example do reserve stuff they know about too, so we may well
	66	* have double reservations.
	67	*/
c7dabef8	68	dev_info(&dev->dev, "%pR %s reserved\n", r,
0f1b414d	69	reserved ? "has been" : "could not be");
1da177e4 LT	70	}
1da177e4 LT	71
b933e19d	72	static void reserve_resources_of_dev(struct pnp_dev *dev)
1da177e4	73	{
95ab3669	74	struct resource *res;
1da177e4 LT	75	int i;
1da177e4 LT	76
95ab3669	77	for (i = 0; (res = pnp_get_resource(dev, IORESOURCE_IO, i)); i++) {
aee3ad81	78	if (res->flags & IORESOURCE_DISABLED)
1da177e4	79	continue;
95ab3669	80	if (res->start == 0)
5859554c	81	continue; /* disabled */
95ab3669	82	if (res->start < 0x100)
1da177e4 LT	83	/*
	84	* Below 0x100 is only standard PC hardware
	85	* (pics, kbd, timer, dma, ...)
	86	* We should not get resource conflicts there,
	87	* and the kernel reserves these anyway
	88	* (see arch/i386/kernel/setup.c).
	89	* So, do nothing
	90	*/
	91	continue;
95ab3669	92	if (res->end < res->start)
5859554c BH	93	continue; /* invalid */
5859554c BH	94
9a007b37	95	reserve_range(dev, res, 1);
1da177e4 LT	96	}
1da177e4 LT	97
95ab3669	98	for (i = 0; (res = pnp_get_resource(dev, IORESOURCE_MEM, i)); i++) {
aee3ad81	99	if (res->flags & IORESOURCE_DISABLED)
a8c78f7f BH	100	continue;
a8c78f7f BH	101
9a007b37	102	reserve_range(dev, res, 0);
a8c78f7f	103	}
1da177e4 LT	104	}
1da177e4 LT	105
9dd78466 BH	106	static int system_pnp_probe(struct pnp_dev *dev,
9dd78466 BH	107	const struct pnp_device_id *dev_id)
1da177e4 LT	108	{
	109	reserve_resources_of_dev(dev);
	110	return 0;
	111	}
	112
	113	static struct pnp_driver system_pnp_driver = {
07d4e9af	114	.name = "system",
9dd78466	115	.id_table = pnp_dev_table,
07d4e9af BH	116	.flags = PNP_DRIVER_RES_DO_NOT_CHANGE,
07d4e9af BH	117	.probe = system_pnp_probe,
1da177e4 LT	118	};
	119
	120	static int __init pnp_system_init(void)
	121	{
	122	return pnp_register_driver(&system_pnp_driver);
	123	}
	124
	125	/**
	126	* Reserve motherboard resources after PCI claim BARs,
	127	* but before PCI assign resources for uninitialized PCI devices
	128	*/
	129	fs_initcall(pnp_system_init);