Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * acpi_power.c - ACPI Bus Power Management ($Revision: 39 $) | |
3 | * | |
4 | * Copyright (C) 2001, 2002 Andy Grover <andrew.grover@intel.com> | |
5 | * Copyright (C) 2001, 2002 Paul Diefenbaugh <paul.s.diefenbaugh@intel.com> | |
6 | * | |
7 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | |
8 | * | |
9 | * This program is free software; you can redistribute it and/or modify | |
10 | * it under the terms of the GNU General Public License as published by | |
11 | * the Free Software Foundation; either version 2 of the License, or (at | |
12 | * your option) any later version. | |
13 | * | |
14 | * This program is distributed in the hope that it will be useful, but | |
15 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
16 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
17 | * General Public License for more details. | |
18 | * | |
19 | * You should have received a copy of the GNU General Public License along | |
20 | * with this program; if not, write to the Free Software Foundation, Inc., | |
21 | * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA. | |
22 | * | |
23 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | |
24 | */ | |
25 | ||
26 | /* | |
27 | * ACPI power-managed devices may be controlled in two ways: | |
28 | * 1. via "Device Specific (D-State) Control" | |
29 | * 2. via "Power Resource Control". | |
30 | * This module is used to manage devices relying on Power Resource Control. | |
31 | * | |
32 | * An ACPI "power resource object" describes a software controllable power | |
33 | * plane, clock plane, or other resource used by a power managed device. | |
34 | * A device may rely on multiple power resources, and a power resource | |
35 | * may be shared by multiple devices. | |
36 | */ | |
37 | ||
38 | #include <linux/kernel.h> | |
39 | #include <linux/module.h> | |
40 | #include <linux/init.h> | |
41 | #include <linux/types.h> | |
42 | #include <linux/proc_fs.h> | |
43 | #include <linux/seq_file.h> | |
44 | #include <acpi/acpi_bus.h> | |
45 | #include <acpi/acpi_drivers.h> | |
46 | ||
1da177e4 | 47 | #define _COMPONENT ACPI_POWER_COMPONENT |
f52fd66d | 48 | ACPI_MODULE_NAME("power"); |
1da177e4 LT |
49 | #define ACPI_POWER_COMPONENT 0x00800000 |
50 | #define ACPI_POWER_CLASS "power_resource" | |
1da177e4 LT |
51 | #define ACPI_POWER_DEVICE_NAME "Power Resource" |
52 | #define ACPI_POWER_FILE_INFO "info" | |
53 | #define ACPI_POWER_FILE_STATUS "state" | |
54 | #define ACPI_POWER_RESOURCE_STATE_OFF 0x00 | |
55 | #define ACPI_POWER_RESOURCE_STATE_ON 0x01 | |
56 | #define ACPI_POWER_RESOURCE_STATE_UNKNOWN 0xFF | |
4be44fcd LB |
57 | static int acpi_power_add(struct acpi_device *device); |
58 | static int acpi_power_remove(struct acpi_device *device, int type); | |
e8363f33 | 59 | static int acpi_power_resume(struct acpi_device *device); |
1da177e4 LT |
60 | static int acpi_power_open_fs(struct inode *inode, struct file *file); |
61 | ||
1ba90e3a TR |
62 | static struct acpi_device_id power_device_ids[] = { |
63 | {ACPI_POWER_HID, 0}, | |
64 | {"", 0}, | |
65 | }; | |
66 | MODULE_DEVICE_TABLE(acpi, power_device_ids); | |
67 | ||
1da177e4 | 68 | static struct acpi_driver acpi_power_driver = { |
c2b6705b | 69 | .name = "power", |
4be44fcd | 70 | .class = ACPI_POWER_CLASS, |
1ba90e3a | 71 | .ids = power_device_ids, |
4be44fcd LB |
72 | .ops = { |
73 | .add = acpi_power_add, | |
74 | .remove = acpi_power_remove, | |
0a613902 | 75 | .resume = acpi_power_resume, |
4be44fcd | 76 | }, |
1da177e4 LT |
77 | }; |
78 | ||
0a613902 KK |
79 | struct acpi_power_reference { |
80 | struct list_head node; | |
81 | struct acpi_device *device; | |
82 | }; | |
83 | ||
4be44fcd | 84 | struct acpi_power_resource { |
41598572 | 85 | struct acpi_device * device; |
4be44fcd LB |
86 | acpi_bus_id name; |
87 | u32 system_level; | |
88 | u32 order; | |
0a613902 KK |
89 | struct mutex resource_lock; |
90 | struct list_head reference; | |
1da177e4 LT |
91 | }; |
92 | ||
4be44fcd | 93 | static struct list_head acpi_power_resource_list; |
1da177e4 | 94 | |
d7508032 | 95 | static const struct file_operations acpi_power_fops = { |
cf7acfab | 96 | .owner = THIS_MODULE, |
4be44fcd LB |
97 | .open = acpi_power_open_fs, |
98 | .read = seq_read, | |
99 | .llseek = seq_lseek, | |
100 | .release = single_release, | |
1da177e4 LT |
101 | }; |
102 | ||
103 | /* -------------------------------------------------------------------------- | |
104 | Power Resource Management | |
105 | -------------------------------------------------------------------------- */ | |
106 | ||
107 | static int | |
4be44fcd LB |
108 | acpi_power_get_context(acpi_handle handle, |
109 | struct acpi_power_resource **resource) | |
1da177e4 | 110 | { |
4be44fcd LB |
111 | int result = 0; |
112 | struct acpi_device *device = NULL; | |
1da177e4 | 113 | |
1da177e4 LT |
114 | |
115 | if (!resource) | |
d550d98d | 116 | return -ENODEV; |
1da177e4 LT |
117 | |
118 | result = acpi_bus_get_device(handle, &device); | |
119 | if (result) { | |
cece9296 | 120 | printk(KERN_WARNING PREFIX "Getting context [%p]\n", handle); |
d550d98d | 121 | return result; |
1da177e4 LT |
122 | } |
123 | ||
50dd0969 | 124 | *resource = acpi_driver_data(device); |
a815ab8b | 125 | if (!*resource) |
d550d98d | 126 | return -ENODEV; |
1da177e4 | 127 | |
d550d98d | 128 | return 0; |
1da177e4 LT |
129 | } |
130 | ||
c35923bc | 131 | static int acpi_power_get_state(struct acpi_power_resource *resource, int *state) |
1da177e4 | 132 | { |
4be44fcd LB |
133 | acpi_status status = AE_OK; |
134 | unsigned long sta = 0; | |
1da177e4 | 135 | |
1da177e4 | 136 | |
c35923bc | 137 | if (!resource || !state) |
d550d98d | 138 | return -EINVAL; |
1da177e4 | 139 | |
5fbc19ef | 140 | status = acpi_evaluate_integer(resource->device->handle, "_STA", NULL, &sta); |
1da177e4 | 141 | if (ACPI_FAILURE(status)) |
d550d98d | 142 | return -ENODEV; |
1da177e4 | 143 | |
c35923bc AS |
144 | *state = (sta & 0x01)?ACPI_POWER_RESOURCE_STATE_ON: |
145 | ACPI_POWER_RESOURCE_STATE_OFF; | |
1da177e4 LT |
146 | |
147 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Resource [%s] is %s\n", | |
c35923bc | 148 | resource->name, state ? "on" : "off")); |
1da177e4 | 149 | |
d550d98d | 150 | return 0; |
1da177e4 LT |
151 | } |
152 | ||
4be44fcd | 153 | static int acpi_power_get_list_state(struct acpi_handle_list *list, int *state) |
1da177e4 | 154 | { |
c35923bc | 155 | int result = 0, state1; |
1da177e4 | 156 | struct acpi_power_resource *resource = NULL; |
4be44fcd | 157 | u32 i = 0; |
1da177e4 | 158 | |
1da177e4 LT |
159 | |
160 | if (!list || !state) | |
d550d98d | 161 | return -EINVAL; |
1da177e4 LT |
162 | |
163 | /* The state of the list is 'on' IFF all resources are 'on'. */ | |
164 | ||
4be44fcd | 165 | for (i = 0; i < list->count; i++) { |
1da177e4 LT |
166 | result = acpi_power_get_context(list->handles[i], &resource); |
167 | if (result) | |
d550d98d | 168 | return result; |
c35923bc | 169 | result = acpi_power_get_state(resource, &state1); |
1da177e4 | 170 | if (result) |
d550d98d | 171 | return result; |
1da177e4 | 172 | |
c35923bc | 173 | *state = state1; |
1da177e4 LT |
174 | |
175 | if (*state != ACPI_POWER_RESOURCE_STATE_ON) | |
176 | break; | |
177 | } | |
178 | ||
179 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Resource list is %s\n", | |
4be44fcd | 180 | *state ? "on" : "off")); |
1da177e4 | 181 | |
d550d98d | 182 | return result; |
1da177e4 LT |
183 | } |
184 | ||
0a613902 | 185 | static int acpi_power_on(acpi_handle handle, struct acpi_device *dev) |
1da177e4 | 186 | { |
c35923bc | 187 | int result = 0, state; |
0a613902 | 188 | int found = 0; |
4be44fcd | 189 | acpi_status status = AE_OK; |
1da177e4 | 190 | struct acpi_power_resource *resource = NULL; |
0a613902 KK |
191 | struct list_head *node, *next; |
192 | struct acpi_power_reference *ref; | |
1da177e4 | 193 | |
1da177e4 LT |
194 | |
195 | result = acpi_power_get_context(handle, &resource); | |
196 | if (result) | |
d550d98d | 197 | return result; |
1da177e4 | 198 | |
0a613902 KK |
199 | mutex_lock(&resource->resource_lock); |
200 | list_for_each_safe(node, next, &resource->reference) { | |
201 | ref = container_of(node, struct acpi_power_reference, node); | |
202 | if (dev->handle == ref->device->handle) { | |
203 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Device [%s] already referenced by resource [%s]\n", | |
204 | dev->pnp.bus_id, resource->name)); | |
205 | found = 1; | |
206 | break; | |
207 | } | |
208 | } | |
209 | ||
210 | if (!found) { | |
211 | ref = kmalloc(sizeof (struct acpi_power_reference), | |
212 | irqs_disabled() ? GFP_ATOMIC : GFP_KERNEL); | |
213 | if (!ref) { | |
214 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "kmalloc() failed\n")); | |
215 | mutex_unlock(&resource->resource_lock); | |
216 | return -ENOMEM; | |
217 | } | |
218 | list_add_tail(&ref->node, &resource->reference); | |
219 | ref->device = dev; | |
220 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Device [%s] added to resource [%s] references\n", | |
221 | dev->pnp.bus_id, resource->name)); | |
222 | } | |
223 | mutex_unlock(&resource->resource_lock); | |
1da177e4 | 224 | |
5fbc19ef | 225 | status = acpi_evaluate_object(resource->device->handle, "_ON", NULL, NULL); |
1da177e4 | 226 | if (ACPI_FAILURE(status)) |
d550d98d | 227 | return -ENODEV; |
1da177e4 | 228 | |
c35923bc | 229 | result = acpi_power_get_state(resource, &state); |
1da177e4 | 230 | if (result) |
d550d98d | 231 | return result; |
c35923bc | 232 | if (state != ACPI_POWER_RESOURCE_STATE_ON) |
d550d98d | 233 | return -ENOEXEC; |
1da177e4 LT |
234 | |
235 | /* Update the power resource's _device_ power state */ | |
41598572 | 236 | resource->device->power.state = ACPI_STATE_D0; |
1da177e4 LT |
237 | |
238 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Resource [%s] turned on\n", | |
4be44fcd | 239 | resource->name)); |
d550d98d | 240 | return 0; |
1da177e4 LT |
241 | } |
242 | ||
0a613902 | 243 | static int acpi_power_off_device(acpi_handle handle, struct acpi_device *dev) |
1da177e4 | 244 | { |
c35923bc | 245 | int result = 0, state; |
4be44fcd | 246 | acpi_status status = AE_OK; |
1da177e4 | 247 | struct acpi_power_resource *resource = NULL; |
0a613902 KK |
248 | struct list_head *node, *next; |
249 | struct acpi_power_reference *ref; | |
250 | ||
1da177e4 | 251 | |
1da177e4 LT |
252 | result = acpi_power_get_context(handle, &resource); |
253 | if (result) | |
d550d98d | 254 | return result; |
1da177e4 | 255 | |
0a613902 KK |
256 | mutex_lock(&resource->resource_lock); |
257 | list_for_each_safe(node, next, &resource->reference) { | |
258 | ref = container_of(node, struct acpi_power_reference, node); | |
259 | if (dev->handle == ref->device->handle) { | |
260 | list_del(&ref->node); | |
261 | kfree(ref); | |
262 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Device [%s] removed from resource [%s] references\n", | |
263 | dev->pnp.bus_id, resource->name)); | |
264 | break; | |
265 | } | |
266 | } | |
1da177e4 | 267 | |
0a613902 KK |
268 | if (!list_empty(&resource->reference)) { |
269 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Cannot turn resource [%s] off - resource is in use\n", | |
270 | resource->name)); | |
271 | mutex_unlock(&resource->resource_lock); | |
d550d98d | 272 | return 0; |
1da177e4 | 273 | } |
0a613902 | 274 | mutex_unlock(&resource->resource_lock); |
1da177e4 | 275 | |
5fbc19ef | 276 | status = acpi_evaluate_object(resource->device->handle, "_OFF", NULL, NULL); |
1da177e4 | 277 | if (ACPI_FAILURE(status)) |
d550d98d | 278 | return -ENODEV; |
1da177e4 | 279 | |
c35923bc | 280 | result = acpi_power_get_state(resource, &state); |
1da177e4 | 281 | if (result) |
d550d98d | 282 | return result; |
c35923bc | 283 | if (state != ACPI_POWER_RESOURCE_STATE_OFF) |
d550d98d | 284 | return -ENOEXEC; |
1da177e4 LT |
285 | |
286 | /* Update the power resource's _device_ power state */ | |
786f18c6 | 287 | resource->device->power.state = ACPI_STATE_D3; |
1da177e4 LT |
288 | |
289 | ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Resource [%s] turned off\n", | |
4be44fcd | 290 | resource->name)); |
1da177e4 | 291 | |
d550d98d | 292 | return 0; |
1da177e4 LT |
293 | } |
294 | ||
77e76609 RW |
295 | /** |
296 | * acpi_device_sleep_wake - execute _DSW (Device Sleep Wake) or (deprecated in | |
297 | * ACPI 3.0) _PSW (Power State Wake) | |
298 | * @dev: Device to handle. | |
299 | * @enable: 0 - disable, 1 - enable the wake capabilities of the device. | |
300 | * @sleep_state: Target sleep state of the system. | |
301 | * @dev_state: Target power state of the device. | |
302 | * | |
303 | * Execute _DSW (Device Sleep Wake) or (deprecated in ACPI 3.0) _PSW (Power | |
304 | * State Wake) for the device, if present. On failure reset the device's | |
305 | * wakeup.flags.valid flag. | |
306 | * | |
307 | * RETURN VALUE: | |
308 | * 0 if either _DSW or _PSW has been successfully executed | |
309 | * 0 if neither _DSW nor _PSW has been found | |
310 | * -ENODEV if the execution of either _DSW or _PSW has failed | |
311 | */ | |
312 | int acpi_device_sleep_wake(struct acpi_device *dev, | |
313 | int enable, int sleep_state, int dev_state) | |
314 | { | |
315 | union acpi_object in_arg[3]; | |
316 | struct acpi_object_list arg_list = { 3, in_arg }; | |
317 | acpi_status status = AE_OK; | |
318 | ||
319 | /* | |
320 | * Try to execute _DSW first. | |
321 | * | |
322 | * Three agruments are needed for the _DSW object: | |
323 | * Argument 0: enable/disable the wake capabilities | |
324 | * Argument 1: target system state | |
325 | * Argument 2: target device state | |
326 | * When _DSW object is called to disable the wake capabilities, maybe | |
327 | * the first argument is filled. The values of the other two agruments | |
328 | * are meaningless. | |
329 | */ | |
330 | in_arg[0].type = ACPI_TYPE_INTEGER; | |
331 | in_arg[0].integer.value = enable; | |
332 | in_arg[1].type = ACPI_TYPE_INTEGER; | |
333 | in_arg[1].integer.value = sleep_state; | |
334 | in_arg[2].type = ACPI_TYPE_INTEGER; | |
335 | in_arg[2].integer.value = dev_state; | |
336 | status = acpi_evaluate_object(dev->handle, "_DSW", &arg_list, NULL); | |
337 | if (ACPI_SUCCESS(status)) { | |
338 | return 0; | |
339 | } else if (status != AE_NOT_FOUND) { | |
340 | printk(KERN_ERR PREFIX "_DSW execution failed\n"); | |
341 | dev->wakeup.flags.valid = 0; | |
342 | return -ENODEV; | |
343 | } | |
344 | ||
345 | /* Execute _PSW */ | |
346 | arg_list.count = 1; | |
347 | in_arg[0].integer.value = enable; | |
348 | status = acpi_evaluate_object(dev->handle, "_PSW", &arg_list, NULL); | |
349 | if (ACPI_FAILURE(status) && (status != AE_NOT_FOUND)) { | |
350 | printk(KERN_ERR PREFIX "_PSW execution failed\n"); | |
351 | dev->wakeup.flags.valid = 0; | |
352 | return -ENODEV; | |
353 | } | |
354 | ||
355 | return 0; | |
356 | } | |
357 | ||
1da177e4 LT |
358 | /* |
359 | * Prepare a wakeup device, two steps (Ref ACPI 2.0:P229): | |
360 | * 1. Power on the power resources required for the wakeup device | |
77e76609 RW |
361 | * 2. Execute _DSW (Device Sleep Wake) or (deprecated in ACPI 3.0) _PSW (Power |
362 | * State Wake) for the device, if present | |
1da177e4 | 363 | */ |
77e76609 | 364 | int acpi_enable_wakeup_device_power(struct acpi_device *dev, int sleep_state) |
1da177e4 | 365 | { |
0af4b8c4 | 366 | int i, err; |
1da177e4 | 367 | |
1da177e4 | 368 | if (!dev || !dev->wakeup.flags.valid) |
77e76609 | 369 | return -EINVAL; |
1da177e4 | 370 | |
0af4b8c4 RW |
371 | /* |
372 | * Do not execute the code below twice in a row without calling | |
373 | * acpi_disable_wakeup_device_power() in between for the same device | |
374 | */ | |
375 | if (dev->wakeup.flags.prepared) | |
376 | return 0; | |
377 | ||
1da177e4 LT |
378 | /* Open power resource */ |
379 | for (i = 0; i < dev->wakeup.resources.count; i++) { | |
77e76609 | 380 | int ret = acpi_power_on(dev->wakeup.resources.handles[i], dev); |
1da177e4 | 381 | if (ret) { |
6468463a | 382 | printk(KERN_ERR PREFIX "Transition power state\n"); |
1da177e4 | 383 | dev->wakeup.flags.valid = 0; |
77e76609 | 384 | return -ENODEV; |
1da177e4 LT |
385 | } |
386 | } | |
387 | ||
77e76609 RW |
388 | /* |
389 | * Passing 3 as the third argument below means the device may be placed | |
390 | * in arbitrary power state afterwards. | |
391 | */ | |
0af4b8c4 RW |
392 | err = acpi_device_sleep_wake(dev, 1, sleep_state, 3); |
393 | if (!err) | |
394 | dev->wakeup.flags.prepared = 1; | |
395 | ||
396 | return err; | |
1da177e4 LT |
397 | } |
398 | ||
399 | /* | |
400 | * Shutdown a wakeup device, counterpart of above method | |
77e76609 RW |
401 | * 1. Execute _DSW (Device Sleep Wake) or (deprecated in ACPI 3.0) _PSW (Power |
402 | * State Wake) for the device, if present | |
1da177e4 LT |
403 | * 2. Shutdown down the power resources |
404 | */ | |
4be44fcd | 405 | int acpi_disable_wakeup_device_power(struct acpi_device *dev) |
1da177e4 | 406 | { |
77e76609 | 407 | int i, ret; |
1da177e4 LT |
408 | |
409 | if (!dev || !dev->wakeup.flags.valid) | |
77e76609 | 410 | return -EINVAL; |
1da177e4 | 411 | |
0af4b8c4 RW |
412 | /* |
413 | * Do not execute the code below twice in a row without calling | |
414 | * acpi_enable_wakeup_device_power() in between for the same device | |
415 | */ | |
416 | if (!dev->wakeup.flags.prepared) | |
417 | return 0; | |
418 | ||
419 | dev->wakeup.flags.prepared = 0; | |
420 | ||
77e76609 RW |
421 | ret = acpi_device_sleep_wake(dev, 0, 0, 0); |
422 | if (ret) | |
423 | return ret; | |
1da177e4 LT |
424 | |
425 | /* Close power resource */ | |
426 | for (i = 0; i < dev->wakeup.resources.count; i++) { | |
0a613902 | 427 | ret = acpi_power_off_device(dev->wakeup.resources.handles[i], dev); |
1da177e4 | 428 | if (ret) { |
6468463a | 429 | printk(KERN_ERR PREFIX "Transition power state\n"); |
1da177e4 | 430 | dev->wakeup.flags.valid = 0; |
77e76609 | 431 | return -ENODEV; |
1da177e4 LT |
432 | } |
433 | } | |
434 | ||
d550d98d | 435 | return ret; |
1da177e4 LT |
436 | } |
437 | ||
438 | /* -------------------------------------------------------------------------- | |
439 | Device Power Management | |
440 | -------------------------------------------------------------------------- */ | |
441 | ||
4be44fcd | 442 | int acpi_power_get_inferred_state(struct acpi_device *device) |
1da177e4 | 443 | { |
4be44fcd LB |
444 | int result = 0; |
445 | struct acpi_handle_list *list = NULL; | |
446 | int list_state = 0; | |
447 | int i = 0; | |
1da177e4 | 448 | |
1da177e4 LT |
449 | |
450 | if (!device) | |
d550d98d | 451 | return -EINVAL; |
1da177e4 LT |
452 | |
453 | device->power.state = ACPI_STATE_UNKNOWN; | |
454 | ||
455 | /* | |
456 | * We know a device's inferred power state when all the resources | |
457 | * required for a given D-state are 'on'. | |
458 | */ | |
4be44fcd | 459 | for (i = ACPI_STATE_D0; i < ACPI_STATE_D3; i++) { |
1da177e4 LT |
460 | list = &device->power.states[i].resources; |
461 | if (list->count < 1) | |
462 | continue; | |
463 | ||
464 | result = acpi_power_get_list_state(list, &list_state); | |
465 | if (result) | |
d550d98d | 466 | return result; |
1da177e4 LT |
467 | |
468 | if (list_state == ACPI_POWER_RESOURCE_STATE_ON) { | |
469 | device->power.state = i; | |
d550d98d | 470 | return 0; |
1da177e4 LT |
471 | } |
472 | } | |
473 | ||
474 | device->power.state = ACPI_STATE_D3; | |
475 | ||
d550d98d | 476 | return 0; |
1da177e4 LT |
477 | } |
478 | ||
4be44fcd | 479 | int acpi_power_transition(struct acpi_device *device, int state) |
1da177e4 | 480 | { |
4be44fcd LB |
481 | int result = 0; |
482 | struct acpi_handle_list *cl = NULL; /* Current Resources */ | |
483 | struct acpi_handle_list *tl = NULL; /* Target Resources */ | |
484 | int i = 0; | |
1da177e4 | 485 | |
1da177e4 LT |
486 | |
487 | if (!device || (state < ACPI_STATE_D0) || (state > ACPI_STATE_D3)) | |
d550d98d | 488 | return -EINVAL; |
1da177e4 | 489 | |
4be44fcd LB |
490 | if ((device->power.state < ACPI_STATE_D0) |
491 | || (device->power.state > ACPI_STATE_D3)) | |
d550d98d | 492 | return -ENODEV; |
1da177e4 LT |
493 | |
494 | cl = &device->power.states[device->power.state].resources; | |
495 | tl = &device->power.states[state].resources; | |
496 | ||
1da177e4 LT |
497 | if (!cl->count && !tl->count) { |
498 | result = -ENODEV; | |
499 | goto end; | |
500 | } | |
501 | ||
502 | /* TBD: Resources must be ordered. */ | |
503 | ||
504 | /* | |
505 | * First we reference all power resources required in the target list | |
506 | * (e.g. so the device doesn't lose power while transitioning). | |
507 | */ | |
4be44fcd | 508 | for (i = 0; i < tl->count; i++) { |
0a613902 | 509 | result = acpi_power_on(tl->handles[i], device); |
1da177e4 LT |
510 | if (result) |
511 | goto end; | |
512 | } | |
513 | ||
b1028c54 KK |
514 | if (device->power.state == state) { |
515 | goto end; | |
516 | } | |
517 | ||
1da177e4 LT |
518 | /* |
519 | * Then we dereference all power resources used in the current list. | |
520 | */ | |
4be44fcd | 521 | for (i = 0; i < cl->count; i++) { |
0a613902 | 522 | result = acpi_power_off_device(cl->handles[i], device); |
1da177e4 LT |
523 | if (result) |
524 | goto end; | |
525 | } | |
526 | ||
72925760 | 527 | end: |
e76d5f7e | 528 | if (result) |
72925760 | 529 | device->power.state = ACPI_STATE_UNKNOWN; |
e76d5f7e | 530 | else { |
72925760 KK |
531 | /* We shouldn't change the state till all above operations succeed */ |
532 | device->power.state = state; | |
533 | } | |
1da177e4 | 534 | |
d550d98d | 535 | return result; |
1da177e4 LT |
536 | } |
537 | ||
1da177e4 LT |
538 | /* -------------------------------------------------------------------------- |
539 | FS Interface (/proc) | |
540 | -------------------------------------------------------------------------- */ | |
541 | ||
4be44fcd | 542 | static struct proc_dir_entry *acpi_power_dir; |
1da177e4 LT |
543 | |
544 | static int acpi_power_seq_show(struct seq_file *seq, void *offset) | |
545 | { | |
0a613902 | 546 | int count = 0; |
c35923bc | 547 | int result = 0, state; |
1da177e4 | 548 | struct acpi_power_resource *resource = NULL; |
0a613902 KK |
549 | struct list_head *node, *next; |
550 | struct acpi_power_reference *ref; | |
1da177e4 | 551 | |
1da177e4 | 552 | |
50dd0969 | 553 | resource = seq->private; |
1da177e4 LT |
554 | |
555 | if (!resource) | |
556 | goto end; | |
557 | ||
c35923bc | 558 | result = acpi_power_get_state(resource, &state); |
0a613902 KK |
559 | if (result) |
560 | goto end; | |
561 | ||
1da177e4 | 562 | seq_puts(seq, "state: "); |
c35923bc | 563 | switch (state) { |
1da177e4 LT |
564 | case ACPI_POWER_RESOURCE_STATE_ON: |
565 | seq_puts(seq, "on\n"); | |
566 | break; | |
567 | case ACPI_POWER_RESOURCE_STATE_OFF: | |
568 | seq_puts(seq, "off\n"); | |
569 | break; | |
570 | default: | |
571 | seq_puts(seq, "unknown\n"); | |
572 | break; | |
573 | } | |
574 | ||
0a613902 KK |
575 | mutex_lock(&resource->resource_lock); |
576 | list_for_each_safe(node, next, &resource->reference) { | |
577 | ref = container_of(node, struct acpi_power_reference, node); | |
578 | count++; | |
579 | } | |
580 | mutex_unlock(&resource->resource_lock); | |
581 | ||
1da177e4 | 582 | seq_printf(seq, "system level: S%d\n" |
4be44fcd LB |
583 | "order: %d\n" |
584 | "reference count: %d\n", | |
585 | resource->system_level, | |
0a613902 | 586 | resource->order, count); |
1da177e4 | 587 | |
4be44fcd | 588 | end: |
d550d98d | 589 | return 0; |
1da177e4 LT |
590 | } |
591 | ||
592 | static int acpi_power_open_fs(struct inode *inode, struct file *file) | |
593 | { | |
594 | return single_open(file, acpi_power_seq_show, PDE(inode)->data); | |
595 | } | |
596 | ||
4be44fcd | 597 | static int acpi_power_add_fs(struct acpi_device *device) |
1da177e4 | 598 | { |
4be44fcd | 599 | struct proc_dir_entry *entry = NULL; |
1da177e4 | 600 | |
1da177e4 LT |
601 | |
602 | if (!device) | |
d550d98d | 603 | return -EINVAL; |
1da177e4 LT |
604 | |
605 | if (!acpi_device_dir(device)) { | |
606 | acpi_device_dir(device) = proc_mkdir(acpi_device_bid(device), | |
4be44fcd | 607 | acpi_power_dir); |
1da177e4 | 608 | if (!acpi_device_dir(device)) |
d550d98d | 609 | return -ENODEV; |
1da177e4 LT |
610 | } |
611 | ||
612 | /* 'status' [R] */ | |
cf7acfab DL |
613 | entry = proc_create_data(ACPI_POWER_FILE_STATUS, |
614 | S_IRUGO, acpi_device_dir(device), | |
615 | &acpi_power_fops, acpi_driver_data(device)); | |
1da177e4 | 616 | if (!entry) |
d550d98d | 617 | return -EIO; |
d550d98d | 618 | return 0; |
1da177e4 LT |
619 | } |
620 | ||
4be44fcd | 621 | static int acpi_power_remove_fs(struct acpi_device *device) |
1da177e4 | 622 | { |
1da177e4 LT |
623 | |
624 | if (acpi_device_dir(device)) { | |
625 | remove_proc_entry(ACPI_POWER_FILE_STATUS, | |
626 | acpi_device_dir(device)); | |
627 | remove_proc_entry(acpi_device_bid(device), acpi_power_dir); | |
628 | acpi_device_dir(device) = NULL; | |
629 | } | |
630 | ||
d550d98d | 631 | return 0; |
1da177e4 LT |
632 | } |
633 | ||
1da177e4 LT |
634 | /* -------------------------------------------------------------------------- |
635 | Driver Interface | |
636 | -------------------------------------------------------------------------- */ | |
637 | ||
4be44fcd | 638 | static int acpi_power_add(struct acpi_device *device) |
1da177e4 | 639 | { |
c35923bc | 640 | int result = 0, state; |
4be44fcd | 641 | acpi_status status = AE_OK; |
1da177e4 | 642 | struct acpi_power_resource *resource = NULL; |
4be44fcd LB |
643 | union acpi_object acpi_object; |
644 | struct acpi_buffer buffer = { sizeof(acpi_object), &acpi_object }; | |
1da177e4 | 645 | |
1da177e4 LT |
646 | |
647 | if (!device) | |
d550d98d | 648 | return -EINVAL; |
1da177e4 | 649 | |
36bcbec7 | 650 | resource = kzalloc(sizeof(struct acpi_power_resource), GFP_KERNEL); |
1da177e4 | 651 | if (!resource) |
d550d98d | 652 | return -ENOMEM; |
1da177e4 | 653 | |
41598572 | 654 | resource->device = device; |
0a613902 KK |
655 | mutex_init(&resource->resource_lock); |
656 | INIT_LIST_HEAD(&resource->reference); | |
1da177e4 LT |
657 | strcpy(resource->name, device->pnp.bus_id); |
658 | strcpy(acpi_device_name(device), ACPI_POWER_DEVICE_NAME); | |
659 | strcpy(acpi_device_class(device), ACPI_POWER_CLASS); | |
660 | acpi_driver_data(device) = resource; | |
661 | ||
662 | /* Evalute the object to get the system level and resource order. */ | |
5fbc19ef | 663 | status = acpi_evaluate_object(device->handle, NULL, NULL, &buffer); |
1da177e4 LT |
664 | if (ACPI_FAILURE(status)) { |
665 | result = -ENODEV; | |
666 | goto end; | |
667 | } | |
668 | resource->system_level = acpi_object.power_resource.system_level; | |
669 | resource->order = acpi_object.power_resource.resource_order; | |
670 | ||
c35923bc | 671 | result = acpi_power_get_state(resource, &state); |
1da177e4 LT |
672 | if (result) |
673 | goto end; | |
674 | ||
c35923bc | 675 | switch (state) { |
1da177e4 LT |
676 | case ACPI_POWER_RESOURCE_STATE_ON: |
677 | device->power.state = ACPI_STATE_D0; | |
678 | break; | |
679 | case ACPI_POWER_RESOURCE_STATE_OFF: | |
680 | device->power.state = ACPI_STATE_D3; | |
681 | break; | |
682 | default: | |
683 | device->power.state = ACPI_STATE_UNKNOWN; | |
684 | break; | |
685 | } | |
686 | ||
687 | result = acpi_power_add_fs(device); | |
688 | if (result) | |
689 | goto end; | |
4be44fcd | 690 | |
1da177e4 | 691 | printk(KERN_INFO PREFIX "%s [%s] (%s)\n", acpi_device_name(device), |
c35923bc | 692 | acpi_device_bid(device), state ? "on" : "off"); |
1da177e4 | 693 | |
4be44fcd | 694 | end: |
1da177e4 LT |
695 | if (result) |
696 | kfree(resource); | |
4be44fcd | 697 | |
d550d98d | 698 | return result; |
1da177e4 LT |
699 | } |
700 | ||
4be44fcd | 701 | static int acpi_power_remove(struct acpi_device *device, int type) |
1da177e4 LT |
702 | { |
703 | struct acpi_power_resource *resource = NULL; | |
0a613902 | 704 | struct list_head *node, *next; |
1da177e4 | 705 | |
1da177e4 LT |
706 | |
707 | if (!device || !acpi_driver_data(device)) | |
d550d98d | 708 | return -EINVAL; |
1da177e4 | 709 | |
50dd0969 | 710 | resource = acpi_driver_data(device); |
1da177e4 LT |
711 | |
712 | acpi_power_remove_fs(device); | |
713 | ||
0a613902 KK |
714 | mutex_lock(&resource->resource_lock); |
715 | list_for_each_safe(node, next, &resource->reference) { | |
716 | struct acpi_power_reference *ref = container_of(node, struct acpi_power_reference, node); | |
717 | list_del(&ref->node); | |
718 | kfree(ref); | |
719 | } | |
720 | mutex_unlock(&resource->resource_lock); | |
721 | ||
1da177e4 LT |
722 | kfree(resource); |
723 | ||
d550d98d | 724 | return 0; |
1da177e4 LT |
725 | } |
726 | ||
e8363f33 | 727 | static int acpi_power_resume(struct acpi_device *device) |
0a613902 | 728 | { |
c35923bc | 729 | int result = 0, state; |
0a613902 KK |
730 | struct acpi_power_resource *resource = NULL; |
731 | struct acpi_power_reference *ref; | |
732 | ||
733 | if (!device || !acpi_driver_data(device)) | |
734 | return -EINVAL; | |
735 | ||
736 | resource = (struct acpi_power_resource *)acpi_driver_data(device); | |
737 | ||
c35923bc | 738 | result = acpi_power_get_state(resource, &state); |
0a613902 KK |
739 | if (result) |
740 | return result; | |
741 | ||
742 | mutex_lock(&resource->resource_lock); | |
c35923bc | 743 | if (state == ACPI_POWER_RESOURCE_STATE_OFF && |
0a613902 KK |
744 | !list_empty(&resource->reference)) { |
745 | ref = container_of(resource->reference.next, struct acpi_power_reference, node); | |
746 | mutex_unlock(&resource->resource_lock); | |
747 | result = acpi_power_on(device->handle, ref->device); | |
748 | return result; | |
749 | } | |
750 | ||
751 | mutex_unlock(&resource->resource_lock); | |
752 | return 0; | |
753 | } | |
754 | ||
4be44fcd | 755 | static int __init acpi_power_init(void) |
1da177e4 | 756 | { |
4be44fcd | 757 | int result = 0; |
1da177e4 | 758 | |
1da177e4 LT |
759 | |
760 | if (acpi_disabled) | |
d550d98d | 761 | return 0; |
1da177e4 LT |
762 | |
763 | INIT_LIST_HEAD(&acpi_power_resource_list); | |
764 | ||
765 | acpi_power_dir = proc_mkdir(ACPI_POWER_CLASS, acpi_root_dir); | |
766 | if (!acpi_power_dir) | |
d550d98d | 767 | return -ENODEV; |
1da177e4 LT |
768 | |
769 | result = acpi_bus_register_driver(&acpi_power_driver); | |
770 | if (result < 0) { | |
771 | remove_proc_entry(ACPI_POWER_CLASS, acpi_root_dir); | |
d550d98d | 772 | return -ENODEV; |
1da177e4 LT |
773 | } |
774 | ||
d550d98d | 775 | return 0; |
1da177e4 LT |
776 | } |
777 | ||
778 | subsys_initcall(acpi_power_init); |