power.c 24.1 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41
/*
 *  acpi_power.c - ACPI Bus Power Management ($Revision: 39 $)
 *
 *  Copyright (C) 2001, 2002 Andy Grover <andrew.grover@intel.com>
 *  Copyright (C) 2001, 2002 Paul Diefenbaugh <paul.s.diefenbaugh@intel.com>
 *
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or (at
 *  your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful, but
 *  WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 *  General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License along
 *  with this program; if not, write to the Free Software Foundation, Inc.,
 *  59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
 *
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 */

/*
 * ACPI power-managed devices may be controlled in two ways:
 * 1. via "Device Specific (D-State) Control"
 * 2. via "Power Resource Control".
 * This module is used to manage devices relying on Power Resource Control.
 * 
 * An ACPI "power resource object" describes a software controllable power
 * plane, clock plane, or other resource used by a power managed device.
 * A device may rely on multiple power resources, and a power resource
 * may be shared by multiple devices.
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/types.h>
42
#include <linux/slab.h>
43
#include <linux/pm_runtime.h>
44
#include <linux/sysfs.h>
L
Linus Torvalds 已提交
45 46
#include <acpi/acpi_bus.h>
#include <acpi/acpi_drivers.h>
47
#include "sleep.h"
48
#include "internal.h"
49

50 51
#define PREFIX "ACPI: "

52
#define _COMPONENT			ACPI_POWER_COMPONENT
53
ACPI_MODULE_NAME("power");
L
Linus Torvalds 已提交
54 55 56 57 58 59 60
#define ACPI_POWER_CLASS		"power_resource"
#define ACPI_POWER_DEVICE_NAME		"Power Resource"
#define ACPI_POWER_FILE_INFO		"info"
#define ACPI_POWER_FILE_STATUS		"state"
#define ACPI_POWER_RESOURCE_STATE_OFF	0x00
#define ACPI_POWER_RESOURCE_STATE_ON	0x01
#define ACPI_POWER_RESOURCE_STATE_UNKNOWN 0xFF
61

62 63 64 65
struct acpi_power_dependent_device {
	struct list_head node;
	struct acpi_device *adev;
	struct work_struct work;
66 67
};

L
Len Brown 已提交
68
struct acpi_power_resource {
69
	struct acpi_device device;
70
	struct list_head list_node;
71
	struct list_head dependent;
72
	char *name;
L
Len Brown 已提交
73 74
	u32 system_level;
	u32 order;
75
	unsigned int ref_count;
76
	bool wakeup_enabled;
77
	struct mutex resource_lock;
L
Linus Torvalds 已提交
78 79
};

80 81 82 83 84
struct acpi_power_resource_entry {
	struct list_head node;
	struct acpi_power_resource *resource;
};

85 86
static LIST_HEAD(acpi_power_resource_list);
static DEFINE_MUTEX(power_resource_list_lock);
L
Linus Torvalds 已提交
87 88 89 90 91

/* --------------------------------------------------------------------------
                             Power Resource Management
   -------------------------------------------------------------------------- */

92 93 94 95 96 97
static inline
struct acpi_power_resource *to_power_resource(struct acpi_device *device)
{
	return container_of(device, struct acpi_power_resource, device);
}

98
static struct acpi_power_resource *acpi_power_get_context(acpi_handle handle)
L
Linus Torvalds 已提交
99
{
100
	struct acpi_device *device;
L
Linus Torvalds 已提交
101

102 103
	if (acpi_bus_get_device(handle, &device))
		return NULL;
L
Linus Torvalds 已提交
104

105
	return to_power_resource(device);
L
Linus Torvalds 已提交
106 107
}

108 109
static int acpi_power_resources_list_add(acpi_handle handle,
					 struct list_head *list)
110 111 112 113 114
{
	struct acpi_power_resource *resource = acpi_power_get_context(handle);
	struct acpi_power_resource_entry *entry;

	if (!resource || !list)
115
		return -EINVAL;
116 117 118

	entry = kzalloc(sizeof(*entry), GFP_KERNEL);
	if (!entry)
119
		return -ENOMEM;
120 121 122 123 124 125 126 127

	entry->resource = resource;
	if (!list_empty(list)) {
		struct acpi_power_resource_entry *e;

		list_for_each_entry(e, list, node)
			if (e->resource->order > resource->order) {
				list_add_tail(&entry->node, &e->node);
128
				return 0;
129 130 131
			}
	}
	list_add_tail(&entry->node, list);
132
	return 0;
133 134 135 136 137 138 139 140 141 142 143 144
}

