power.c 23.5 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 282 283 284 285
	if (resource->ref_count++) {
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
				  "Power resource [%s] already on",
				  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 328 329
	if (!resource->ref_count) {
		ACPI_DEBUG_PRINT((ACPI_DB_INFO,
				  "Power resource [%s] already off",
				  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 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480
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,
	},
};

static void acpi_power_hide_list(struct acpi_device *adev, int state)
{
	struct acpi_device_power_state *ps = &adev->power.states[state];
	struct acpi_power_resource_entry *entry;

	if (list_empty(&ps->resources))
		return;

	list_for_each_entry_reverse(entry, &ps->resources, node) {
		struct acpi_device *res_dev = &entry->resource->device;

		sysfs_remove_link_from_group(&adev->dev.kobj,
					     attr_groups[state].name,
					     dev_name(&res_dev->dev));
	}
	sysfs_remove_group(&adev->dev.kobj, &attr_groups[state]);
}

static void acpi_power_expose_list(struct acpi_device *adev, int state)
481
{
482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502
	struct acpi_device_power_state *ps = &adev->power.states[state];
	struct acpi_power_resource_entry *entry;
	int ret;

	if (list_empty(&ps->resources))
		return;

	ret = sysfs_create_group(&adev->dev.kobj, &attr_groups[state]);
	if (ret)
		return;

	list_for_each_entry(entry, &ps->resources, node) {
		struct acpi_device *res_dev = &entry->resource->device;

		ret = sysfs_add_link_to_group(&adev->dev.kobj,
					      attr_groups[state].name,
					      &res_dev->dev.kobj,
					      dev_name(&res_dev->dev));
		if (ret) {
			acpi_power_hide_list(adev, state);
			break;
503 504 505
		}
	}
}
506

507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533
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;

	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);
	}

	for (state = ACPI_STATE_D0; state <= ACPI_STATE_D3_HOT; state++) {
		if (add)
			acpi_power_expose_list(adev, state);
		else
			acpi_power_hide_list(adev, state);
	}
}

534
int acpi_power_wakeup_list_init(struct list_head *list, int *system_level_p)
535 536 537 538 539 540
{
	struct acpi_power_resource_entry *entry;
	int system_level = 5;

	list_for_each_entry(entry, list, node) {
		struct acpi_power_resource *resource = entry->resource;
541 542 543
		acpi_handle handle = resource->device.handle;
		int result;
		int state;
544

545 546 547 548 549 550 551 552 553 554 555
		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;
		}
556 557
		if (system_level > resource->system_level)
			system_level = resource->system_level;
558 559

		mutex_unlock(&resource->resource_lock);
560
	}
561 562
	*system_level_p = system_level;
	return 0;
563 564
}

565 566 567
/* --------------------------------------------------------------------------
                             Device Power Management
   -------------------------------------------------------------------------- */
568

569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 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
/**
 * 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 已提交
632 633 634
/*
 * Prepare a wakeup device, two steps (Ref ACPI 2.0:P229):
 * 1. Power on the power resources required for the wakeup device 
635 636
 * 2. Execute _DSW (Device Sleep Wake) or (deprecated in ACPI 3.0) _PSW (Power
 *    State Wake) for the device, if present
L
Linus Torvalds 已提交
637
 */
638
int acpi_enable_wakeup_device_power(struct acpi_device *dev, int sleep_state)
L
Linus Torvalds 已提交
639
{
640
	struct acpi_power_resource_entry *entry;
641
	int err = 0;
L
Linus Torvalds 已提交
642 643

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

646 647 648 649
	mutex_lock(&acpi_device_lock);

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

651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669
	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 已提交
670
	}
