[net-next-2.6.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/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	}
};

static void reserve_range(const char *pnpid, resource_size_t start, resource_size_t end, int port)
{
	struct resource *res;
	char *regionid;

	regionid = kmalloc(16, GFP_KERNEL);
	if (regionid == NULL)
		return;
	snprintf(regionid, 16, "pnp %s", pnpid);
	if (port)
		res = request_region(start, end-start+1, regionid);
	else
		res = request_mem_region(start, end-start+1, regionid);
	if (res == NULL)
		kfree(regionid);
	else
		res->flags &= ~IORESOURCE_BUSY;
	/*
	 * 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.
	 */
	printk(KERN_INFO
		"pnp: %s: %s range 0x%llx-0x%llx %s reserved\n",
		pnpid, port ? "ioport" : "iomem",
                (unsigned long long)start, (unsigned long long)end,
		NULL != res ? "has been" : "could not be");
}

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

	for (i = 0; i < PNP_MAX_PORT; i++) {
		if (!pnp_port_valid(dev, i))
			continue;
		if (pnp_port_start(dev, i) == 0)
			continue;	/* disabled */
		if (pnp_port_start(dev, i) < 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 (pnp_port_end(dev, i) < pnp_port_start(dev, i))
			continue;	/* invalid */

		reserve_range(dev->dev.bus_id, pnp_port_start(dev, i),
			pnp_port_end(dev, i), 1);
	}

	for (i = 0; i < PNP_MAX_MEM; i++) {
		if (!pnp_mem_valid(dev, i))
			continue;

		reserve_range(dev->dev.bus_id, pnp_mem_start(dev, i),
			pnp_mem_end(dev, i), 0);
	}

	return;
}

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,
	.remove		= NULL,
};

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	*/
	9
	10	#include <linux/pnp.h>
	11	#include <linux/device.h>
	12	#include <linux/init.h>
	13	#include <linux/slab.h>
	14	#include <linux/kernel.h>
	15	#include <linux/ioport.h>
	16
	17	static const struct pnp_device_id pnp_dev_table[] = {
	18	/* General ID for reserving resources */
	19	{ "PNP0c02", 0 },
	20	/* memory controller */
	21	{ "PNP0c01", 0 },
	22	{ "", 0 }
	23	};
	24
a2b091db	25	static void reserve_range(const char *pnpid, resource_size_t start, resource_size_t end, int port)
1da177e4 LT	26	{
	27	struct resource *res;
	28	char *regionid;
	29
	30	regionid = kmalloc(16, GFP_KERNEL);
5859554c	31	if (regionid == NULL)
1da177e4 LT	32	return;
1da177e4 LT	33	snprintf(regionid, 16, "pnp %s", pnpid);
a8c78f7f	34	if (port)
a2b091db	35	res = request_region(start, end-start+1, regionid);
a8c78f7f	36	else
a2b091db	37	res = request_mem_region(start, end-start+1, regionid);
5859554c BH	38	if (res == NULL)
5859554c BH	39	kfree(regionid);
1da177e4 LT	40	else
	41	res->flags &= ~IORESOURCE_BUSY;
	42	/*
	43	* Failures at this point are usually harmless. pci quirks for
	44	* example do reserve stuff they know about too, so we may well
	45	* have double reservations.
	46	*/
	47	printk(KERN_INFO
a2b091db PV	48	"pnp: %s: %s range 0x%llx-0x%llx %s reserved\n",
	49	pnpid, port ? "ioport" : "iomem",
	50	(unsigned long long)start, (unsigned long long)end,
5859554c	51	NULL != res ? "has been" : "could not be");
1da177e4 LT	52	}
1da177e4 LT	53
a2b091db	54	static void reserve_resources_of_dev(const struct pnp_dev *dev)
1da177e4 LT	55	{
	56	int i;
	57
5859554c	58	for (i = 0; i < PNP_MAX_PORT; i++) {
1da177e4	59	if (!pnp_port_valid(dev, i))
1da177e4 LT	60	continue;
1da177e4 LT	61	if (pnp_port_start(dev, i) == 0)
5859554c	62	continue; /* disabled */
1da177e4 LT	63	if (pnp_port_start(dev, i) < 0x100)
	64	/*
	65	* Below 0x100 is only standard PC hardware
	66	* (pics, kbd, timer, dma, ...)
	67	* We should not get resource conflicts there,
	68	* and the kernel reserves these anyway
	69	* (see arch/i386/kernel/setup.c).
	70	* So, do nothing
	71	*/
	72	continue;
	73	if (pnp_port_end(dev, i) < pnp_port_start(dev, i))
5859554c BH	74	continue; /* invalid */
	75
	76	reserve_range(dev->dev.bus_id, pnp_port_start(dev, i),
	77	pnp_port_end(dev, i), 1);
1da177e4 LT	78	}
1da177e4 LT	79
a8c78f7f BH	80	for (i = 0; i < PNP_MAX_MEM; i++) {
	81	if (!pnp_mem_valid(dev, i))
	82	continue;
	83
	84	reserve_range(dev->dev.bus_id, pnp_mem_start(dev, i),
	85	pnp_mem_end(dev, i), 0);
	86	}
	87
1da177e4 LT	88	return;
	89	}
	90
	91	static int system_pnp_probe(struct pnp_dev * dev, const struct pnp_device_id *dev_id)
	92	{
	93	reserve_resources_of_dev(dev);
	94	return 0;
	95	}
	96
	97	static struct pnp_driver system_pnp_driver = {
	98	.name = "system",
	99	.id_table = pnp_dev_table,
	100	.flags = PNP_DRIVER_RES_DO_NOT_CHANGE,
	101	.probe = system_pnp_probe,
	102	.remove = NULL,
	103	};
	104
	105	static int __init pnp_system_init(void)
	106	{
	107	return pnp_register_driver(&system_pnp_driver);
	108	}
	109
	110	/**
	111	* Reserve motherboard resources after PCI claim BARs,
	112	* but before PCI assign resources for uninitialized PCI devices
	113	*/
	114	fs_initcall(pnp_system_init);