void acpi_power_resources_list_free(struct list_head *list)
{
	struct acpi_power_resource_entry *entry, *e;

	list_for_each_entry_safe(entry, e, list, node) {
		list_del(&entry->node);
		kfree(entry);
	}
}

145 146
int acpi_extract_power_resources(union acpi_object *package, unsigned int start,
				 struct list_head *list)
147 148
{
	unsigned int i;
149
	int err = 0;
150 151 152 153 154 155

	for (i = start; i < package->package.count; i++) {
		union acpi_object *element = &package->package.elements[i];
		acpi_handle rhandle;

		if (element->type != ACPI_TYPE_LOCAL_REFERENCE) {
156
			err = -ENODATA;
157 158 159 160
			break;
		}
		rhandle = element->reference.handle;
		if (!rhandle) {
161
			err = -ENODEV;
162 163
			break;
		}
164 165 166 167 168 169 170
		err = acpi_add_power_resource(rhandle);
		if (err)
			break;

		err = acpi_power_resources_list_add(rhandle, list);
		if (err)
			break;
171
	}
172
	if (err)
173 174
		acpi_power_resources_list_free(list);

175
	return err;
176 177
}

178
static int acpi_power_get_state(acpi_handle handle, int *state)
L
Linus Torvalds 已提交
179
{
L
Len Brown 已提交
180
	acpi_status status = AE_OK;
181
	unsigned long long sta = 0;
182 183
	char node_name[5];
	struct acpi_buffer buffer = { sizeof(node_name), node_name };
L
Linus Torvalds 已提交
184 185


186
	if (!handle || !state)
187
		return -EINVAL;
L
Linus Torvalds 已提交
188

189
	status = acpi_evaluate_integer(handle, "_STA", NULL, &sta);
L
Linus Torvalds 已提交
190
	if (ACPI_FAILURE(status))
191
		return -ENODEV;
L
Linus Torvalds 已提交
192

193 194
	*state = (sta & 0x01)?ACPI_POWER_RESOURCE_STATE_ON:
			      ACPI_POWER_RESOURCE_STATE_OFF;
L
Linus Torvalds 已提交
195

196 197
	acpi_get_name(handle, ACPI_SINGLE_NAME, &buffer);

L
Linus Torvalds 已提交
198
	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Resource [%s] is %s\n",
199
			  node_name,
200
				*state ? "on" : "off"));
L
Linus Torvalds 已提交
201

202
	return 0;
L
Linus Torvalds 已提交
203 204
}

205
static int acpi_power_get_list_state(struct list_head *list, int *state)
L
Linus Torvalds 已提交
206
{
207
	struct acpi_power_resource_entry *entry;
208
	int cur_state;
L
Linus Torvalds 已提交
209 210

	if (!list || !state)
211
		return -EINVAL;
L
Linus Torvalds 已提交
212 213

	/* The state of the list is 'on' IFF all resources are 'on'. */
214 215 216
	list_for_each_entry(entry, list, node) {
		struct acpi_power_resource *resource = entry->resource;
		acpi_handle handle = resource->device.handle;
217 218 219 220 221 222 223 224 225
		int result;

		mutex_lock(&resource->resource_lock);
		result = acpi_power_get_state(handle, &cur_state);
		mutex_unlock(&resource->resource_lock);
		if (result)
			return result;

		if (cur_state != ACPI_POWER_RESOURCE_STATE_ON)
L
Linus Torvalds 已提交
226 227 228 229
			break;
	}

	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Resource list is %s\n",
230
			  cur_state ? "on" : "off"));
L
Linus Torvalds 已提交
231

232 233
	*state = cur_state;
	return 0;
L
Linus Torvalds 已提交
234 235
}

236
static void acpi_power_resume_dependent(struct work_struct *work)
237
{
238 239 240
	struct acpi_power_dependent_device *dep;
	struct acpi_device_physical_node *pn;
	struct acpi_device *adev;
241 242
	int state;

243 244 245
	dep = container_of(work, struct acpi_power_dependent_device, work);
	adev = dep->adev;
	if (acpi_power_get_inferred_state(adev, &state))
246 247
		return;

248
	if (state > ACPI_STATE_D0)
249 250
		return;

251 252 253 254 255 256 257 258 259
	mutex_lock(&adev->physical_node_lock);

	list_for_each_entry(pn, &adev->physical_node_list, node)
		pm_request_resume(pn->dev);

	list_for_each_entry(pn, &adev->power_dependent, node)
		pm_request_resume(pn->dev);

	mutex_unlock(&adev->physical_node_lock);
260 261
}

