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