671 672 673 674 675
	/*
	 * 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);
676 677 678 679 680
	if (err)
		dev->wakeup.prepare_count = 0;

 out:
	mutex_unlock(&acpi_device_lock);
681
	return err;
L
Linus Torvalds 已提交
682 683 684 685
}

/*
 * Shutdown a wakeup device, counterpart of above method
686 687
 * 1. Execute _DSW (Device Sleep Wake) or (deprecated in ACPI 3.0) _PSW (Power
 *    State Wake) for the device, if present
L
Linus Torvalds 已提交
688 689
 * 2. Shutdown down the power resources
 */
L
Len Brown 已提交
690
int acpi_disable_wakeup_device_power(struct acpi_device *dev)
L
Linus Torvalds 已提交
691
{
692
	struct acpi_power_resource_entry *entry;
693
	int err = 0;
L
Linus Torvalds 已提交
694 695

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

698 699 700 701 702
	mutex_lock(&acpi_device_lock);

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

703
	/*
704 705
	 * Executing the code below even if prepare_count is already zero when
	 * the function is called may be useful, for example for initialisation.
706
	 */
707 708
	if (dev->wakeup.prepare_count < 0)
		dev->wakeup.prepare_count = 0;
709

710 711 712
	err = acpi_device_sleep_wake(dev, 0, 0, 0);
	if (err)
		goto out;
L
Linus Torvalds 已提交
713

714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732
	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 已提交
733 734
	}

735 736 737
 out:
	mutex_unlock(&acpi_device_lock);
	return err;
L
Linus Torvalds 已提交
738 739
}

740
int acpi_power_get_inferred_state(struct acpi_device *device, int *state)
L
Linus Torvalds 已提交
741
{
L
Len Brown 已提交
742 743 744
	int result = 0;
	int list_state = 0;
	int i = 0;
L
Linus Torvalds 已提交
745

746
	if (!device || !state)
747
		return -EINVAL;
L
Linus Torvalds 已提交
748 749 750 751 752

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

		if (list_empty(list))
L
Linus Torvalds 已提交
757 758 759 760
			continue;

		result = acpi_power_get_list_state(list, &list_state);
		if (result)
761
			return result;
L
Linus Torvalds 已提交
762 763

		if (list_state == ACPI_POWER_RESOURCE_STATE_ON) {
764
			*state = i;
765
			return 0;
L
Linus Torvalds 已提交
766 767 768
		}
	}

769
	*state = ACPI_STATE_D3;
770
	return 0;
L
Linus Torvalds 已提交
771 772
}

773 774
int acpi_power_on_resources(struct acpi_device *device, int state)
{
775
	if (!device || state < ACPI_STATE_D0 || state > ACPI_STATE_D3_HOT)
776 777 778 779 780
		return -EINVAL;

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

L
Len Brown 已提交
781
int acpi_power_transition(struct acpi_device *device, int state)
L
Linus Torvalds 已提交
782
{
783
	int result = 0;
L
Linus Torvalds 已提交
784

785
	if (!device || (state < ACPI_STATE_D0) || (state > ACPI_STATE_D3_COLD))
786
		return -EINVAL;
L
Linus Torvalds 已提交
787

788
	if (device->power.state == state || !device->flags.power_manageable)
789 790
		return 0;

L
Len Brown 已提交
791
	if ((device->power.state < ACPI_STATE_D0)
792
	    || (device->power.state > ACPI_STATE_D3_COLD))
793
		return -ENODEV;
L
Linus Torvalds 已提交
794 795 796 797 798

	/* TBD: Resources must be ordered. */

	/*
	 * First we reference all power resources required in the target list
799 800
	 * (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 已提交
801
	 */
802 803 804 805 806
	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)
807 808
		acpi_power_off_list(
			&device->power.states[device->power.state].resources);
L
Linus Torvalds 已提交
809

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

813
	return result;
L
Linus Torvalds 已提交
814 815
}

816 817 818 819 820 821
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);
822 823 824 825 826 827

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

	acpi_free_ids(device);
828 829
	kfree(resource);
}
L
Linus Torvalds 已提交
830

831 832 833 834 835 836 837 838 839 840 841 842 843 844 845
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);
}

