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 | 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. | |
37 | * Finaly only devices that have a CRS method need to be in this list. | |
38 | */ | |
9dd78466 BH |
39 | static __initdata struct acpi_device_id excluded_id_list[] = { |
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; | |
9dd78466 BH |
91 | status = pnpacpi_parse_allocated_resource((acpi_handle) dev->data, |
92 | &dev->res); | |
1da177e4 LT |
93 | return ACPI_FAILURE(status) ? -ENODEV : 0; |
94 | } | |
95 | ||
9dd78466 BH |
96 | static int pnpacpi_set_resources(struct pnp_dev *dev, |
97 | struct pnp_resource_table *res) | |
1da177e4 LT |
98 | { |
99 | acpi_handle handle = dev->data; | |
100 | struct acpi_buffer buffer; | |
101 | int ret = 0; | |
102 | acpi_status status; | |
103 | ||
104 | ret = pnpacpi_build_resource_template(handle, &buffer); | |
105 | if (ret) | |
106 | return ret; | |
107 | ret = pnpacpi_encode_resources(res, &buffer); | |
108 | if (ret) { | |
109 | kfree(buffer.pointer); | |
110 | return ret; | |
111 | } | |
112 | status = acpi_set_current_resources(handle, &buffer); | |
113 | if (ACPI_FAILURE(status)) | |
114 | ret = -EINVAL; | |
115 | kfree(buffer.pointer); | |
116 | return ret; | |
117 | } | |
118 | ||
119 | static int pnpacpi_disable_resources(struct pnp_dev *dev) | |
120 | { | |
121 | acpi_status status; | |
55955aad | 122 | |
1da177e4 | 123 | /* acpi_unregister_gsi(pnp_irq(dev, 0)); */ |
9dd78466 BH |
124 | status = acpi_evaluate_object((acpi_handle) dev->data, |
125 | "_DIS", NULL, NULL); | |
1da177e4 LT |
126 | return ACPI_FAILURE(status) ? -ENODEV : 0; |
127 | } | |
128 | ||
fc30e68e SL |
129 | static int pnpacpi_suspend(struct pnp_dev *dev, pm_message_t state) |
130 | { | |
9dd78466 BH |
131 | return acpi_bus_set_power((acpi_handle) dev->data, |
132 | acpi_pm_device_sleep_state(&dev->dev, | |
133 | device_may_wakeup | |
134 | (&dev->dev), | |
135 | NULL)); | |
fc30e68e SL |
136 | } |
137 | ||
138 | static int pnpacpi_resume(struct pnp_dev *dev) | |
139 | { | |
9dd78466 | 140 | return acpi_bus_set_power((acpi_handle) dev->data, ACPI_STATE_D0); |
fc30e68e SL |
141 | } |
142 | ||
b449f63c | 143 | static struct pnp_protocol pnpacpi_protocol = { |
9dd78466 BH |
144 | .name = "Plug and Play ACPI", |
145 | .get = pnpacpi_get_resources, | |
146 | .set = pnpacpi_set_resources, | |
1da177e4 | 147 | .disable = pnpacpi_disable_resources, |
fc30e68e SL |
148 | .suspend = pnpacpi_suspend, |
149 | .resume = pnpacpi_resume, | |
1da177e4 LT |
150 | }; |
151 | ||
152 | static int __init pnpacpi_add_device(struct acpi_device *device) | |
153 | { | |
154 | acpi_handle temp = NULL; | |
155 | acpi_status status; | |
156 | struct pnp_id *dev_id; | |
157 | struct pnp_dev *dev; | |
158 | ||
07b0120d | 159 | status = acpi_get_handle(device->handle, "_CRS", &temp); |
160 | if (ACPI_FAILURE(status) || !ispnpidacpi(acpi_device_hid(device)) || | |
9dd78466 | 161 | is_exclusive_device(device)) |
1da177e4 LT |
162 | return 0; |
163 | ||
164 | pnp_dbg("ACPI device : hid %s", acpi_device_hid(device)); | |
9dd78466 | 165 | dev = kzalloc(sizeof(struct pnp_dev), GFP_KERNEL); |
1da177e4 LT |
166 | if (!dev) { |
167 | pnp_err("Out of memory"); | |
168 | return -ENOMEM; | |
169 | } | |
170 | dev->data = device->handle; | |
171 | /* .enabled means if the device can decode the resources */ | |
172 | dev->active = device->status.enabled; | |
173 | status = acpi_get_handle(device->handle, "_SRS", &temp); | |
174 | if (ACPI_SUCCESS(status)) | |
175 | dev->capabilities |= PNP_CONFIGURABLE; | |
176 | dev->capabilities |= PNP_READ; | |
177 | if (device->flags.dynamic_status) | |
178 | dev->capabilities |= PNP_WRITE; | |
179 | if (device->flags.removable) | |
180 | dev->capabilities |= PNP_REMOVABLE; | |
181 | status = acpi_get_handle(device->handle, "_DIS", &temp); | |
182 | if (ACPI_SUCCESS(status)) | |
183 | dev->capabilities |= PNP_DISABLE; | |
184 | ||
185 | dev->protocol = &pnpacpi_protocol; | |
186 | ||
187 | if (strlen(acpi_device_name(device))) | |
188 | strncpy(dev->name, acpi_device_name(device), sizeof(dev->name)); | |
189 | else | |
190 | strncpy(dev->name, acpi_device_bid(device), sizeof(dev->name)); | |
191 | ||
192 | dev->number = num; | |
55955aad | 193 | |
1da177e4 | 194 | /* set the initial values for the PnP device */ |
cd861280 | 195 | dev_id = kzalloc(sizeof(struct pnp_id), GFP_KERNEL); |
1da177e4 LT |
196 | if (!dev_id) |
197 | goto err; | |
198 | pnpidacpi_to_pnpid(acpi_device_hid(device), dev_id->id); | |
199 | pnp_add_id(dev_id, dev); | |
200 | ||
9dd78466 | 201 | if (dev->active) { |
1da177e4 | 202 | /* parse allocated resource */ |
9dd78466 BH |
203 | status = |
204 | pnpacpi_parse_allocated_resource(device->handle, &dev->res); | |
1da177e4 | 205 | if (ACPI_FAILURE(status) && (status != AE_NOT_FOUND)) { |
9dd78466 BH |
206 | pnp_err("PnPACPI: METHOD_NAME__CRS failure for %s", |
207 | dev_id->id); | |
1da177e4 LT |
208 | goto err1; |
209 | } | |
210 | } | |
211 | ||
9dd78466 | 212 | if (dev->capabilities & PNP_CONFIGURABLE) { |
55955aad | 213 | status = pnpacpi_parse_resource_option_data(device->handle, |
9dd78466 | 214 | dev); |
1da177e4 | 215 | if (ACPI_FAILURE(status) && (status != AE_NOT_FOUND)) { |
9dd78466 BH |
216 | pnp_err("PnPACPI: METHOD_NAME__PRS failure for %s", |
217 | dev_id->id); | |
1da177e4 LT |
218 | goto err1; |
219 | } | |
220 | } | |
55955aad | 221 | |
1da177e4 LT |
222 | /* parse compatible ids */ |
223 | if (device->flags.compatible_ids) { | |
224 | struct acpi_compatible_id_list *cid_list = device->pnp.cid_list; | |
225 | int i; | |
226 | ||
227 | for (i = 0; i < cid_list->count; i++) { | |
228 | if (!ispnpidacpi(cid_list->id[i].value)) | |
229 | continue; | |
cd861280 | 230 | dev_id = kzalloc(sizeof(struct pnp_id), GFP_KERNEL); |
1da177e4 LT |
231 | if (!dev_id) |
232 | continue; | |
233 | ||
234 | pnpidacpi_to_pnpid(cid_list->id[i].value, dev_id->id); | |
235 | pnp_add_id(dev_id, dev); | |
236 | } | |
237 | } | |
238 | ||
239 | /* clear out the damaged flags */ | |
240 | if (!dev->active) | |
241 | pnp_init_resource_table(&dev->res); | |
242 | pnp_add_device(dev); | |
9dd78466 | 243 | num++; |
1da177e4 LT |
244 | |
245 | return AE_OK; | |
9dd78466 | 246 | err1: |
1da177e4 | 247 | kfree(dev_id); |
9dd78466 | 248 | err: |
1da177e4 LT |
249 | kfree(dev); |
250 | return -EINVAL; | |
251 | } | |
252 | ||
253 | static acpi_status __init pnpacpi_add_device_handler(acpi_handle handle, | |
9dd78466 BH |
254 | u32 lvl, void *context, |
255 | void **rv) | |
1da177e4 LT |
256 | { |
257 | struct acpi_device *device; | |
258 | ||
259 | if (!acpi_bus_get_device(handle, &device)) | |
260 | pnpacpi_add_device(device); | |
261 | else | |
262 | return AE_CTRL_DEPTH; | |
263 | return AE_OK; | |
264 | } | |
265 | ||
55955aad DB |
266 | static int __init acpi_pnp_match(struct device *dev, void *_pnp) |
267 | { | |
9dd78466 BH |
268 | struct acpi_device *acpi = to_acpi_device(dev); |
269 | struct pnp_dev *pnp = _pnp; | |
55955aad DB |
270 | |
271 | /* true means it matched */ | |
272 | return acpi->flags.hardware_id | |
9dd78466 BH |
273 | && !acpi_get_physical_device(acpi->handle) |
274 | && compare_pnp_id(pnp->id, acpi->pnp.hardware_id); | |
55955aad DB |
275 | } |
276 | ||
9dd78466 | 277 | static int __init acpi_pnp_find_device(struct device *dev, acpi_handle * handle) |
55955aad | 278 | { |
9dd78466 BH |
279 | struct device *adev; |
280 | struct acpi_device *acpi; | |
55955aad DB |
281 | |
282 | adev = bus_find_device(&acpi_bus_type, NULL, | |
9dd78466 | 283 | to_pnp_dev(dev), acpi_pnp_match); |
55955aad DB |
284 | if (!adev) |
285 | return -ENODEV; | |
286 | ||
287 | acpi = to_acpi_device(adev); | |
288 | *handle = acpi->handle; | |
289 | put_device(adev); | |
290 | return 0; | |
291 | } | |
292 | ||
293 | /* complete initialization of a PNPACPI device includes having | |
294 | * pnpdev->dev.archdata.acpi_handle point to its ACPI sibling. | |
295 | */ | |
296 | static struct acpi_bus_type __initdata acpi_pnp_bus = { | |
297 | .bus = &pnp_bus_type, | |
298 | .find_device = acpi_pnp_find_device, | |
299 | }; | |
300 | ||
1da177e4 | 301 | int pnpacpi_disabled __initdata; |
b449f63c | 302 | static int __init pnpacpi_init(void) |
1da177e4 LT |
303 | { |
304 | if (acpi_disabled || pnpacpi_disabled) { | |
305 | pnp_info("PnP ACPI: disabled"); | |
306 | return 0; | |
307 | } | |
308 | pnp_info("PnP ACPI init"); | |
309 | pnp_register_protocol(&pnpacpi_protocol); | |
55955aad | 310 | register_acpi_bus_type(&acpi_pnp_bus); |
1da177e4 LT |
311 | acpi_get_devices(NULL, pnpacpi_add_device_handler, NULL, NULL); |
312 | pnp_info("PnP ACPI: found %d devices", num); | |
55955aad | 313 | unregister_acpi_bus_type(&acpi_pnp_bus); |
8f81dd14 | 314 | pnp_platform_devices = 1; |
1da177e4 LT |
315 | return 0; |
316 | } | |
9dd78466 | 317 | |
1da177e4 LT |
318 | subsys_initcall(pnpacpi_init); |
319 | ||
320 | static int __init pnpacpi_setup(char *str) | |
321 | { | |
322 | if (str == NULL) | |
323 | return 1; | |
324 | if (!strncmp(str, "off", 3)) | |
325 | pnpacpi_disabled = 1; | |
326 | return 1; | |
327 | } | |
9dd78466 | 328 | |
1da177e4 LT |
329 | __setup("pnpacpi=", pnpacpi_setup); |
330 | ||
b449f63c | 331 | #if 0 |
1da177e4 | 332 | EXPORT_SYMBOL(pnpacpi_protocol); |
b449f63c | 333 | #endif |