Loading...
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>
6 *
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 */
21
22#include <linux/export.h>
23#include <linux/acpi.h>
24#include <linux/pnp.h>
25#include <linux/slab.h>
26#include <linux/mod_devicetable.h>
27
28#include "../base.h"
29#include "pnpacpi.h"
30
31static int num;
32
33/* We need only to blacklist devices that have already an acpi driver that
34 * can't use pnp layer. We don't need to blacklist device that are directly
35 * used by the kernel (PCI root, ...), as it is harmless and there were
36 * already present in pnpbios. But there is an exception for devices that
37 * have irqs (PIC, Timer) because we call acpi_register_gsi.
38 * Finally, only devices that have a CRS method need to be in this list.
39 */
40static struct acpi_device_id excluded_id_list[] __initdata = {
41 {"PNP0C09", 0}, /* EC */
42 {"PNP0C0F", 0}, /* Link device */
43 {"PNP0000", 0}, /* PIC */
44 {"PNP0100", 0}, /* Timer */
45 {"", 0},
46};
47
48static inline int __init is_exclusive_device(struct acpi_device *dev)
49{
50 return (!acpi_match_device_ids(dev, excluded_id_list));
51}
52
53/*
54 * Compatible Device IDs
55 */
56#define TEST_HEX(c) \
57 if (!(('0' <= (c) && (c) <= '9') || ('A' <= (c) && (c) <= 'F'))) \
58 return 0
59#define TEST_ALPHA(c) \
60 if (!('A' <= (c) && (c) <= 'Z')) \
61 return 0
62static int __init ispnpidacpi(const char *id)
63{
64 TEST_ALPHA(id[0]);
65 TEST_ALPHA(id[1]);
66 TEST_ALPHA(id[2]);
67 TEST_HEX(id[3]);
68 TEST_HEX(id[4]);
69 TEST_HEX(id[5]);
70 TEST_HEX(id[6]);
71 if (id[7] != '\0')
72 return 0;
73 return 1;
74}
75
76static int pnpacpi_get_resources(struct pnp_dev *dev)
77{
78 pnp_dbg(&dev->dev, "get resources\n");
79 return pnpacpi_parse_allocated_resource(dev);
80}
81
82static int pnpacpi_set_resources(struct pnp_dev *dev)
83{
84 struct acpi_device *acpi_dev;
85 acpi_handle handle;
86 int ret = 0;
87
88 pnp_dbg(&dev->dev, "set resources\n");
89
90 handle = ACPI_HANDLE(&dev->dev);
91 if (!handle || acpi_bus_get_device(handle, &acpi_dev)) {
92 dev_dbg(&dev->dev, "ACPI device not found in %s!\n", __func__);
93 return -ENODEV;
94 }
95
96 if (WARN_ON_ONCE(acpi_dev != dev->data))
97 dev->data = acpi_dev;
98
99 if (acpi_has_method(handle, METHOD_NAME__SRS)) {
100 struct acpi_buffer buffer;
101
102 ret = pnpacpi_build_resource_template(dev, &buffer);
103 if (ret)
104 return ret;
105
106 ret = pnpacpi_encode_resources(dev, &buffer);
107 if (!ret) {
108 acpi_status status;
109
110 status = acpi_set_current_resources(handle, &buffer);
111 if (ACPI_FAILURE(status))
112 ret = -EIO;
113 }
114 kfree(buffer.pointer);
115 }
116 if (!ret && acpi_bus_power_manageable(handle))
117 ret = acpi_bus_set_power(handle, ACPI_STATE_D0);
118
119 return ret;
120}
121
122static int pnpacpi_disable_resources(struct pnp_dev *dev)
123{
124 struct acpi_device *acpi_dev;
125 acpi_handle handle;
126 acpi_status status;
127
128 dev_dbg(&dev->dev, "disable resources\n");
129
130 handle = ACPI_HANDLE(&dev->dev);
131 if (!handle || acpi_bus_get_device(handle, &acpi_dev)) {
132 dev_dbg(&dev->dev, "ACPI device not found in %s!\n", __func__);
133 return 0;
134 }
135
136 /* acpi_unregister_gsi(pnp_irq(dev, 0)); */
137 if (acpi_bus_power_manageable(handle))
138 acpi_bus_set_power(handle, ACPI_STATE_D3_COLD);
139
140 /* continue even if acpi_bus_set_power() fails */
141 status = acpi_evaluate_object(handle, "_DIS", NULL, NULL);
142 if (ACPI_FAILURE(status) && status != AE_NOT_FOUND)
143 return -ENODEV;
144
145 return 0;
146}
147
148#ifdef CONFIG_ACPI_SLEEP
149static bool pnpacpi_can_wakeup(struct pnp_dev *dev)
150{
151 struct acpi_device *acpi_dev;
152 acpi_handle handle;
153
154 handle = ACPI_HANDLE(&dev->dev);
155 if (!handle || acpi_bus_get_device(handle, &acpi_dev)) {
156 dev_dbg(&dev->dev, "ACPI device not found in %s!\n", __func__);
157 return false;
158 }
159
160 return acpi_bus_can_wakeup(handle);
161}
162
163static int pnpacpi_suspend(struct pnp_dev *dev, pm_message_t state)
164{
165 struct acpi_device *acpi_dev;
166 acpi_handle handle;
167 int error = 0;
168
169 handle = ACPI_HANDLE(&dev->dev);
170 if (!handle || acpi_bus_get_device(handle, &acpi_dev)) {
171 dev_dbg(&dev->dev, "ACPI device not found in %s!\n", __func__);
172 return 0;
173 }
174
175 if (device_can_wakeup(&dev->dev)) {
176 error = acpi_pm_device_sleep_wake(&dev->dev,
177 device_may_wakeup(&dev->dev));
178 if (error)
179 return error;
180 }
181
182 if (acpi_bus_power_manageable(handle)) {
183 int power_state = acpi_pm_device_sleep_state(&dev->dev, NULL,
184 ACPI_STATE_D3_COLD);
185 if (power_state < 0)
186 power_state = (state.event == PM_EVENT_ON) ?
187 ACPI_STATE_D0 : ACPI_STATE_D3_COLD;
188
189 /*
190 * acpi_bus_set_power() often fails (keyboard port can't be
191 * powered-down?), and in any case, our return value is ignored
192 * by pnp_bus_suspend(). Hence we don't revert the wakeup
193 * setting if the set_power fails.
194 */
195 error = acpi_bus_set_power(handle, power_state);
196 }
197
198 return error;
199}
200
201static int pnpacpi_resume(struct pnp_dev *dev)
202{
203 struct acpi_device *acpi_dev;
204 acpi_handle handle = ACPI_HANDLE(&dev->dev);
205 int error = 0;
206
207 if (!handle || acpi_bus_get_device(handle, &acpi_dev)) {
208 dev_dbg(&dev->dev, "ACPI device not found in %s!\n", __func__);
209 return -ENODEV;
210 }
211
212 if (device_may_wakeup(&dev->dev))
213 acpi_pm_device_sleep_wake(&dev->dev, false);
214
215 if (acpi_bus_power_manageable(handle))
216 error = acpi_bus_set_power(handle, ACPI_STATE_D0);
217
218 return error;
219}
220#endif
221
222struct pnp_protocol pnpacpi_protocol = {
223 .name = "Plug and Play ACPI",
224 .get = pnpacpi_get_resources,
225 .set = pnpacpi_set_resources,
226 .disable = pnpacpi_disable_resources,
227#ifdef CONFIG_ACPI_SLEEP
228 .can_wakeup = pnpacpi_can_wakeup,
229 .suspend = pnpacpi_suspend,
230 .resume = pnpacpi_resume,
231#endif
232};
233EXPORT_SYMBOL(pnpacpi_protocol);
234
235static char *__init pnpacpi_get_id(struct acpi_device *device)
236{
237 struct acpi_hardware_id *id;
238
239 list_for_each_entry(id, &device->pnp.ids, list) {
240 if (ispnpidacpi(id->id))
241 return id->id;
242 }
243
244 return NULL;
245}
246
247static int __init pnpacpi_add_device(struct acpi_device *device)
248{
249 struct pnp_dev *dev;
250 char *pnpid;
251 struct acpi_hardware_id *id;
252 int error;
253
254 /* Skip devices that are already bound */
255 if (device->physical_node_count)
256 return 0;
257
258 /*
259 * If a PnPacpi device is not present , the device
260 * driver should not be loaded.
261 */
262 if (!acpi_has_method(device->handle, "_CRS"))
263 return 0;
264
265 pnpid = pnpacpi_get_id(device);
266 if (!pnpid)
267 return 0;
268
269 if (is_exclusive_device(device) || !device->status.present)
270 return 0;
271
272 dev = pnp_alloc_dev(&pnpacpi_protocol, num, pnpid);
273 if (!dev)
274 return -ENOMEM;
275
276 dev->data = device;
277 /* .enabled means the device can decode the resources */
278 dev->active = device->status.enabled;
279 if (acpi_has_method(device->handle, "_SRS"))
280 dev->capabilities |= PNP_CONFIGURABLE;
281 dev->capabilities |= PNP_READ;
282 if (device->flags.dynamic_status && (dev->capabilities & PNP_CONFIGURABLE))
283 dev->capabilities |= PNP_WRITE;
284 if (device->flags.removable)
285 dev->capabilities |= PNP_REMOVABLE;
286 if (acpi_has_method(device->handle, "_DIS"))
287 dev->capabilities |= PNP_DISABLE;
288
289 if (strlen(acpi_device_name(device)))
290 strncpy(dev->name, acpi_device_name(device), sizeof(dev->name));
291 else
292 strncpy(dev->name, acpi_device_bid(device), sizeof(dev->name));
293
294 if (dev->active)
295 pnpacpi_parse_allocated_resource(dev);
296
297 if (dev->capabilities & PNP_CONFIGURABLE)
298 pnpacpi_parse_resource_option_data(dev);
299
300 list_for_each_entry(id, &device->pnp.ids, list) {
301 if (!strcmp(id->id, pnpid))
302 continue;
303 if (!ispnpidacpi(id->id))
304 continue;
305 pnp_add_id(dev, id->id);
306 }
307
308 /* clear out the damaged flags */
309 if (!dev->active)
310 pnp_init_resources(dev);
311
312 error = pnp_add_device(dev);
313 if (error) {
314 put_device(&dev->dev);
315 return error;
316 }
317
318 num++;
319
320 return 0;
321}
322
323static acpi_status __init pnpacpi_add_device_handler(acpi_handle handle,
324 u32 lvl, void *context,
325 void **rv)
326{
327 struct acpi_device *device;
328
329 if (!acpi_bus_get_device(handle, &device))
330 pnpacpi_add_device(device);
331 else
332 return AE_CTRL_DEPTH;
333 return AE_OK;
334}
335
336static int __init acpi_pnp_match(struct device *dev, void *_pnp)
337{
338 struct acpi_device *acpi = to_acpi_device(dev);
339 struct pnp_dev *pnp = _pnp;
340
341 /* true means it matched */
342 return !acpi->physical_node_count
343 && compare_pnp_id(pnp->id, acpi_device_hid(acpi));
344}
345
346static struct acpi_device * __init acpi_pnp_find_companion(struct device *dev)
347{
348 dev = bus_find_device(&acpi_bus_type, NULL, to_pnp_dev(dev),
349 acpi_pnp_match);
350 if (!dev)
351 return NULL;
352
353 put_device(dev);
354 return to_acpi_device(dev);
355}
356
357/* complete initialization of a PNPACPI device includes having
358 * pnpdev->dev.archdata.acpi_handle point to its ACPI sibling.
359 */
360static bool acpi_pnp_bus_match(struct device *dev)
361{
362 return dev->bus == &pnp_bus_type;
363}
364
365static struct acpi_bus_type __initdata acpi_pnp_bus = {
366 .name = "PNP",
367 .match = acpi_pnp_bus_match,
368 .find_companion = acpi_pnp_find_companion,
369};
370
371int pnpacpi_disabled __initdata;
372static int __init pnpacpi_init(void)
373{
374 if (acpi_disabled || pnpacpi_disabled) {
375 printk(KERN_INFO "pnp: PnP ACPI: disabled\n");
376 return 0;
377 }
378 printk(KERN_INFO "pnp: PnP ACPI init\n");
379 pnp_register_protocol(&pnpacpi_protocol);
380 register_acpi_bus_type(&acpi_pnp_bus);
381 acpi_get_devices(NULL, pnpacpi_add_device_handler, NULL, NULL);
382 printk(KERN_INFO "pnp: PnP ACPI: found %d devices\n", num);
383 unregister_acpi_bus_type(&acpi_pnp_bus);
384 pnp_platform_devices = 1;
385 return 0;
386}
387
388fs_initcall(pnpacpi_init);
389
390static int __init pnpacpi_setup(char *str)
391{
392 if (str == NULL)
393 return 1;
394 if (!strncmp(str, "off", 3))
395 pnpacpi_disabled = 1;
396 return 1;
397}
398
399__setup("pnpacpi=", pnpacpi_setup);
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>
6 *
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 */
21
22#include <linux/export.h>
23#include <linux/acpi.h>
24#include <linux/pnp.h>
25#include <linux/slab.h>
26#include <linux/mod_devicetable.h>
27#include <acpi/acpi_bus.h>
28
29#include "../base.h"
30#include "pnpacpi.h"
31
32static int num;
33
34/* We need only to blacklist devices that have already an acpi driver that
35 * can't use pnp layer. We don't need to blacklist device that are directly
36 * used by the kernel (PCI root, ...), as it is harmless and there were
37 * already present in pnpbios. But there is an exception for devices that
38 * have irqs (PIC, Timer) because we call acpi_register_gsi.
39 * Finally, only devices that have a CRS method need to be in this list.
40 */
41static struct acpi_device_id excluded_id_list[] __initdata = {
42 {"PNP0C09", 0}, /* EC */
43 {"PNP0C0F", 0}, /* Link device */
44 {"PNP0000", 0}, /* PIC */
45 {"PNP0100", 0}, /* Timer */
46 {"", 0},
47};
48
49static inline int __init is_exclusive_device(struct acpi_device *dev)
50{
51 return (!acpi_match_device_ids(dev, excluded_id_list));
52}
53
54/*
55 * Compatible Device IDs
56 */
57#define TEST_HEX(c) \
58 if (!(('0' <= (c) && (c) <= '9') || ('A' <= (c) && (c) <= 'F'))) \
59 return 0
60#define TEST_ALPHA(c) \
61 if (!('@' <= (c) || (c) <= 'Z')) \
62 return 0
63static int __init ispnpidacpi(const char *id)
64{
65 TEST_ALPHA(id[0]);
66 TEST_ALPHA(id[1]);
67 TEST_ALPHA(id[2]);
68 TEST_HEX(id[3]);
69 TEST_HEX(id[4]);
70 TEST_HEX(id[5]);
71 TEST_HEX(id[6]);
72 if (id[7] != '\0')
73 return 0;
74 return 1;
75}
76
77static int pnpacpi_get_resources(struct pnp_dev *dev)
78{
79 pnp_dbg(&dev->dev, "get resources\n");
80 return pnpacpi_parse_allocated_resource(dev);
81}
82
83static int pnpacpi_set_resources(struct pnp_dev *dev)
84{
85 struct acpi_device *acpi_dev;
86 acpi_handle handle;
87 struct acpi_buffer buffer;
88 int ret;
89
90 pnp_dbg(&dev->dev, "set resources\n");
91
92 handle = DEVICE_ACPI_HANDLE(&dev->dev);
93 if (!handle || ACPI_FAILURE(acpi_bus_get_device(handle, &acpi_dev))) {
94 dev_dbg(&dev->dev, "ACPI device not found in %s!\n", __func__);
95 return -ENODEV;
96 }
97
98 ret = pnpacpi_build_resource_template(dev, &buffer);
99 if (ret)
100 return ret;
101 ret = pnpacpi_encode_resources(dev, &buffer);
102 if (ret) {
103 kfree(buffer.pointer);
104 return ret;
105 }
106 if (ACPI_FAILURE(acpi_set_current_resources(handle, &buffer)))
107 ret = -EINVAL;
108 else if (acpi_bus_power_manageable(handle))
109 ret = acpi_bus_set_power(handle, ACPI_STATE_D0);
110 kfree(buffer.pointer);
111 return ret;
112}
113
114static int pnpacpi_disable_resources(struct pnp_dev *dev)
115{
116 struct acpi_device *acpi_dev;
117 acpi_handle handle;
118 int ret;
119
120 dev_dbg(&dev->dev, "disable resources\n");
121
122 handle = DEVICE_ACPI_HANDLE(&dev->dev);
123 if (!handle || ACPI_FAILURE(acpi_bus_get_device(handle, &acpi_dev))) {
124 dev_dbg(&dev->dev, "ACPI device not found in %s!\n", __func__);
125 return 0;
126 }
127
128 /* acpi_unregister_gsi(pnp_irq(dev, 0)); */
129 ret = 0;
130 if (acpi_bus_power_manageable(handle))
131 acpi_bus_set_power(handle, ACPI_STATE_D3);
132 /* continue even if acpi_bus_set_power() fails */
133 if (ACPI_FAILURE(acpi_evaluate_object(handle, "_DIS", NULL, NULL)))
134 ret = -ENODEV;
135 return ret;
136}
137
138#ifdef CONFIG_ACPI_SLEEP
139static bool pnpacpi_can_wakeup(struct pnp_dev *dev)
140{
141 struct acpi_device *acpi_dev;
142 acpi_handle handle;
143
144 handle = DEVICE_ACPI_HANDLE(&dev->dev);
145 if (!handle || ACPI_FAILURE(acpi_bus_get_device(handle, &acpi_dev))) {
146 dev_dbg(&dev->dev, "ACPI device not found in %s!\n", __func__);
147 return false;
148 }
149
150 return acpi_bus_can_wakeup(handle);
151}
152
153static int pnpacpi_suspend(struct pnp_dev *dev, pm_message_t state)
154{
155 struct acpi_device *acpi_dev;
156 acpi_handle handle;
157 int error = 0;
158
159 handle = DEVICE_ACPI_HANDLE(&dev->dev);
160 if (!handle || ACPI_FAILURE(acpi_bus_get_device(handle, &acpi_dev))) {
161 dev_dbg(&dev->dev, "ACPI device not found in %s!\n", __func__);
162 return 0;
163 }
164
165 if (device_can_wakeup(&dev->dev)) {
166 error = acpi_pm_device_sleep_wake(&dev->dev,
167 device_may_wakeup(&dev->dev));
168 if (error)
169 return error;
170 }
171
172 if (acpi_bus_power_manageable(handle)) {
173 int power_state = acpi_pm_device_sleep_state(&dev->dev, NULL);
174
175 if (power_state < 0)
176 power_state = (state.event == PM_EVENT_ON) ?
177 ACPI_STATE_D0 : ACPI_STATE_D3;
178
179 /*
180 * acpi_bus_set_power() often fails (keyboard port can't be
181 * powered-down?), and in any case, our return value is ignored
182 * by pnp_bus_suspend(). Hence we don't revert the wakeup
183 * setting if the set_power fails.
184 */
185 error = acpi_bus_set_power(handle, power_state);
186 }
187
188 return error;
189}
190
191static int pnpacpi_resume(struct pnp_dev *dev)
192{
193 struct acpi_device *acpi_dev;
194 acpi_handle handle = DEVICE_ACPI_HANDLE(&dev->dev);
195 int error = 0;
196
197 if (!handle || ACPI_FAILURE(acpi_bus_get_device(handle, &acpi_dev))) {
198 dev_dbg(&dev->dev, "ACPI device not found in %s!\n", __func__);
199 return -ENODEV;
200 }
201
202 if (device_may_wakeup(&dev->dev))
203 acpi_pm_device_sleep_wake(&dev->dev, false);
204
205 if (acpi_bus_power_manageable(handle))
206 error = acpi_bus_set_power(handle, ACPI_STATE_D0);
207
208 return error;
209}
210#endif
211
212struct pnp_protocol pnpacpi_protocol = {
213 .name = "Plug and Play ACPI",
214 .get = pnpacpi_get_resources,
215 .set = pnpacpi_set_resources,
216 .disable = pnpacpi_disable_resources,
217#ifdef CONFIG_ACPI_SLEEP
218 .can_wakeup = pnpacpi_can_wakeup,
219 .suspend = pnpacpi_suspend,
220 .resume = pnpacpi_resume,
221#endif
222};
223EXPORT_SYMBOL(pnpacpi_protocol);
224
225static char *__init pnpacpi_get_id(struct acpi_device *device)
226{
227 struct acpi_hardware_id *id;
228
229 list_for_each_entry(id, &device->pnp.ids, list) {
230 if (ispnpidacpi(id->id))
231 return id->id;
232 }
233
234 return NULL;
235}
236
237static int __init pnpacpi_add_device(struct acpi_device *device)
238{
239 acpi_handle temp = NULL;
240 acpi_status status;
241 struct pnp_dev *dev;
242 char *pnpid;
243 struct acpi_hardware_id *id;
244
245 /*
246 * If a PnPacpi device is not present , the device
247 * driver should not be loaded.
248 */
249 status = acpi_get_handle(device->handle, "_CRS", &temp);
250 if (ACPI_FAILURE(status))
251 return 0;
252
253 pnpid = pnpacpi_get_id(device);
254 if (!pnpid)
255 return 0;
256
257 if (is_exclusive_device(device) || !device->status.present)
258 return 0;
259
260 dev = pnp_alloc_dev(&pnpacpi_protocol, num, pnpid);
261 if (!dev)
262 return -ENOMEM;
263
264 dev->data = device;
265 /* .enabled means the device can decode the resources */
266 dev->active = device->status.enabled;
267 status = acpi_get_handle(device->handle, "_SRS", &temp);
268 if (ACPI_SUCCESS(status))
269 dev->capabilities |= PNP_CONFIGURABLE;
270 dev->capabilities |= PNP_READ;
271 if (device->flags.dynamic_status && (dev->capabilities & PNP_CONFIGURABLE))
272 dev->capabilities |= PNP_WRITE;
273 if (device->flags.removable)
274 dev->capabilities |= PNP_REMOVABLE;
275 status = acpi_get_handle(device->handle, "_DIS", &temp);
276 if (ACPI_SUCCESS(status))
277 dev->capabilities |= PNP_DISABLE;
278
279 if (strlen(acpi_device_name(device)))
280 strncpy(dev->name, acpi_device_name(device), sizeof(dev->name));
281 else
282 strncpy(dev->name, acpi_device_bid(device), sizeof(dev->name));
283
284 if (dev->active)
285 pnpacpi_parse_allocated_resource(dev);
286
287 if (dev->capabilities & PNP_CONFIGURABLE)
288 pnpacpi_parse_resource_option_data(dev);
289
290 list_for_each_entry(id, &device->pnp.ids, list) {
291 if (!strcmp(id->id, pnpid))
292 continue;
293 if (!ispnpidacpi(id->id))
294 continue;
295 pnp_add_id(dev, id->id);
296 }
297
298 /* clear out the damaged flags */
299 if (!dev->active)
300 pnp_init_resources(dev);
301 pnp_add_device(dev);
302 num++;
303
304 return AE_OK;
305}
306
307static acpi_status __init pnpacpi_add_device_handler(acpi_handle handle,
308 u32 lvl, void *context,
309 void **rv)
310{
311 struct acpi_device *device;
312
313 if (!acpi_bus_get_device(handle, &device))
314 pnpacpi_add_device(device);
315 else
316 return AE_CTRL_DEPTH;
317 return AE_OK;
318}
319
320static int __init acpi_pnp_match(struct device *dev, void *_pnp)
321{
322 struct acpi_device *acpi = to_acpi_device(dev);
323 struct pnp_dev *pnp = _pnp;
324 struct device *physical_device;
325
326 physical_device = acpi_get_physical_device(acpi->handle);
327 if (physical_device)
328 put_device(physical_device);
329
330 /* true means it matched */
331 return !physical_device
332 && compare_pnp_id(pnp->id, acpi_device_hid(acpi));
333}
334
335static int __init acpi_pnp_find_device(struct device *dev, acpi_handle * handle)
336{
337 struct device *adev;
338 struct acpi_device *acpi;
339
340 adev = bus_find_device(&acpi_bus_type, NULL,
341 to_pnp_dev(dev), acpi_pnp_match);
342 if (!adev)
343 return -ENODEV;
344
345 acpi = to_acpi_device(adev);
346 *handle = acpi->handle;
347 put_device(adev);
348 return 0;
349}
350
351/* complete initialization of a PNPACPI device includes having
352 * pnpdev->dev.archdata.acpi_handle point to its ACPI sibling.
353 */
354static struct acpi_bus_type __initdata acpi_pnp_bus = {
355 .bus = &pnp_bus_type,
356 .find_device = acpi_pnp_find_device,
357};
358
359int pnpacpi_disabled __initdata;
360static int __init pnpacpi_init(void)
361{
362 if (acpi_disabled || pnpacpi_disabled) {
363 printk(KERN_INFO "pnp: PnP ACPI: disabled\n");
364 return 0;
365 }
366 printk(KERN_INFO "pnp: PnP ACPI init\n");
367 pnp_register_protocol(&pnpacpi_protocol);
368 register_acpi_bus_type(&acpi_pnp_bus);
369 acpi_get_devices(NULL, pnpacpi_add_device_handler, NULL, NULL);
370 printk(KERN_INFO "pnp: PnP ACPI: found %d devices\n", num);
371 unregister_acpi_bus_type(&acpi_pnp_bus);
372 pnp_platform_devices = 1;
373 return 0;
374}
375
376fs_initcall(pnpacpi_init);
377
378static int __init pnpacpi_setup(char *str)
379{
380 if (str == NULL)
381 return 1;
382 if (!strncmp(str, "off", 3))
383 pnpacpi_disabled = 1;
384 return 1;
385}
386
387__setup("pnpacpi=", pnpacpi_setup);