846
int acpi_add_power_resource(acpi_handle handle)
L
Linus Torvalds 已提交
847
{
848 849
	struct acpi_power_resource *resource;
	struct acpi_device *device = NULL;
L
Len Brown 已提交
850 851
	union acpi_object acpi_object;
	struct acpi_buffer buffer = { sizeof(acpi_object), &acpi_object };
852 853
	acpi_status status;
	int state, result = -ENODEV;
L
Linus Torvalds 已提交
854

855 856
	acpi_bus_get_device(handle, &device);
	if (device)
857
		return 0;
L
Linus Torvalds 已提交
858

859
	resource = kzalloc(sizeof(*resource), GFP_KERNEL);
L
Linus Torvalds 已提交
860
	if (!resource)
861
		return -ENOMEM;
L
Linus Torvalds 已提交
862

863 864 865
	device = &resource->device;
	acpi_init_device_object(device, handle, ACPI_BUS_TYPE_POWER,
				ACPI_STA_DEFAULT);
866
	mutex_init(&resource->resource_lock);
867
	INIT_LIST_HEAD(&resource->dependent);
868
	resource->name = device->pnp.bus_id;
L
Linus Torvalds 已提交
869 870
	strcpy(acpi_device_name(device), ACPI_POWER_DEVICE_NAME);
	strcpy(acpi_device_class(device), ACPI_POWER_CLASS);
871
	device->power.state = ACPI_STATE_UNKNOWN;
L
Linus Torvalds 已提交
872 873

	/* Evalute the object to get the system level and resource order. */
874 875
	status = acpi_evaluate_object(handle, NULL, NULL, &buffer);
	if (ACPI_FAILURE(status))
876
		goto err;
877

L
Linus Torvalds 已提交
878 879 880
	resource->system_level = acpi_object.power_resource.system_level;
	resource->order = acpi_object.power_resource.resource_order;

881
	result = acpi_power_get_state(handle, &state);
L
Linus Torvalds 已提交
882
	if (result)
883
		goto err;
L
Linus Torvalds 已提交
884 885

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

888
	device->flags.match_driver = true;
889
	result = acpi_device_add(device, acpi_release_power_resource);
L
Linus Torvalds 已提交
890
	if (result)
891
		goto err;
L
Len Brown 已提交
892

893 894 895
	if (!device_create_file(&device->dev, &dev_attr_resource_in_use))
		device->remove = acpi_power_sysfs_remove;

896 897 898
	mutex_lock(&power_resource_list_lock);
	list_add(&resource->list_node, &acpi_power_resource_list);
	mutex_unlock(&power_resource_list_lock);
899
	acpi_device_add_finalize(device);
900
	return 0;
L
Linus Torvalds 已提交
901

902 903
 err:
	acpi_release_power_resource(&device->dev);
904
	return result;
905
}
L
Linus Torvalds 已提交
906

907 908
#ifdef CONFIG_ACPI_SLEEP
void acpi_resume_power_resources(void)
909
{
910
	struct acpi_power_resource *resource;
911

912
	mutex_lock(&power_resource_list_lock);
913

914 915
	list_for_each_entry(resource, &acpi_power_resource_list, list_node) {
		int result, state;
916

917
		mutex_lock(&resource->resource_lock);
918

919
		result = acpi_power_get_state(resource->device.handle, &state);
920 921 922 923
		if (result)
			continue;

		if (state == ACPI_POWER_RESOURCE_STATE_OFF
924 925 926
		    && resource->ref_count) {
			dev_info(&resource->device.dev, "Turning ON\n");
			__acpi_power_on(resource);
927 928 929 930
		} else if (state == ACPI_POWER_RESOURCE_STATE_ON
		    && !resource->ref_count) {
			dev_info(&resource->device.dev, "Turning OFF\n");
			__acpi_power_off(resource);
931
		}
932

933 934
		mutex_unlock(&resource->resource_lock);
	}
935

936
	mutex_unlock(&power_resource_list_lock);
937
}
938
#endif