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