262
static int __acpi_power_on(struct acpi_power_resource *resource)
L
Linus Torvalds 已提交
263
{
L
Len Brown 已提交
264
	acpi_status status = AE_OK;
L
Linus Torvalds 已提交
265

266
	status = acpi_evaluate_object(resource->device.handle, "_ON", NULL, NULL);
267 268 269 270 271 272 273 274 275
	if (ACPI_FAILURE(status))
		return -ENODEV;

	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Power resource [%s] turned on\n",
			  resource->name));

	return 0;
}

276
static int acpi_power_on_unlocked(struct acpi_power_resource *resource)
277
{
278
	int result = 0;
279

280 281
	if (resource->ref_count++) {
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
282
				  "Power resource [%s] already on\n",
283 284 285
				  resource->name));
	} else {
		result = __acpi_power_on(resource);
286
		if (result) {
287
			resource->ref_count--;
288 289
		} else {
			struct acpi_power_dependent_device *dep;
290

291 292 293
			list_for_each_entry(dep, &resource->dependent, node)
				schedule_work(&dep->work);
		}
294
	}
295 296
	return result;
}
297

298 299 300
static int acpi_power_on(struct acpi_power_resource *resource)
{
	int result;
301

302 303 304
	mutex_lock(&resource->resource_lock);
	result = acpi_power_on_unlocked(resource);
	mutex_unlock(&resource->resource_lock);
305
	return result;
L
Linus Torvalds 已提交
306 307
}

308 309 310 311 312 313 314 315 316 317 318 319 320 321
static int __acpi_power_off(struct acpi_power_resource *resource)
{
	acpi_status status;

	status = acpi_evaluate_object(resource->device.handle, "_OFF",
				      NULL, NULL);
	if (ACPI_FAILURE(status))
		return -ENODEV;

	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Power resource [%s] turned off\n",
			  resource->name));
	return 0;
}

322
static int acpi_power_off_unlocked(struct acpi_power_resource *resource)
L
Linus Torvalds 已提交
323
{
324
	int result = 0;
L
Linus Torvalds 已提交
325

326 327
	if (!resource->ref_count) {
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
328
				  "Power resource [%s] already off\n",
329
				  resource->name));
330
		return 0;
331
	}
L
Linus Torvalds 已提交
332

333 334 335 336
	if (--resource->ref_count) {
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
				  "Power resource [%s] still in use\n",
				  resource->name));
337 338 339 340
	} else {
		result = __acpi_power_off(resource);
		if (result)
			resource->ref_count++;
L
Linus Torvalds 已提交
341
	}
342 343
	return result;
}
L
Linus Torvalds 已提交
344

345 346 347
static int acpi_power_off(struct acpi_power_resource *resource)
{
	int result;
L
Linus Torvalds 已提交
348

349 350 351
	mutex_lock(&resource->resource_lock);
	result = acpi_power_off_unlocked(resource);
	mutex_unlock(&resource->resource_lock);
352
	return result;
L
Linus Torvalds 已提交
353 354
}

355
static int acpi_power_off_list(struct list_head *list)
356
{
357 358
	struct acpi_power_resource_entry *entry;
	int result = 0;
359

360 361 362 363 364 365
	list_for_each_entry_reverse(entry, list, node) {
		result = acpi_power_off(entry->resource);
		if (result)
			goto err;
	}
	return 0;
366

367 368 369 370 371
 err:
	list_for_each_entry_continue(entry, list, node)
		acpi_power_on(entry->resource);

	return result;
372 373
}

374
static int acpi_power_on_list(struct list_head *list)
375
{
376
	struct acpi_power_resource_entry *entry;
377 378
	int result = 0;

379 380 381 382
	list_for_each_entry(entry, list, node) {
		result = acpi_power_on(entry->resource);
		if (result)
			goto err;
383
	}
384 385 386 387 388
	return 0;

 err:
	list_for_each_entry_continue_reverse(entry, list, node)
		acpi_power_off(entry->resource);
389 390 391 392

	return result;
}

