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. |
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; |
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) |
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 | } |
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; |
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 | } |
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); |