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 640 641 642 643 644 645 646 647 648 649 650 651
/**
 * 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 */
	arg_list.count = 1;
	in_arg[0].integer.value = enable;
	status = acpi_evaluate_object(dev->handle, "_PSW", &arg_list, NULL);
	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 已提交
652 653 654
/*
 * Prepare a wakeup device, two steps (Ref ACPI 2.0:P229):
 * 1. Power on the power resources required for the wakeup device 
655 656
 * 2. Execute _DSW (Device Sleep Wake) or (deprecated in ACPI 3.0) _PSW (Power
 *    State Wake) for the device, if present
L
Linus Torvalds 已提交
657
 */
658
int acpi_enable_wakeup_device_power(struct acpi_device *dev, int sleep_state)
L
Linus Torvalds 已提交
659
{
660
	struct acpi_power_resource_entry *entry;
661
	int err = 0;
L
Linus Torvalds 已提交
662 663

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

666 667 668 669
	mutex_lock(&acpi_device_lock);

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

671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689
	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 已提交
690
	}
691 692 693 694 695
	/*
	 * 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);
696 697 698 699 700
	if (err)
		dev->wakeup.prepare_count = 0;

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

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

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

718 719 720 721 722
	mutex_lock(&acpi_device_lock);

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

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

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

734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752
	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 已提交
753 754
	}

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

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

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

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

		if (list_empty(list))
L
Linus Torvalds 已提交
777 778 779 780
			continue;

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

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

789
	*state = ACPI_STATE_D3;
790
	return 0;
L
Linus Torvalds 已提交
791 792
}

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

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

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

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

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

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

	/* TBD: Resources must be ordered. */

	/*
	 * First we reference all power resources required in the target list
819 820
	 * (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 已提交
821
	 */
822 823 824 825 826
	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)
827 828
		acpi_power_off_list(
			&device->power.states[device->power.state].resources);
L
Linus Torvalds 已提交
829

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

833
	return result;
L
Linus Torvalds 已提交
834 835
}

836 837 838 839 840 841
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);
842 843 844 845 846

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

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

851 852 853 854 855 856 857 858 859 860 861 862 863 864 865
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);
}

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

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

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

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

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

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

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

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

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

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

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

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

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

933
	mutex_lock(&power_resource_list_lock);
934

935 936
	list_for_each_entry(resource, &acpi_power_resource_list, list_node) {
		int result, state;
937

938
		mutex_lock(&resource->resource_lock);
939

940
		result = acpi_power_get_state(resource->device.handle, &state);
941 942 943 944
		if (result)
			continue;

		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