393
static void acpi_power_add_dependent(struct acpi_power_resource *resource,
394
				     struct acpi_device *adev)
395
{
396
	struct acpi_power_dependent_device *dep;
397

398
	mutex_lock(&resource->resource_lock);
399

400 401 402
	list_for_each_entry(dep, &resource->dependent, node)
		if (dep->adev == adev)
			goto out;
403

404 405 406
	dep = kzalloc(sizeof(*dep), GFP_KERNEL);
	if (!dep)
		goto out;
407

408 409 410
	dep->adev = adev;
	INIT_WORK(&dep->work, acpi_power_resume_dependent);
	list_add_tail(&dep->node, &resource->dependent);
411

412 413
 out:
	mutex_unlock(&resource->resource_lock);
414 415
}

416
static void acpi_power_remove_dependent(struct acpi_power_resource *resource,
417
					struct acpi_device *adev)
418
{
419 420
	struct acpi_power_dependent_device *dep;
	struct work_struct *work = NULL;
421

422
	mutex_lock(&resource->resource_lock);
423

424 425 426 427 428 429
	list_for_each_entry(dep, &resource->dependent, node)
		if (dep->adev == adev) {
			list_del(&dep->node);
			work = &dep->work;
			break;
		}
430

431
	mutex_unlock(&resource->resource_lock);
432

433 434 435 436
	if (work) {
		cancel_work_sync(work);
		kfree(dep);
	}
437 438
}

439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461
static struct attribute *attrs[] = {
	NULL,
};

static struct attribute_group attr_groups[] = {
	[ACPI_STATE_D0] = {
		.name = "power_resources_D0",
		.attrs = attrs,
	},
	[ACPI_STATE_D1] = {
		.name = "power_resources_D1",
		.attrs = attrs,
	},
	[ACPI_STATE_D2] = {
		.name = "power_resources_D2",
		.attrs = attrs,
	},
	[ACPI_STATE_D3_HOT] = {
		.name = "power_resources_D3hot",
		.attrs = attrs,
	},
};

462 463 464 465 466 467 468 469
static struct attribute_group wakeup_attr_group = {
	.name = "power_resources_wakeup",
	.attrs = attrs,
};

static void acpi_power_hide_list(struct acpi_device *adev,
				 struct list_head *resources,
				 struct attribute_group *attr_group)
470 471 472
{
	struct acpi_power_resource_entry *entry;

473
	if (list_empty(resources))
474 475
		return;

476
	list_for_each_entry_reverse(entry, resources, node) {
477 478 479
		struct acpi_device *res_dev = &entry->resource->device;

		sysfs_remove_link_from_group(&adev->dev.kobj,
480
					     attr_group->name,
481 482
					     dev_name(&res_dev->dev));
	}
483
	sysfs_remove_group(&adev->dev.kobj, attr_group);
484 485
}

486 487 488
static void acpi_power_expose_list(struct acpi_device *adev,
				   struct list_head *resources,
				   struct attribute_group *attr_group)
489
{
490 491 492
	struct acpi_power_resource_entry *entry;
	int ret;

493
	if (list_empty(resources))
494 495
		return;

496
	ret = sysfs_create_group(&adev->dev.kobj, attr_group);
497 498 499
	if (ret)
		return;

500
	list_for_each_entry(entry, resources, node) {
501 502 503
		struct acpi_device *res_dev = &entry->resource->device;

		ret = sysfs_add_link_to_group(&adev->dev.kobj,
504
					      attr_group->name,
505 506 507
					      &res_dev->dev.kobj,
					      dev_name(&res_dev->dev));
		if (ret) {
508
			acpi_power_hide_list(adev, resources, attr_group);
509
			break;
510 511 512
		}
	}
}
513

514 515 516 517 518 519 520 521 522 523 524
static void acpi_power_expose_hide(struct acpi_device *adev,
				   struct list_head *resources,
				   struct attribute_group *attr_group,
				   bool expose)
{
	if (expose)
		acpi_power_expose_list(adev, resources, attr_group);
	else
		acpi_power_hide_list(adev, resources, attr_group);
}

