PNP: Lindent all source files
[linux-block.git] / drivers / pnp / pnpacpi / core.c
CommitLineData
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
30static 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
39static __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
47static 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
61static 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
75static 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
87static 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
96static 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
119static 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
129static 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
138static 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 143static 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
152static 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
253static 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
266static 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 277static 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 */
296static struct acpi_bus_type __initdata acpi_pnp_bus = {
297 .bus = &pnp_bus_type,
298 .find_device = acpi_pnp_find_device,
299};
300
1da177e4 301int pnpacpi_disabled __initdata;
b449f63c 302static 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
318subsys_initcall(pnpacpi_init);
319
320static 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 332EXPORT_SYMBOL(pnpacpi_protocol);
b449f63c 333#endif