]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * pnpacpi -- PnP ACPI driver | |
3 | * | |
4 | * Copyright (c) 2004 Matthieu Castet <castet.matthieu@free.fr> | |
5 | * Copyright (c) 2004 Li Shaohua <shaohua.li@intel.com> | |
55955aad | 6 | * |
1da177e4 LT |
7 | * This program is free software; you can redistribute it and/or modify it |
8 | * under the terms of the GNU General Public License as published by the | |
9 | * Free Software Foundation; either version 2, or (at your option) any | |
10 | * later version. | |
11 | * | |
12 | * This program is distributed in the hope that it will be useful, but | |
13 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
15 | * General Public License for more details. | |
16 | * | |
17 | * You should have received a copy of the GNU General Public License | |
18 | * along with this program; if not, write to the Free Software | |
19 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
20 | */ | |
55955aad | 21 | |
1da177e4 LT |
22 | #include <linux/acpi.h> |
23 | #include <linux/pnp.h> | |
29b71a1c | 24 | #include <linux/mod_devicetable.h> |
1da177e4 | 25 | #include <acpi/acpi_bus.h> |
29b71a1c TR |
26 | #include <acpi/actypes.h> |
27 | ||
1da177e4 LT |
28 | #include "pnpacpi.h" |
29 | ||
30 | static int num = 0; | |
31 | ||
c4bb6f5a MC |
32 | /* We need only to blacklist devices that have already an acpi driver that |
33 | * can't use pnp layer. We don't need to blacklist device that are directly | |
34 | * used by the kernel (PCI root, ...), as it is harmless and there were | |
35 | * already present in pnpbios. But there is an exception for devices that | |
36 | * have irqs (PIC, Timer) because we call acpi_register_gsi. | |
07d4e9af | 37 | * Finally, only devices that have a CRS method need to be in this list. |
c4bb6f5a | 38 | */ |
07d4e9af | 39 | static struct __initdata acpi_device_id excluded_id_list[] = { |
9dd78466 BH |
40 | {"PNP0C09", 0}, /* EC */ |
41 | {"PNP0C0F", 0}, /* Link device */ | |
42 | {"PNP0000", 0}, /* PIC */ | |
43 | {"PNP0100", 0}, /* Timer */ | |
29b71a1c TR |
44 | {"", 0}, |
45 | }; | |
46 | ||
1da177e4 LT |
47 | static inline int is_exclusive_device(struct acpi_device *dev) |
48 | { | |
29b71a1c | 49 | return (!acpi_match_device_ids(dev, excluded_id_list)); |
1da177e4 LT |
50 | } |
51 | ||
1da177e4 LT |
52 | /* |
53 | * Compatible Device IDs | |
54 | */ | |
55 | #define TEST_HEX(c) \ | |
56 | if (!(('0' <= (c) && (c) <= '9') || ('A' <= (c) && (c) <= 'F'))) \ | |
57 | return 0 | |
58 | #define TEST_ALPHA(c) \ | |
59 | if (!('@' <= (c) || (c) <= 'Z')) \ | |
60 | return 0 | |
61 | static int __init ispnpidacpi(char *id) | |
62 | { | |
63 | TEST_ALPHA(id[0]); | |
64 | TEST_ALPHA(id[1]); | |
65 | TEST_ALPHA(id[2]); | |
66 | TEST_HEX(id[3]); | |
67 | TEST_HEX(id[4]); | |
68 | TEST_HEX(id[5]); | |
69 | TEST_HEX(id[6]); | |
70 | if (id[7] != '\0') | |
71 | return 0; | |
72 | return 1; | |
73 | } | |
74 | ||
75 | static void __init pnpidacpi_to_pnpid(char *id, char *str) | |
76 | { | |
77 | str[0] = id[0]; | |
78 | str[1] = id[1]; | |
79 | str[2] = id[2]; | |
80 | str[3] = tolower(id[3]); | |
81 | str[4] = tolower(id[4]); | |
82 | str[5] = tolower(id[5]); | |
83 | str[6] = tolower(id[6]); | |
84 | str[7] = '\0'; | |
85 | } | |
86 | ||
9dd78466 BH |
87 | static int pnpacpi_get_resources(struct pnp_dev *dev, |
88 | struct pnp_resource_table *res) | |
1da177e4 LT |
89 | { |
90 | acpi_status status; | |
07d4e9af | 91 | |
9dd78466 BH |
92 | status = pnpacpi_parse_allocated_resource((acpi_handle) dev->data, |
93 | &dev->res); | |
1da177e4 LT |
94 | return ACPI_FAILURE(status) ? -ENODEV : 0; |
95 | } | |
96 | ||
9dd78466 BH |
97 | static int pnpacpi_set_resources(struct pnp_dev *dev, |
98 | struct pnp_resource_table *res) | |
1da177e4 LT |
99 | { |
100 | acpi_handle handle = dev->data; | |
101 | struct acpi_buffer buffer; | |
102 | int ret = 0; | |
103 | acpi_status status; | |
104 | ||
105 | ret = pnpacpi_build_resource_template(handle, &buffer); | |
106 | if (ret) | |
107 | return ret; | |
108 | ret = pnpacpi_encode_resources(res, &buffer); | |
109 | if (ret) { | |
110 | kfree(buffer.pointer); | |
111 | return ret; | |
112 | } | |
113 | status = acpi_set_current_resources(handle, &buffer); | |
114 | if (ACPI_FAILURE(status)) | |
115 | ret = -EINVAL; | |
116 | kfree(buffer.pointer); | |
117 | return ret; | |
118 | } | |
119 | ||
120 | static int pnpacpi_disable_resources(struct pnp_dev *dev) | |
121 | { | |
122 | acpi_status status; | |
55955aad | 123 | |
1da177e4 | 124 | /* acpi_unregister_gsi(pnp_irq(dev, 0)); */ |
9dd78466 BH |
125 | status = acpi_evaluate_object((acpi_handle) dev->data, |
126 | "_DIS", NULL, NULL); | |
1da177e4 LT |
127 | return ACPI_FAILURE(status) ? -ENODEV : 0; |
128 | } | |
129 | ||
673d5b43 | 130 | #ifdef CONFIG_ACPI_SLEEP |
fc30e68e SL |
131 | static int pnpacpi_suspend(struct pnp_dev *dev, pm_message_t state) |
132 | { | |
9dd78466 BH |
133 | return acpi_bus_set_power((acpi_handle) dev->data, |
134 | acpi_pm_device_sleep_state(&dev->dev, | |
135 | device_may_wakeup | |
136 | (&dev->dev), | |
137 | NULL)); | |
fc30e68e SL |
138 | } |
139 | ||
140 | static int pnpacpi_resume(struct pnp_dev *dev) | |
141 | { | |
9dd78466 | 142 | return acpi_bus_set_power((acpi_handle) dev->data, ACPI_STATE_D0); |
fc30e68e | 143 | } |
673d5b43 | 144 | #endif |
fc30e68e | 145 | |
b449f63c | 146 | static struct pnp_protocol pnpacpi_protocol = { |
07d4e9af BH |
147 | .name = "Plug and Play ACPI", |
148 | .get = pnpacpi_get_resources, | |
149 | .set = pnpacpi_set_resources, | |
1da177e4 | 150 | .disable = pnpacpi_disable_resources, |
673d5b43 | 151 | #ifdef CONFIG_ACPI_SLEEP |
fc30e68e SL |
152 | .suspend = pnpacpi_suspend, |
153 | .resume = pnpacpi_resume, | |
673d5b43 | 154 | #endif |
1da177e4 LT |
155 | }; |
156 | ||
157 | static int __init pnpacpi_add_device(struct acpi_device *device) | |
158 | { | |
159 | acpi_handle temp = NULL; | |
160 | acpi_status status; | |
161 | struct pnp_id *dev_id; | |
162 | struct pnp_dev *dev; | |
163 | ||
07b0120d MC |
164 | status = acpi_get_handle(device->handle, "_CRS", &temp); |
165 | if (ACPI_FAILURE(status) || !ispnpidacpi(acpi_device_hid(device)) || | |
9dd78466 | 166 | is_exclusive_device(device)) |
1da177e4 LT |
167 | return 0; |
168 | ||
169 | pnp_dbg("ACPI device : hid %s", acpi_device_hid(device)); | |
9dd78466 | 170 | dev = kzalloc(sizeof(struct pnp_dev), GFP_KERNEL); |
1da177e4 LT |
171 | if (!dev) { |
172 | pnp_err("Out of memory"); | |
173 | return -ENOMEM; | |
174 | } | |
175 | dev->data = device->handle; | |
07d4e9af | 176 | /* .enabled means the device can decode the resources */ |
1da177e4 LT |
177 | dev->active = device->status.enabled; |
178 | status = acpi_get_handle(device->handle, "_SRS", &temp); | |
179 | if (ACPI_SUCCESS(status)) | |
180 | dev->capabilities |= PNP_CONFIGURABLE; | |
181 | dev->capabilities |= PNP_READ; | |
182 | if (device->flags.dynamic_status) | |
183 | dev->capabilities |= PNP_WRITE; | |
184 | if (device->flags.removable) | |
185 | dev->capabilities |= PNP_REMOVABLE; | |
186 | status = acpi_get_handle(device->handle, "_DIS", &temp); | |
187 | if (ACPI_SUCCESS(status)) | |
188 | dev->capabilities |= PNP_DISABLE; | |
189 | ||
190 | dev->protocol = &pnpacpi_protocol; | |
191 | ||
192 | if (strlen(acpi_device_name(device))) | |
193 | strncpy(dev->name, acpi_device_name(device), sizeof(dev->name)); | |
194 | else | |
195 | strncpy(dev->name, acpi_device_bid(device), sizeof(dev->name)); | |
196 | ||
197 | dev->number = num; | |
55955aad | 198 | |
1da177e4 | 199 | /* set the initial values for the PnP device */ |
cd861280 | 200 | dev_id = kzalloc(sizeof(struct pnp_id), GFP_KERNEL); |
1da177e4 LT |
201 | if (!dev_id) |
202 | goto err; | |
203 | pnpidacpi_to_pnpid(acpi_device_hid(device), dev_id->id); | |
204 | pnp_add_id(dev_id, dev); | |
205 | ||
9dd78466 | 206 | if (dev->active) { |
1da177e4 | 207 | /* parse allocated resource */ |
07d4e9af BH |
208 | status = pnpacpi_parse_allocated_resource(device->handle, |
209 | &dev->res); | |
1da177e4 | 210 | if (ACPI_FAILURE(status) && (status != AE_NOT_FOUND)) { |
9dd78466 BH |
211 | pnp_err("PnPACPI: METHOD_NAME__CRS failure for %s", |
212 | dev_id->id); | |
1da177e4 LT |
213 | goto err1; |
214 | } | |
215 | } | |
216 | ||
9dd78466 | 217 | if (dev->capabilities & PNP_CONFIGURABLE) { |
55955aad | 218 | status = pnpacpi_parse_resource_option_data(device->handle, |
9dd78466 | 219 | dev); |
1da177e4 | 220 | if (ACPI_FAILURE(status) && (status != AE_NOT_FOUND)) { |
9dd78466 BH |
221 | pnp_err("PnPACPI: METHOD_NAME__PRS failure for %s", |
222 | dev_id->id); | |
1da177e4 LT |
223 | goto err1; |
224 | } | |
225 | } | |
55955aad | 226 | |
1da177e4 LT |
227 | /* parse compatible ids */ |
228 | if (device->flags.compatible_ids) { | |
229 | struct acpi_compatible_id_list *cid_list = device->pnp.cid_list; | |
230 | int i; | |
231 | ||
232 | for (i = 0; i < cid_list->count; i++) { | |
233 | if (!ispnpidacpi(cid_list->id[i].value)) | |
234 | continue; | |
cd861280 | 235 | dev_id = kzalloc(sizeof(struct pnp_id), GFP_KERNEL); |
1da177e4 LT |
236 | if (!dev_id) |
237 | continue; | |
238 | ||
239 | pnpidacpi_to_pnpid(cid_list->id[i].value, dev_id->id); | |
240 | pnp_add_id(dev_id, dev); | |
241 | } | |
242 | } | |
243 | ||
244 | /* clear out the damaged flags */ | |
245 | if (!dev->active) | |
246 | pnp_init_resource_table(&dev->res); | |
247 | pnp_add_device(dev); | |
9dd78466 | 248 | num++; |
1da177e4 LT |
249 | |
250 | return AE_OK; | |
9dd78466 | 251 | err1: |
1da177e4 | 252 | kfree(dev_id); |
9dd78466 | 253 | err: |
1da177e4 LT |
254 | kfree(dev); |
255 | return -EINVAL; | |
256 | } | |
257 | ||
258 | static acpi_status __init pnpacpi_add_device_handler(acpi_handle handle, | |
9dd78466 BH |
259 | u32 lvl, void *context, |
260 | void **rv) | |
1da177e4 LT |
261 | { |
262 | struct acpi_device *device; | |
263 | ||
264 | if (!acpi_bus_get_device(handle, &device)) | |
265 | pnpacpi_add_device(device); | |
266 | else | |
267 | return AE_CTRL_DEPTH; | |
268 | return AE_OK; | |
269 | } | |
270 | ||
55955aad DB |
271 | static int __init acpi_pnp_match(struct device *dev, void *_pnp) |
272 | { | |
9dd78466 BH |
273 | struct acpi_device *acpi = to_acpi_device(dev); |
274 | struct pnp_dev *pnp = _pnp; | |
55955aad DB |
275 | |
276 | /* true means it matched */ | |
277 | return acpi->flags.hardware_id | |
9dd78466 BH |
278 | && !acpi_get_physical_device(acpi->handle) |
279 | && compare_pnp_id(pnp->id, acpi->pnp.hardware_id); | |
55955aad DB |
280 | } |
281 | ||
9dd78466 | 282 | static int __init acpi_pnp_find_device(struct device *dev, acpi_handle * handle) |
55955aad | 283 | { |
9dd78466 BH |
284 | struct device *adev; |
285 | struct acpi_device *acpi; | |
55955aad DB |
286 | |
287 | adev = bus_find_device(&acpi_bus_type, NULL, | |
9dd78466 | 288 | to_pnp_dev(dev), acpi_pnp_match); |
55955aad DB |
289 | if (!adev) |
290 | return -ENODEV; | |
291 | ||
292 | acpi = to_acpi_device(adev); | |
293 | *handle = acpi->handle; | |
294 | put_device(adev); | |
295 | return 0; | |
296 | } | |
297 | ||
298 | /* complete initialization of a PNPACPI device includes having | |
299 | * pnpdev->dev.archdata.acpi_handle point to its ACPI sibling. | |
300 | */ | |
301 | static struct acpi_bus_type __initdata acpi_pnp_bus = { | |
07d4e9af | 302 | .bus = &pnp_bus_type, |
55955aad DB |
303 | .find_device = acpi_pnp_find_device, |
304 | }; | |
305 | ||
1da177e4 | 306 | int pnpacpi_disabled __initdata; |
b449f63c | 307 | static int __init pnpacpi_init(void) |
1da177e4 LT |
308 | { |
309 | if (acpi_disabled || pnpacpi_disabled) { | |
310 | pnp_info("PnP ACPI: disabled"); | |
311 | return 0; | |
312 | } | |
313 | pnp_info("PnP ACPI init"); | |
314 | pnp_register_protocol(&pnpacpi_protocol); | |
55955aad | 315 | register_acpi_bus_type(&acpi_pnp_bus); |
1da177e4 LT |
316 | acpi_get_devices(NULL, pnpacpi_add_device_handler, NULL, NULL); |
317 | pnp_info("PnP ACPI: found %d devices", num); | |
55955aad | 318 | unregister_acpi_bus_type(&acpi_pnp_bus); |
8f81dd14 | 319 | pnp_platform_devices = 1; |
1da177e4 LT |
320 | return 0; |
321 | } | |
9dd78466 | 322 | |
1da177e4 LT |
323 | subsys_initcall(pnpacpi_init); |
324 | ||
325 | static int __init pnpacpi_setup(char *str) | |
326 | { | |
327 | if (str == NULL) | |
328 | return 1; | |
329 | if (!strncmp(str, "off", 3)) | |
330 | pnpacpi_disabled = 1; | |
331 | return 1; | |
332 | } | |
9dd78466 | 333 | |
1da177e4 | 334 | __setup("pnpacpi=", pnpacpi_setup); |