[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 <[email protected]>
 * (c) Copyright 2007 Hewlett-Packard Development Company, L.P.
 *	Bjorn Helgaas <[email protected]>
 */

#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(struct pnp_dev *dev, resource_size_t start,
			  resource_size_t end, int port)
{
	char *regionid;
	const char *pnpid = dev->dev.bus_id;
	struct resource *res;

	regionid = kmalloc(16, GFP_KERNEL);
	if (!regionid)
		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)
		res->flags &= ~IORESOURCE_BUSY;
	else
		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, "%s range 0x%llx-0x%llx %s reserved\n",
		port ? "ioport" : "iomem",
		(unsigned long long) start, (unsigned long long) end,
		res ? "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_UNSET)
			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->start, res->end, 1);
	}

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

		reserve_range(dev, res->start, res->end, 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 <[email protected]>
a8c78f7f BH	6	* (c) Copyright 2007 Hewlett-Packard Development Company, L.P.
a8c78f7f BH	7	* Bjorn Helgaas <[email protected]>
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 */
9dd78466	19	{"PNP0c02", 0},
1da177e4	20	/* memory controller */
9dd78466 BH	21	{"PNP0c01", 0},
9dd78466 BH	22	{"", 0}
1da177e4 LT	23	};
1da177e4 LT	24
b933e19d	25	static void reserve_range(struct pnp_dev *dev, resource_size_t start,
9dd78466	26	resource_size_t end, int port)
1da177e4	27	{
1da177e4	28	char *regionid;
b933e19d BH	29	const char *pnpid = dev->dev.bus_id;
b933e19d BH	30	struct resource *res;
1da177e4 LT	31
1da177e4 LT	32	regionid = kmalloc(16, GFP_KERNEL);
b933e19d	33	if (!regionid)
1da177e4	34	return;
b933e19d	35
1da177e4	36	snprintf(regionid, 16, "pnp %s", pnpid);
a8c78f7f	37	if (port)
9dd78466	38	res = request_region(start, end - start + 1, regionid);
a8c78f7f	39	else
9dd78466	40	res = request_mem_region(start, end - start + 1, regionid);
b933e19d	41	if (res)
1da177e4	42	res->flags &= ~IORESOURCE_BUSY;
b933e19d BH	43	else
	44	kfree(regionid);
	45
1da177e4 LT	46	/*
	47	* Failures at this point are usually harmless. pci quirks for
	48	* example do reserve stuff they know about too, so we may well
	49	* have double reservations.
	50	*/
b933e19d BH	51	dev_info(&dev->dev, "%s range 0x%llx-0x%llx %s reserved\n",
	52	port ? "ioport" : "iomem",
	53	(unsigned long long) start, (unsigned long long) end,
	54	res ? "has been" : "could not be");
1da177e4 LT	55	}
1da177e4 LT	56
b933e19d	57	static void reserve_resources_of_dev(struct pnp_dev *dev)
1da177e4	58	{
95ab3669	59	struct resource *res;
1da177e4 LT	60	int i;
1da177e4 LT	61
95ab3669 BH	62	for (i = 0; (res = pnp_get_resource(dev, IORESOURCE_IO, i)); i++) {
95ab3669 BH	63	if (res->flags & IORESOURCE_UNSET)
1da177e4	64	continue;
95ab3669	65	if (res->start == 0)
5859554c	66	continue; /* disabled */
95ab3669	67	if (res->start < 0x100)
1da177e4 LT	68	/*
	69	* Below 0x100 is only standard PC hardware
	70	* (pics, kbd, timer, dma, ...)
	71	* We should not get resource conflicts there,
	72	* and the kernel reserves these anyway
	73	* (see arch/i386/kernel/setup.c).
	74	* So, do nothing
	75	*/
	76	continue;
95ab3669	77	if (res->end < res->start)
5859554c BH	78	continue; /* invalid */
5859554c BH	79
95ab3669	80	reserve_range(dev, res->start, res->end, 1);
1da177e4 LT	81	}
1da177e4 LT	82
95ab3669 BH	83	for (i = 0; (res = pnp_get_resource(dev, IORESOURCE_MEM, i)); i++) {
95ab3669 BH	84	if (res->flags & IORESOURCE_UNSET)
a8c78f7f BH	85	continue;
a8c78f7f BH	86
95ab3669	87	reserve_range(dev, res->start, res->end, 0);
a8c78f7f	88	}
1da177e4 LT	89	}
1da177e4 LT	90
9dd78466 BH	91	static int system_pnp_probe(struct pnp_dev *dev,
9dd78466 BH	92	const struct pnp_device_id *dev_id)
1da177e4 LT	93	{
	94	reserve_resources_of_dev(dev);
	95	return 0;
	96	}
	97
	98	static struct pnp_driver system_pnp_driver = {
07d4e9af	99	.name = "system",
9dd78466	100	.id_table = pnp_dev_table,
07d4e9af BH	101	.flags = PNP_DRIVER_RES_DO_NOT_CHANGE,
07d4e9af BH	102	.probe = system_pnp_probe,
1da177e4 LT	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);