525 526 527 528 529 530
void acpi_power_add_remove_device(struct acpi_device *adev, bool add)
{
	struct acpi_device_power_state *ps;
	struct acpi_power_resource_entry *entry;
	int state;

531 532 533 534
	if (adev->wakeup.flags.valid)
		acpi_power_expose_hide(adev, &adev->wakeup.resources,
				       &wakeup_attr_group, add);

535 536 537 538 539 540 541 542 543 544 545 546 547
	if (!adev->power.flags.power_resources)
		return;

	ps = &adev->power.states[ACPI_STATE_D0];
	list_for_each_entry(entry, &ps->resources, node) {
		struct acpi_power_resource *resource = entry->resource;

		if (add)
			acpi_power_add_dependent(resource, adev);
		else
			acpi_power_remove_dependent(resource, adev);
	}

548 549 550 551
	for (state = ACPI_STATE_D0; state <= ACPI_STATE_D3_HOT; state++)
		acpi_power_expose_hide(adev,
				       &adev->power.states[state].resources,
				       &attr_groups[state], add);
552 553
}

554
int acpi_power_wakeup_list_init(struct list_head *list, int *system_level_p)
555 556 557 558 559 560
{
	struct acpi_power_resource_entry *entry;
	int system_level = 5;

	list_for_each_entry(entry, list, node) {
		struct acpi_power_resource *resource = entry->resource;
561 562 563
		acpi_handle handle = resource->device.handle;
		int result;
		int state;
564

565 566 567 568 569 570 571 572 573 574 575
		mutex_lock(&resource->resource_lock);

		result = acpi_power_get_state(handle, &state);
		if (result) {
			mutex_unlock(&resource->resource_lock);
			return result;
		}
		if (state == ACPI_POWER_RESOURCE_STATE_ON) {
			resource->ref_count++;
			resource->wakeup_enabled = true;
		}
576 577
		if (system_level > resource->system_level)
			system_level = resource->system_level;
578 579

		mutex_unlock(&resource->resource_lock);
580
	}
581 582
	*system_level_p = system_level;
	return 0;
583 584
}

585 586 587
/* --------------------------------------------------------------------------
                             Device Power Management
   -------------------------------------------------------------------------- */
588

589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639
/**
 * acpi_device_sleep_wake - execute _DSW (Device Sleep Wake) or (deprecated in
 *                          ACPI 3.0) _PSW (Power State Wake)
 * @dev: Device to handle.
 * @enable: 0 - disable, 1 - enable the wake capabilities of the device.
 * @sleep_state: Target sleep state of the system.
 * @dev_state: Target power state of the device.
 *
 * Execute _DSW (Device Sleep Wake) or (deprecated in ACPI 3.0) _PSW (Power
 * State Wake) for the device, if present.  On failure reset the device's
 * wakeup.flags.valid flag.
 *
 * RETURN VALUE:
 * 0 if either _DSW or _PSW has been successfully executed
 * 0 if neither _DSW nor _PSW has been found
 * -ENODEV if the execution of either _DSW or _PSW has failed
 */
int acpi_device_sleep_wake(struct acpi_device *dev,
                           int enable, int sleep_state, int dev_state)
{
	union acpi_object in_arg[3];
	struct acpi_object_list arg_list = { 3, in_arg };
	acpi_status status = AE_OK;

	/*
	 * Try to execute _DSW first.
	 *
	 * Three agruments are needed for the _DSW object:
	 * Argument 0: enable/disable the wake capabilities
	 * Argument 1: target system state
	 * Argument 2: target device state
	 * When _DSW object is called to disable the wake capabilities, maybe
	 * the first argument is filled. The values of the other two agruments
	 * are meaningless.
	 */
	in_arg[0].type = ACPI_TYPE_INTEGER;
	in_arg[0].integer.value = enable;
	in_arg[1].type = ACPI_TYPE_INTEGER;
	in_arg[1].integer.value = sleep_state;
	in_arg[2].type = ACPI_TYPE_INTEGER;
	in_arg[2].integer.value = dev_state;
	status = acpi_evaluate_object(dev->handle, "_DSW", &arg_list, NULL);
	if (ACPI_SUCCESS(status)) {
		return 0;
	} else if (status != AE_NOT_FOUND) {
		printk(KERN_ERR PREFIX "_DSW execution failed\n");
		dev->wakeup.flags.valid = 0;
		return -ENODEV;
	}

	/* Execute _PSW */
640
	status = acpi_execute_simple_method(dev->handle, "_PSW", enable);
641 642 643 644 645 646 647 648 649
	if (ACPI_FAILURE(status) && (status != AE_NOT_FOUND)) {
		printk(KERN_ERR PREFIX "_PSW execution failed\n");
		dev->wakeup.flags.valid = 0;
		return -ENODEV;
	}

	return 0;
}

