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> | |
24 | #include <acpi/acpi_bus.h> | |
25 | #include "pnpacpi.h" | |
26 | ||
27 | static int num = 0; | |
28 | ||
c4bb6f5a | 29 | /* We need only to blacklist devices that have already an acpi driver that |
30 | * can't use pnp layer. We don't need to blacklist device that are directly | |
31 | * used by the kernel (PCI root, ...), as it is harmless and there were | |
32 | * already present in pnpbios. But there is an exception for devices that | |
33 | * have irqs (PIC, Timer) because we call acpi_register_gsi. | |
34 | * Finaly only devices that have a CRS method need to be in this list. | |
35 | */ | |
1da177e4 | 36 | static char __initdata excluded_id_list[] = |
1da177e4 | 37 | "PNP0C09," /* EC */ |
1da177e4 LT |
38 | "PNP0C0F," /* Link device */ |
39 | "PNP0000," /* PIC */ | |
40 | "PNP0100," /* Timer */ | |
41 | ; | |
42 | static inline int is_exclusive_device(struct acpi_device *dev) | |
43 | { | |
44 | return (!acpi_match_ids(dev, excluded_id_list)); | |
45 | } | |
46 | ||
1da177e4 LT |
47 | /* |
48 | * Compatible Device IDs | |
49 | */ | |
50 | #define TEST_HEX(c) \ | |
51 | if (!(('0' <= (c) && (c) <= '9') || ('A' <= (c) && (c) <= 'F'))) \ | |
52 | return 0 | |
53 | #define TEST_ALPHA(c) \ | |
54 | if (!('@' <= (c) || (c) <= 'Z')) \ | |
55 | return 0 | |
56 | static int __init ispnpidacpi(char *id) | |
57 | { | |
58 | TEST_ALPHA(id[0]); | |
59 | TEST_ALPHA(id[1]); | |
60 | TEST_ALPHA(id[2]); | |
61 | TEST_HEX(id[3]); | |
62 | TEST_HEX(id[4]); | |
63 | TEST_HEX(id[5]); | |
64 | TEST_HEX(id[6]); | |
65 | if (id[7] != '\0') | |
66 | return 0; | |
67 | return 1; | |
68 | } | |
69 | ||
70 | static void __init pnpidacpi_to_pnpid(char *id, char *str) | |
71 | { | |
72 | str[0] = id[0]; | |
73 | str[1] = id[1]; | |
74 | str[2] = id[2]; | |
75 | str[3] = tolower(id[3]); | |
76 | str[4] = tolower(id[4]); | |
77 | str[5] = tolower(id[5]); | |
78 | str[6] = tolower(id[6]); | |
79 | str[7] = '\0'; | |
80 | } | |
81 | ||
82 | static int pnpacpi_get_resources(struct pnp_dev * dev, struct pnp_resource_table * res) | |
83 | { | |
84 | acpi_status status; | |
55955aad | 85 | status = pnpacpi_parse_allocated_resource((acpi_handle)dev->data, |
1da177e4 LT |
86 | &dev->res); |
87 | return ACPI_FAILURE(status) ? -ENODEV : 0; | |
88 | } | |
89 | ||
90 | static int pnpacpi_set_resources(struct pnp_dev * dev, struct pnp_resource_table * res) | |
91 | { | |
92 | acpi_handle handle = dev->data; | |
93 | struct acpi_buffer buffer; | |
94 | int ret = 0; | |
95 | acpi_status status; | |
96 | ||
97 | ret = pnpacpi_build_resource_template(handle, &buffer); | |
98 | if (ret) | |
99 | return ret; | |
100 | ret = pnpacpi_encode_resources(res, &buffer); | |
101 | if (ret) { | |
102 | kfree(buffer.pointer); | |
103 | return ret; | |
104 | } | |
105 | status = acpi_set_current_resources(handle, &buffer); | |
106 | if (ACPI_FAILURE(status)) | |
107 | ret = -EINVAL; | |
108 | kfree(buffer.pointer); | |
109 | return ret; | |
110 | } | |
111 | ||
112 | static int pnpacpi_disable_resources(struct pnp_dev *dev) | |
113 | { | |
114 | acpi_status status; | |
55955aad | 115 | |
1da177e4 | 116 | /* acpi_unregister_gsi(pnp_irq(dev, 0)); */ |
55955aad | 117 | status = acpi_evaluate_object((acpi_handle)dev->data, |
1da177e4 LT |
118 | "_DIS", NULL, NULL); |
119 | return ACPI_FAILURE(status) ? -ENODEV : 0; | |
120 | } | |
121 | ||
b449f63c | 122 | static struct pnp_protocol pnpacpi_protocol = { |
1da177e4 LT |
123 | .name = "Plug and Play ACPI", |
124 | .get = pnpacpi_get_resources, | |
125 | .set = pnpacpi_set_resources, | |
126 | .disable = pnpacpi_disable_resources, | |
127 | }; | |
128 | ||
129 | static int __init pnpacpi_add_device(struct acpi_device *device) | |
130 | { | |
131 | acpi_handle temp = NULL; | |
132 | acpi_status status; | |
133 | struct pnp_id *dev_id; | |
134 | struct pnp_dev *dev; | |
135 | ||
07b0120d | 136 | status = acpi_get_handle(device->handle, "_CRS", &temp); |
137 | if (ACPI_FAILURE(status) || !ispnpidacpi(acpi_device_hid(device)) || | |
1da177e4 LT |
138 | is_exclusive_device(device)) |
139 | return 0; | |
140 | ||
141 | pnp_dbg("ACPI device : hid %s", acpi_device_hid(device)); | |
cd861280 | 142 | dev = kzalloc(sizeof(struct pnp_dev), GFP_KERNEL); |
1da177e4 LT |
143 | if (!dev) { |
144 | pnp_err("Out of memory"); | |
145 | return -ENOMEM; | |
146 | } | |
147 | dev->data = device->handle; | |
148 | /* .enabled means if the device can decode the resources */ | |
149 | dev->active = device->status.enabled; | |
150 | status = acpi_get_handle(device->handle, "_SRS", &temp); | |
151 | if (ACPI_SUCCESS(status)) | |
152 | dev->capabilities |= PNP_CONFIGURABLE; | |
153 | dev->capabilities |= PNP_READ; | |
154 | if (device->flags.dynamic_status) | |
155 | dev->capabilities |= PNP_WRITE; | |
156 | if (device->flags.removable) | |
157 | dev->capabilities |= PNP_REMOVABLE; | |
158 | status = acpi_get_handle(device->handle, "_DIS", &temp); | |
159 | if (ACPI_SUCCESS(status)) | |
160 | dev->capabilities |= PNP_DISABLE; | |
161 | ||
162 | dev->protocol = &pnpacpi_protocol; | |
163 | ||
164 | if (strlen(acpi_device_name(device))) | |
165 | strncpy(dev->name, acpi_device_name(device), sizeof(dev->name)); | |
166 | else | |
167 | strncpy(dev->name, acpi_device_bid(device), sizeof(dev->name)); | |
168 | ||
169 | dev->number = num; | |
55955aad | 170 | |
1da177e4 | 171 | /* set the initial values for the PnP device */ |
cd861280 | 172 | dev_id = kzalloc(sizeof(struct pnp_id), GFP_KERNEL); |
1da177e4 LT |
173 | if (!dev_id) |
174 | goto err; | |
175 | pnpidacpi_to_pnpid(acpi_device_hid(device), dev_id->id); | |
176 | pnp_add_id(dev_id, dev); | |
177 | ||
178 | if(dev->active) { | |
179 | /* parse allocated resource */ | |
180 | status = pnpacpi_parse_allocated_resource(device->handle, &dev->res); | |
181 | if (ACPI_FAILURE(status) && (status != AE_NOT_FOUND)) { | |
182 | pnp_err("PnPACPI: METHOD_NAME__CRS failure for %s", dev_id->id); | |
183 | goto err1; | |
184 | } | |
185 | } | |
186 | ||
187 | if(dev->capabilities & PNP_CONFIGURABLE) { | |
55955aad | 188 | status = pnpacpi_parse_resource_option_data(device->handle, |
1da177e4 LT |
189 | dev); |
190 | if (ACPI_FAILURE(status) && (status != AE_NOT_FOUND)) { | |
191 | pnp_err("PnPACPI: METHOD_NAME__PRS failure for %s", dev_id->id); | |
192 | goto err1; | |
193 | } | |
194 | } | |
55955aad | 195 | |
1da177e4 LT |
196 | /* parse compatible ids */ |
197 | if (device->flags.compatible_ids) { | |
198 | struct acpi_compatible_id_list *cid_list = device->pnp.cid_list; | |
199 | int i; | |
200 | ||
201 | for (i = 0; i < cid_list->count; i++) { | |
202 | if (!ispnpidacpi(cid_list->id[i].value)) | |
203 | continue; | |
cd861280 | 204 | dev_id = kzalloc(sizeof(struct pnp_id), GFP_KERNEL); |
1da177e4 LT |
205 | if (!dev_id) |
206 | continue; | |
207 | ||
208 | pnpidacpi_to_pnpid(cid_list->id[i].value, dev_id->id); | |
209 | pnp_add_id(dev_id, dev); | |
210 | } | |
211 | } | |
212 | ||
213 | /* clear out the damaged flags */ | |
214 | if (!dev->active) | |
215 | pnp_init_resource_table(&dev->res); | |
216 | pnp_add_device(dev); | |
217 | num ++; | |
218 | ||
219 | return AE_OK; | |
220 | err1: | |
221 | kfree(dev_id); | |
222 | err: | |
223 | kfree(dev); | |
224 | return -EINVAL; | |
225 | } | |
226 | ||
227 | static acpi_status __init pnpacpi_add_device_handler(acpi_handle handle, | |
228 | u32 lvl, void *context, void **rv) | |
229 | { | |
230 | struct acpi_device *device; | |
231 | ||
232 | if (!acpi_bus_get_device(handle, &device)) | |
233 | pnpacpi_add_device(device); | |
234 | else | |
235 | return AE_CTRL_DEPTH; | |
236 | return AE_OK; | |
237 | } | |
238 | ||
55955aad DB |
239 | static int __init acpi_pnp_match(struct device *dev, void *_pnp) |
240 | { | |
241 | struct acpi_device *acpi = to_acpi_device(dev); | |
242 | struct pnp_dev *pnp = _pnp; | |
243 | ||
244 | /* true means it matched */ | |
245 | return acpi->flags.hardware_id | |
246 | && !acpi_get_physical_device(acpi->handle) | |
247 | && compare_pnp_id(pnp->id, acpi->pnp.hardware_id); | |
248 | } | |
249 | ||
250 | static int __init acpi_pnp_find_device(struct device *dev, acpi_handle *handle) | |
251 | { | |
252 | struct device *adev; | |
253 | struct acpi_device *acpi; | |
254 | ||
255 | adev = bus_find_device(&acpi_bus_type, NULL, | |
256 | to_pnp_dev(dev), | |
257 | acpi_pnp_match); | |
258 | if (!adev) | |
259 | return -ENODEV; | |
260 | ||
261 | acpi = to_acpi_device(adev); | |
262 | *handle = acpi->handle; | |
263 | put_device(adev); | |
264 | return 0; | |
265 | } | |
266 | ||
267 | /* complete initialization of a PNPACPI device includes having | |
268 | * pnpdev->dev.archdata.acpi_handle point to its ACPI sibling. | |
269 | */ | |
270 | static struct acpi_bus_type __initdata acpi_pnp_bus = { | |
271 | .bus = &pnp_bus_type, | |
272 | .find_device = acpi_pnp_find_device, | |
273 | }; | |
274 | ||
1da177e4 | 275 | int pnpacpi_disabled __initdata; |
b449f63c | 276 | static int __init pnpacpi_init(void) |
1da177e4 LT |
277 | { |
278 | if (acpi_disabled || pnpacpi_disabled) { | |
279 | pnp_info("PnP ACPI: disabled"); | |
280 | return 0; | |
281 | } | |
282 | pnp_info("PnP ACPI init"); | |
283 | pnp_register_protocol(&pnpacpi_protocol); | |
55955aad | 284 | register_acpi_bus_type(&acpi_pnp_bus); |
1da177e4 LT |
285 | acpi_get_devices(NULL, pnpacpi_add_device_handler, NULL, NULL); |
286 | pnp_info("PnP ACPI: found %d devices", num); | |
55955aad | 287 | unregister_acpi_bus_type(&acpi_pnp_bus); |
8f81dd14 | 288 | pnp_platform_devices = 1; |
1da177e4 LT |
289 | return 0; |
290 | } | |
291 | subsys_initcall(pnpacpi_init); | |
292 | ||
293 | static int __init pnpacpi_setup(char *str) | |
294 | { | |
295 | if (str == NULL) | |
296 | return 1; | |
297 | if (!strncmp(str, "off", 3)) | |
298 | pnpacpi_disabled = 1; | |
299 | return 1; | |
300 | } | |
301 | __setup("pnpacpi=", pnpacpi_setup); | |
302 | ||
b449f63c | 303 | #if 0 |
1da177e4 | 304 | EXPORT_SYMBOL(pnpacpi_protocol); |
b449f63c | 305 | #endif |