L
Linus Torvalds 已提交
650 651 652
/*
 * Prepare a wakeup device, two steps (Ref ACPI 2.0:P229):
 * 1. Power on the power resources required for the wakeup device 
653 654
 * 2. Execute _DSW (Device Sleep Wake) or (deprecated in ACPI 3.0) _PSW (Power
 *    State Wake) for the device, if present
L
Linus Torvalds 已提交
655
 */
656
int acpi_enable_wakeup_device_power(struct acpi_device *dev, int sleep_state)
L
Linus Torvalds 已提交
657
{
658
	struct acpi_power_resource_entry *entry;
659
	int err = 0;
L
Linus Torvalds 已提交
660 661

	if (!dev || !dev->wakeup.flags.valid)
662
		return -EINVAL;
L
Linus Torvalds 已提交
663

664 665 666 667
	mutex_lock(&acpi_device_lock);

	if (dev->wakeup.prepare_count++)
		goto out;
668

669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687
	list_for_each_entry(entry, &dev->wakeup.resources, node) {
		struct acpi_power_resource *resource = entry->resource;

		mutex_lock(&resource->resource_lock);

		if (!resource->wakeup_enabled) {
			err = acpi_power_on_unlocked(resource);
			if (!err)
				resource->wakeup_enabled = true;
		}

		mutex_unlock(&resource->resource_lock);

		if (err) {
			dev_err(&dev->dev,
				"Cannot turn wakeup power resources on\n");
			dev->wakeup.flags.valid = 0;
			goto out;
		}
L
Linus Torvalds 已提交
688
	}
689 690 691 692 693
	/*
	 * Passing 3 as the third argument below means the device may be
	 * put into arbitrary power state afterward.
	 */
	err = acpi_device_sleep_wake(dev, 1, sleep_state, 3);
694 695 696 697 698
	if (err)
		dev->wakeup.prepare_count = 0;

 out:
	mutex_unlock(&acpi_device_lock);
699
	return err;
L
Linus Torvalds 已提交
700 701 702 703
}

/*
 * Shutdown a wakeup device, counterpart of above method
704 705
 * 1. Execute _DSW (Device Sleep Wake) or (deprecated in ACPI 3.0) _PSW (Power
 *    State Wake) for the device, if present
L
Linus Torvalds 已提交
706 707
 * 2. Shutdown down the power resources
 */
L
Len Brown 已提交
708
int acpi_disable_wakeup_device_power(struct acpi_device *dev)
L
Linus Torvalds 已提交
709
{
710
	struct acpi_power_resource_entry *entry;
711
	int err = 0;
L
Linus Torvalds 已提交
712 713

	if (!dev || !dev->wakeup.flags.valid)
714
		return -EINVAL;
L
Linus Torvalds 已提交
715

716 717 718 719 720
	mutex_lock(&acpi_device_lock);

	if (--dev->wakeup.prepare_count > 0)
		goto out;

721
	/*
722 723
	 * Executing the code below even if prepare_count is already zero when
	 * the function is called may be useful, for example for initialisation.
724
	 */
725 726
	if (dev->wakeup.prepare_count < 0)
		dev->wakeup.prepare_count = 0;
727

728 729 730
	err = acpi_device_sleep_wake(dev, 0, 0, 0);
	if (err)
		goto out;
L
Linus Torvalds 已提交
731

732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750
	list_for_each_entry(entry, &dev->wakeup.resources, node) {
		struct acpi_power_resource *resource = entry->resource;

		mutex_lock(&resource->resource_lock);

		if (resource->wakeup_enabled) {
			err = acpi_power_off_unlocked(resource);
			if (!err)
				resource->wakeup_enabled = false;
		}

		mutex_unlock(&resource->resource_lock);

		if (err) {
			dev_err(&dev->dev,
				"Cannot turn wakeup power resources off\n");
			dev->wakeup.flags.valid = 0;
			break;
		}
L
Linus Torvalds 已提交
751 752
	}

753 754 755
 out:
	mutex_unlock(&acpi_device_lock);
	return err;
L
Linus Torvalds 已提交
756 757
}

758
int acpi_power_get_inferred_state(struct acpi_device *device, int *state)
L
Linus Torvalds 已提交
759
{
L
Len Brown 已提交
760 761 762
	int result = 0;
	int list_state = 0;
	int i = 0;
L
Linus Torvalds 已提交
763

764
	if (!device || !state)
765
		return -EINVAL;
L
Linus Torvalds 已提交
766 767 768 769 770

	/*
	 * We know a device's inferred power state when all the resources
	 * required for a given D-state are 'on'.
	 */
771
	for (i = ACPI_STATE_D0; i <= ACPI_STATE_D3_HOT; i++) {
772 773 774
		struct list_head *list = &device->power.states[i].resources;

		if (list_empty(list))
L
Linus Torvalds 已提交
775 776 777 778
			continue;

		result = acpi_power_get_list_state(list, &list_state);
		if (result)
779
			return result;
L
Linus Torvalds 已提交
780 781

		if (list_state == ACPI_POWER_RESOURCE_STATE_ON) {
782
			*state = i;
783
			return 0;
L
Linus Torvalds 已提交
784 785 786
		}
	}

787
	*state = ACPI_STATE_D3_COLD;
788
	return 0;
L
Linus Torvalds 已提交
789 790
}

791 792
int acpi_power_on_resources(struct acpi_device *device, int state)
{
793
	if (!device || state < ACPI_STATE_D0 || state > ACPI_STATE_D3_HOT)
794 795 796 797 798
		return -EINVAL;

	return acpi_power_on_list(&device->power.states[state].resources);
}

L
Len Brown 已提交
799
int acpi_power_transition(struct acpi_device *device, int state)
L
Linus Torvalds 已提交
800
{
801
	int result = 0;
L
Linus Torvalds 已提交
802

803
	if (!device || (state < ACPI_STATE_D0) || (state > ACPI_STATE_D3_COLD))
804
		return -EINVAL;
L
Linus Torvalds 已提交
805

806
	if (device->power.state == state || !device->flags.power_manageable)
807 808
		return 0;

L
Len Brown 已提交
809
	if ((device->power.state < ACPI_STATE_D0)
810
	    || (device->power.state > ACPI_STATE_D3_COLD))
811
		return -ENODEV;
L
Linus Torvalds 已提交
812 813 814 815 816

	/* TBD: Resources must be ordered. */

	/*
	 * First we reference all power resources required in the target list
817 818
	 * (e.g. so the device doesn't lose power while transitioning).  Then,
	 * we dereference all power resources used in the current list.
L
Linus Torvalds 已提交
819
	 */
820 821 822 823 824
	if (state < ACPI_STATE_D3_COLD)
		result = acpi_power_on_list(
			&device->power.states[state].resources);

	if (!result && device->power.state < ACPI_STATE_D3_COLD)
825 826
		acpi_power_off_list(
			&device->power.states[device->power.state].resources);
L
Linus Torvalds 已提交
827

828 829
	/* We shouldn't change the state unless the above operations succeed. */
	device->power.state = result ? ACPI_STATE_UNKNOWN : state;
L
Linus Torvalds 已提交
830

831
	return result;
L
Linus Torvalds 已提交
832 833
}

834 835 836 837 838 839
static void acpi_release_power_resource(struct device *dev)
{
	struct acpi_device *device = to_acpi_device(dev);
	struct acpi_power_resource *resource;

	resource = container_of(device, struct acpi_power_resource, device);
840 841 842 843 844

	mutex_lock(&power_resource_list_lock);
	list_del(&resource->list_node);
	mutex_unlock(&power_resource_list_lock);

845
	acpi_free_pnp_ids(&device->pnp);
846 847
	kfree(resource);
}
L
Linus Torvalds 已提交
848

849 850 851 852 853 854 855 856 857 858 859 860 861 862 863
static ssize_t acpi_power_in_use_show(struct device *dev,
				      struct device_attribute *attr,
				      char *buf) {
	struct acpi_power_resource *resource;

	resource = to_power_resource(to_acpi_device(dev));
	return sprintf(buf, "%u\n", !!resource->ref_count);
}
static DEVICE_ATTR(resource_in_use, 0444, acpi_power_in_use_show, NULL);

static void acpi_power_sysfs_remove(struct acpi_device *device)
{
	device_remove_file(&device->dev, &dev_attr_resource_in_use);
}

864
int acpi_add_power_resource(acpi_handle handle)
L
Linus Torvalds 已提交
865
{
866 867
	struct acpi_power_resource *resource;
	struct acpi_device *device = NULL;
L
Len Brown 已提交
868 869
	union acpi_object acpi_object;
	struct acpi_buffer buffer = { sizeof(acpi_object), &acpi_object };
870 871
	acpi_status status;
	int state, result = -ENODEV;
L
Linus Torvalds 已提交
872

873 874
	acpi_bus_get_device(handle, &device);
	if (device)
875
		return 0;
L
Linus Torvalds 已提交
876

877
	resource = kzalloc(sizeof(*resource), GFP_KERNEL);
L
Linus Torvalds 已提交
878
	if (!resource)
879
		return -ENOMEM;
L
Linus Torvalds 已提交
880

881 882 883
	device = &resource->device;
	acpi_init_device_object(device, handle, ACPI_BUS_TYPE_POWER,
				ACPI_STA_DEFAULT);
884
	mutex_init(&resource->resource_lock);
885
	INIT_LIST_HEAD(&resource->dependent);
886
	INIT_LIST_HEAD(&resource->list_node);
887
	resource->name = device->pnp.bus_id;
L
Linus Torvalds 已提交
888 889
	strcpy(acpi_device_name(device), ACPI_POWER_DEVICE_NAME);
	strcpy(acpi_device_class(device), ACPI_POWER_CLASS);
890
	device->power.state = ACPI_STATE_UNKNOWN;
L
Linus Torvalds 已提交
891 892

	/* Evalute the object to get the system level and resource order. */
893 894
	status = acpi_evaluate_object(handle, NULL, NULL, &buffer);
	if (ACPI_FAILURE(status))
895
		goto err;
896

L
Linus Torvalds 已提交
897 898 899
	resource->system_level = acpi_object.power_resource.system_level;
	resource->order = acpi_object.power_resource.resource_order;

900
	result = acpi_power_get_state(handle, &state);
L
Linus Torvalds 已提交
901
	if (result)
902
		goto err;
L
Linus Torvalds 已提交
903 904

	printk(KERN_INFO PREFIX "%s [%s] (%s)\n", acpi_device_name(device),
905
	       acpi_device_bid(device), state ? "on" : "off");
L
Linus Torvalds 已提交
906

907
	device->flags.match_driver = true;
908
	result = acpi_device_add(device, acpi_release_power_resource);
L
Linus Torvalds 已提交
909
	if (result)
910
		goto err;
L
Len Brown 已提交
911

912 913 914
	if (!device_create_file(&device->dev, &dev_attr_resource_in_use))
		device->remove = acpi_power_sysfs_remove;

915 916 917
	mutex_lock(&power_resource_list_lock);
	list_add(&resource->list_node, &acpi_power_resource_list);
	mutex_unlock(&power_resource_list_lock);
918
	acpi_device_add_finalize(device);
919
	return 0;
L
Linus Torvalds 已提交
920

921 922
 err:
	acpi_release_power_resource(&device->dev);
923
	return result;
924
}
L
Linus Torvalds 已提交
925

926 927
#ifdef CONFIG_ACPI_SLEEP
void acpi_resume_power_resources(void)
928
{
929
	struct acpi_power_resource *resource;
930

931
	mutex_lock(&power_resource_list_lock);
932

933 934
	list_for_each_entry(resource, &acpi_power_resource_list, list_node) {
		int result, state;
935

936
		mutex_lock(&resource->resource_lock);
937

938
		result = acpi_power_get_state(resource->device.handle, &state);
939 940
		if (result) {
			mutex_unlock(&resource->resource_lock);
941
			continue;
942
		}
943 944

		if (state == ACPI_POWER_RESOURCE_STATE_OFF
945 946 947
		    && resource->ref_count) {
			dev_info(&resource->device.dev, "Turning ON\n");
			__acpi_power_on(resource);
948 949 950 951
		} else if (state == ACPI_POWER_RESOURCE_STATE_ON
		    && !resource->ref_count) {
			dev_info(&resource->device.dev, "Turning OFF\n");
			__acpi_power_off(resource);
952
		}
953

954 955
		mutex_unlock(&resource->resource_lock);
	}
956

957
	mutex_unlock(&power_resource_list_lock);
958
}
959
#endif