acpi_powerres.c revision 227293
150476Speter/*- 220083Sache * Copyright (c) 2001 Michael Smith 320083Sache * All rights reserved. 420083Sache * 520083Sache * Redistribution and use in source and binary forms, with or without 620083Sache * modification, are permitted provided that the following conditions 720083Sache * are met: 820083Sache * 1. Redistributions of source code must retain the above copyright 920083Sache * notice, this list of conditions and the following disclaimer. 1020083Sache * 2. Redistributions in binary form must reproduce the above copyright 1120083Sache * notice, this list of conditions and the following disclaimer in the 1220083Sache * documentation and/or other materials provided with the distribution. 1320083Sache * 1420083Sache * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 1520083Sache * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 1620083Sache * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 1720083Sache * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 1820083Sache * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 1920083Sache * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 2020083Sache * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 2120083Sache * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 2220083Sache * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 2320083Sache * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 2420083Sache * SUCH DAMAGE. 2520083Sache */ 2620083Sache 2720083Sache#include <sys/cdefs.h> 2820083Sache__FBSDID("$FreeBSD: head/sys/dev/acpica/acpi_powerres.c 227293 2011-11-07 06:44:47Z ed $"); 2920083Sache 3020083Sache#include "opt_acpi.h" 3120083Sache#include <sys/param.h> 3220083Sache#include <sys/kernel.h> 3320083Sache#include <sys/malloc.h> 3420083Sache#include <sys/bus.h> 3520083Sache 3620083Sache#include <contrib/dev/acpica/include/acpi.h> 3720083Sache#include <contrib/dev/acpica/include/accommon.h> 3820083Sache 3920083Sache#include <dev/acpica/acpivar.h> 4020083Sache 4120083Sache/* 4220083Sache * ACPI power resource management. 4320083Sache * 4420083Sache * Power resource behaviour is slightly complicated by the fact that 4520083Sache * a single power resource may provide power for more than one device. 4620083Sache * Thus, we must track the device(s) being powered by a given power 4720083Sache * resource, and only deactivate it when there are no powered devices. 4820083Sache * 4920083Sache * Note that this only manages resources for known devices. There is an 5020083Sache * ugly case where we may turn of power to a device which is in use because 5120083Sache * we don't know that it depends on a given resource. We should perhaps 5220083Sache * try to be smarter about this, but a more complete solution would involve 5320083Sache * scanning all of the ACPI namespace to find devices we're not currently 5420083Sache * aware of, and this raises questions about whether they should be left 5520083Sache * on, turned off, etc. 5620083Sache */ 5720083Sache 5820083Sachestatic MALLOC_DEFINE(M_ACPIPWR, "acpipwr", "ACPI power resources"); 5920083Sache 6020083Sache/* Hooks for the ACPI CA debugging infrastructure */ 6120083Sache#define _COMPONENT ACPI_POWERRES 6274570SacheACPI_MODULE_NAME("POWERRES") 6320083Sache 6420083Sache/* Return values from _STA on a power resource */ 6520083Sache#define ACPI_PWR_OFF 0 6654090Sache#define ACPI_PWR_ON 1 6720083Sache#define ACPI_PWR_UNK (-1) 6820083Sache 6920083Sache/* A relationship between a power resource and a consumer. */ 7020083Sachestruct acpi_powerreference { 7120083Sache struct acpi_powerconsumer *ar_consumer; 7220083Sache struct acpi_powerresource *ar_resource; 7320083Sache TAILQ_ENTRY(acpi_powerreference) ar_rlink; /* link on resource list */ 7473361Sache TAILQ_ENTRY(acpi_powerreference) ar_clink; /* link on consumer */ 7520083Sache}; 7620083Sache 7720083Sache/* A power-managed device. */ 7854090Sachestruct acpi_powerconsumer { 7953943Sache /* Device which is powered */ 8053943Sache ACPI_HANDLE ac_consumer; 8153943Sache int ac_state; 8253943Sache TAILQ_ENTRY(acpi_powerconsumer) ac_link; 8353943Sache TAILQ_HEAD(,acpi_powerreference) ac_references; 8453943Sache}; 8553943Sache 8653943Sache/* A power resource. */ 8753943Sachestruct acpi_powerresource { 8853943Sache TAILQ_ENTRY(acpi_powerresource) ap_link; 8953943Sache TAILQ_HEAD(,acpi_powerreference) ap_references; 9053943Sache ACPI_HANDLE ap_resource; 9153943Sache UINT64 ap_systemlevel; 9253943Sache UINT64 ap_order; 9353943Sache int ap_state; 9453943Sache}; 9574413Sache 9653943Sachestatic TAILQ_HEAD(acpi_powerresource_list, acpi_powerresource) 9774413Sache acpi_powerresources; 9853961Sachestatic TAILQ_HEAD(acpi_powerconsumer_list, acpi_powerconsumer) 9973361Sache acpi_powerconsumers; 10073361SacheACPI_SERIAL_DECL(powerres, "ACPI power resources"); 10173361Sache 10273361Sachestatic ACPI_STATUS acpi_pwr_register_consumer(ACPI_HANDLE consumer); 103#ifdef notyet 104static ACPI_STATUS acpi_pwr_deregister_consumer(ACPI_HANDLE consumer); 105#endif /* notyet */ 106static ACPI_STATUS acpi_pwr_register_resource(ACPI_HANDLE res); 107#ifdef notyet 108static ACPI_STATUS acpi_pwr_deregister_resource(ACPI_HANDLE res); 109#endif /* notyet */ 110static void acpi_pwr_reference_resource(ACPI_OBJECT *obj, 111 void *arg); 112static int acpi_pwr_dereference_resource(struct acpi_powerconsumer 113 *pc); 114static ACPI_STATUS acpi_pwr_switch_power(void); 115static struct acpi_powerresource 116 *acpi_pwr_find_resource(ACPI_HANDLE res); 117static struct acpi_powerconsumer 118 *acpi_pwr_find_consumer(ACPI_HANDLE consumer); 119 120/* Initialise our lists. */ 121static void 122acpi_pwr_init(void *junk) 123{ 124 TAILQ_INIT(&acpi_powerresources); 125 TAILQ_INIT(&acpi_powerconsumers); 126} 127SYSINIT(acpi_powerresource, SI_SUB_TUNABLES, SI_ORDER_ANY, acpi_pwr_init, NULL); 128 129/* 130 * Register a power resource. 131 * 132 * It's OK to call this if we already know about the resource. 133 */ 134static ACPI_STATUS 135acpi_pwr_register_resource(ACPI_HANDLE res) 136{ 137 ACPI_STATUS status; 138 ACPI_BUFFER buf; 139 ACPI_OBJECT *obj; 140 struct acpi_powerresource *rp, *srp; 141 142 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 143 ACPI_SERIAL_ASSERT(powerres); 144 145 rp = NULL; 146 buf.Pointer = NULL; 147 148 /* Look to see if we know about this resource */ 149 if (acpi_pwr_find_resource(res) != NULL) 150 return_ACPI_STATUS (AE_OK); /* already know about it */ 151 152 /* Allocate a new resource */ 153 if ((rp = malloc(sizeof(*rp), M_ACPIPWR, M_NOWAIT | M_ZERO)) == NULL) { 154 status = AE_NO_MEMORY; 155 goto out; 156 } 157 TAILQ_INIT(&rp->ap_references); 158 rp->ap_resource = res; 159 160 /* Get the Power Resource object */ 161 buf.Length = ACPI_ALLOCATE_BUFFER; 162 if (ACPI_FAILURE(status = AcpiEvaluateObject(res, NULL, NULL, &buf))) { 163 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "no power resource object\n")); 164 goto out; 165 } 166 obj = buf.Pointer; 167 if (obj->Type != ACPI_TYPE_POWER) { 168 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 169 "questionable power resource object %s\n", 170 acpi_name(res))); 171 status = AE_TYPE; 172 goto out; 173 } 174 rp->ap_systemlevel = obj->PowerResource.SystemLevel; 175 rp->ap_order = obj->PowerResource.ResourceOrder; 176 rp->ap_state = ACPI_PWR_UNK; 177 178 /* Sort the resource into the list */ 179 status = AE_OK; 180 srp = TAILQ_FIRST(&acpi_powerresources); 181 if (srp == NULL || rp->ap_order < srp->ap_order) { 182 TAILQ_INSERT_HEAD(&acpi_powerresources, rp, ap_link); 183 goto done; 184 } 185 TAILQ_FOREACH(srp, &acpi_powerresources, ap_link) { 186 if (rp->ap_order < srp->ap_order) { 187 TAILQ_INSERT_BEFORE(srp, rp, ap_link); 188 goto done; 189 } 190 } 191 TAILQ_INSERT_TAIL(&acpi_powerresources, rp, ap_link); 192 193 done: 194 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 195 "registered power resource %s\n", acpi_name(res))); 196 197 out: 198 if (buf.Pointer != NULL) 199 AcpiOsFree(buf.Pointer); 200 if (ACPI_FAILURE(status) && rp != NULL) 201 free(rp, M_ACPIPWR); 202 return_ACPI_STATUS (status); 203} 204 205#ifdef notyet 206/* 207 * Deregister a power resource. 208 */ 209static ACPI_STATUS 210acpi_pwr_deregister_resource(ACPI_HANDLE res) 211{ 212 struct acpi_powerresource *rp; 213 214 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 215 ACPI_SERIAL_ASSERT(powerres); 216 217 rp = NULL; 218 219 /* Find the resource */ 220 if ((rp = acpi_pwr_find_resource(res)) == NULL) 221 return_ACPI_STATUS (AE_BAD_PARAMETER); 222 223 /* Check that there are no consumers referencing this resource */ 224 if (TAILQ_FIRST(&rp->ap_references) != NULL) 225 return_ACPI_STATUS (AE_BAD_PARAMETER); 226 227 /* Pull it off the list and free it */ 228 TAILQ_REMOVE(&acpi_powerresources, rp, ap_link); 229 free(rp, M_ACPIPWR); 230 231 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "deregistered power resource %s\n", 232 acpi_name(res))); 233 234 return_ACPI_STATUS (AE_OK); 235} 236#endif /* notyet */ 237 238/* 239 * Register a power consumer. 240 * 241 * It's OK to call this if we already know about the consumer. 242 */ 243static ACPI_STATUS 244acpi_pwr_register_consumer(ACPI_HANDLE consumer) 245{ 246 struct acpi_powerconsumer *pc; 247 248 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 249 ACPI_SERIAL_ASSERT(powerres); 250 251 /* Check to see whether we know about this consumer already */ 252 if (acpi_pwr_find_consumer(consumer) != NULL) 253 return_ACPI_STATUS (AE_OK); 254 255 /* Allocate a new power consumer */ 256 if ((pc = malloc(sizeof(*pc), M_ACPIPWR, M_NOWAIT)) == NULL) 257 return_ACPI_STATUS (AE_NO_MEMORY); 258 TAILQ_INSERT_HEAD(&acpi_powerconsumers, pc, ac_link); 259 TAILQ_INIT(&pc->ac_references); 260 pc->ac_consumer = consumer; 261 262 /* XXX we should try to find its current state */ 263 pc->ac_state = ACPI_STATE_UNKNOWN; 264 265 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "registered power consumer %s\n", 266 acpi_name(consumer))); 267 268 return_ACPI_STATUS (AE_OK); 269} 270 271#ifdef notyet 272/* 273 * Deregister a power consumer. 274 * 275 * This should only be done once the consumer has been powered off. 276 * (XXX is this correct? Check once implemented) 277 */ 278static ACPI_STATUS 279acpi_pwr_deregister_consumer(ACPI_HANDLE consumer) 280{ 281 struct acpi_powerconsumer *pc; 282 283 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 284 ACPI_SERIAL_ASSERT(powerres); 285 286 /* Find the consumer */ 287 if ((pc = acpi_pwr_find_consumer(consumer)) == NULL) 288 return_ACPI_STATUS (AE_BAD_PARAMETER); 289 290 /* Make sure the consumer's not referencing anything right now */ 291 if (TAILQ_FIRST(&pc->ac_references) != NULL) 292 return_ACPI_STATUS (AE_BAD_PARAMETER); 293 294 /* Pull the consumer off the list and free it */ 295 TAILQ_REMOVE(&acpi_powerconsumers, pc, ac_link); 296 free(pc, M_ACPIPWR); 297 298 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "deregistered power consumer %s\n", 299 acpi_name(consumer))); 300 301 return_ACPI_STATUS (AE_OK); 302} 303#endif /* notyet */ 304 305/* 306 * Set a power consumer to a particular power state. 307 */ 308ACPI_STATUS 309acpi_pwr_switch_consumer(ACPI_HANDLE consumer, int state) 310{ 311 struct acpi_powerconsumer *pc; 312 ACPI_HANDLE method_handle, reslist_handle, pr0_handle; 313 ACPI_BUFFER reslist_buffer; 314 ACPI_OBJECT *reslist_object; 315 ACPI_STATUS status; 316 char *method_name, *reslist_name; 317 int res_changed; 318 319 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 320 321 /* It's never ok to switch a non-existent consumer. */ 322 if (consumer == NULL) 323 return_ACPI_STATUS (AE_NOT_FOUND); 324 reslist_buffer.Pointer = NULL; 325 reslist_object = NULL; 326 ACPI_SERIAL_BEGIN(powerres); 327 328 /* Find the consumer */ 329 if ((pc = acpi_pwr_find_consumer(consumer)) == NULL) { 330 if (ACPI_FAILURE(status = acpi_pwr_register_consumer(consumer))) 331 goto out; 332 if ((pc = acpi_pwr_find_consumer(consumer)) == NULL) 333 panic("acpi added power consumer but can't find it"); 334 } 335 336 /* Check for valid transitions. We can only go to D0 from D3. */ 337 status = AE_BAD_PARAMETER; 338 if (pc->ac_state == ACPI_STATE_D3 && state != ACPI_STATE_D0) 339 goto out; 340 341 /* Find transition mechanism(s) */ 342 switch (state) { 343 case ACPI_STATE_D0: 344 method_name = "_PS0"; 345 reslist_name = "_PR0"; 346 break; 347 case ACPI_STATE_D1: 348 method_name = "_PS1"; 349 reslist_name = "_PR1"; 350 break; 351 case ACPI_STATE_D2: 352 method_name = "_PS2"; 353 reslist_name = "_PR2"; 354 break; 355 case ACPI_STATE_D3: 356 method_name = "_PS3"; 357 reslist_name = "_PR3"; 358 break; 359 default: 360 goto out; 361 } 362 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "setup to switch %s D%d -> D%d\n", 363 acpi_name(consumer), pc->ac_state, state)); 364 365 /* 366 * Verify that this state is supported, ie. one of method or 367 * reslist must be present. We need to do this before we go 368 * dereferencing resources (since we might be trying to go to 369 * a state we don't support). 370 * 371 * Note that if any states are supported, the device has to 372 * support D0 and D3. It's never an error to try to go to 373 * D0. 374 */ 375 if (ACPI_FAILURE(AcpiGetHandle(consumer, method_name, &method_handle))) 376 method_handle = NULL; 377 if (ACPI_FAILURE(AcpiGetHandle(consumer, reslist_name, &reslist_handle))) 378 reslist_handle = NULL; 379 if (reslist_handle == NULL && method_handle == NULL) { 380 if (state == ACPI_STATE_D0) { 381 pc->ac_state = ACPI_STATE_D0; 382 status = AE_OK; 383 goto out; 384 } 385 if (state != ACPI_STATE_D3) { 386 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 387 "attempt to set unsupported state D%d\n", state)); 388 goto out; 389 } 390 391 /* 392 * Turn off the resources listed in _PR0 to go to D3. If there is 393 * no _PR0 method, this object doesn't support ACPI power states. 394 */ 395 if (ACPI_FAILURE(AcpiGetHandle(consumer, "_PR0", &pr0_handle))) { 396 status = AE_NOT_FOUND; 397 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 398 "device missing _PR0 (desired state was D%d)\n", state)); 399 goto out; 400 } 401 reslist_buffer.Length = ACPI_ALLOCATE_BUFFER; 402 status = AcpiEvaluateObject(pr0_handle, NULL, NULL, &reslist_buffer); 403 if (ACPI_FAILURE(status)) { 404 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 405 "can't evaluate _PR0 for device %s, state D%d\n", 406 acpi_name(consumer), state)); 407 goto out; 408 } 409 reslist_object = (ACPI_OBJECT *)reslist_buffer.Pointer; 410 if (!ACPI_PKG_VALID(reslist_object, 1)) { 411 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 412 "invalid package object for state D%d\n", state)); 413 status = AE_TYPE; 414 goto out; 415 } 416 AcpiOsFree(reslist_buffer.Pointer); 417 reslist_buffer.Pointer = NULL; 418 reslist_object = NULL; 419 } 420 421 /* 422 * Check that we can actually fetch the list of power resources 423 */ 424 if (reslist_handle != NULL) { 425 reslist_buffer.Length = ACPI_ALLOCATE_BUFFER; 426 status = AcpiEvaluateObject(reslist_handle, NULL, NULL, 427 &reslist_buffer); 428 if (ACPI_FAILURE(status)) { 429 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 430 "can't evaluate resource list %s\n", 431 acpi_name(reslist_handle))); 432 goto out; 433 } 434 reslist_object = (ACPI_OBJECT *)reslist_buffer.Pointer; 435 if (reslist_object->Type != ACPI_TYPE_PACKAGE) { 436 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 437 "resource list is not ACPI_TYPE_PACKAGE (%d)\n", 438 reslist_object->Type)); 439 status = AE_TYPE; 440 goto out; 441 } 442 } 443 444 /* 445 * Now we are ready to switch, so kill off any current power 446 * resource references. 447 */ 448 res_changed = acpi_pwr_dereference_resource(pc); 449 450 /* 451 * Add new power resource references, if we have any. Traverse the 452 * package that we got from evaluating reslist_handle, and look up each 453 * of the resources that are referenced. 454 */ 455 if (reslist_object != NULL) { 456 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "referencing %d new resources\n", 457 reslist_object->Package.Count)); 458 acpi_ForeachPackageObject(reslist_object, acpi_pwr_reference_resource, 459 pc); 460 res_changed = 1; 461 } 462 463 /* 464 * If we changed anything in the resource list, we need to run a switch 465 * pass now. 466 */ 467 if (ACPI_FAILURE(status = acpi_pwr_switch_power())) { 468 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 469 "failed to switch resources from %s to D%d\n", 470 acpi_name(consumer), state)); 471 472 /* XXX is this appropriate? Should we return to previous state? */ 473 goto out; 474 } 475 476 /* Invoke power state switch method (if present) */ 477 if (method_handle != NULL) { 478 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 479 "invoking state transition method %s\n", 480 acpi_name(method_handle))); 481 status = AcpiEvaluateObject(method_handle, NULL, NULL, NULL); 482 if (ACPI_FAILURE(status)) { 483 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "failed to set state - %s\n", 484 AcpiFormatException(status))); 485 pc->ac_state = ACPI_STATE_UNKNOWN; 486 487 /* XXX Should we return to previous state? */ 488 goto out; 489 } 490 } 491 492 /* Transition was successful */ 493 pc->ac_state = state; 494 status = AE_OK; 495 496out: 497 ACPI_SERIAL_END(powerres); 498 if (reslist_buffer.Pointer != NULL) 499 AcpiOsFree(reslist_buffer.Pointer); 500 return_ACPI_STATUS (status); 501} 502 503/* Enable or disable a power resource for wake */ 504ACPI_STATUS 505acpi_pwr_wake_enable(ACPI_HANDLE consumer, int enable) 506{ 507 ACPI_STATUS status; 508 struct acpi_powerconsumer *pc; 509 struct acpi_prw_data prw; 510 int i; 511 512 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 513 514 if (consumer == NULL) 515 return (AE_BAD_PARAMETER); 516 517 ACPI_SERIAL_BEGIN(powerres); 518 if ((pc = acpi_pwr_find_consumer(consumer)) == NULL) { 519 if (ACPI_FAILURE(status = acpi_pwr_register_consumer(consumer))) 520 goto out; 521 if ((pc = acpi_pwr_find_consumer(consumer)) == NULL) 522 panic("acpi wake added power consumer but can't find it"); 523 } 524 525 status = AE_OK; 526 if (acpi_parse_prw(consumer, &prw) != 0) 527 goto out; 528 for (i = 0; i < prw.power_res_count; i++) 529 if (enable) 530 acpi_pwr_reference_resource(&prw.power_res[i], pc); 531 else 532 acpi_pwr_dereference_resource(pc); 533 534 if (prw.power_res_count > 0) 535 acpi_pwr_switch_power(); 536 537out: 538 ACPI_SERIAL_END(powerres); 539 return (status); 540} 541 542/* 543 * Called to create a reference between a power consumer and a power resource 544 * identified in the object. 545 */ 546static void 547acpi_pwr_reference_resource(ACPI_OBJECT *obj, void *arg) 548{ 549 struct acpi_powerconsumer *pc = (struct acpi_powerconsumer *)arg; 550 struct acpi_powerreference *pr; 551 struct acpi_powerresource *rp; 552 ACPI_HANDLE res; 553 ACPI_STATUS status; 554 555 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 556 ACPI_SERIAL_ASSERT(powerres); 557 558 res = acpi_GetReference(NULL, obj); 559 if (res == NULL) { 560 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 561 "can't create a power reference for object type %d\n", 562 obj->Type)); 563 return_VOID; 564 } 565 566 /* Create/look up the resource */ 567 if (ACPI_FAILURE(status = acpi_pwr_register_resource(res))) { 568 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 569 "couldn't register power resource %s - %s\n", 570 obj->String.Pointer, AcpiFormatException(status))); 571 return_VOID; 572 } 573 if ((rp = acpi_pwr_find_resource(res)) == NULL) { 574 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "power resource list corrupted\n")); 575 return_VOID; 576 } 577 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "found power resource %s\n", 578 acpi_name(rp->ap_resource))); 579 580 /* Create a reference between the consumer and resource */ 581 if ((pr = malloc(sizeof(*pr), M_ACPIPWR, M_NOWAIT | M_ZERO)) == NULL) { 582 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 583 "allocation failed for a power consumer reference\n")); 584 return_VOID; 585 } 586 pr->ar_consumer = pc; 587 pr->ar_resource = rp; 588 TAILQ_INSERT_TAIL(&pc->ac_references, pr, ar_clink); 589 TAILQ_INSERT_TAIL(&rp->ap_references, pr, ar_rlink); 590 591 return_VOID; 592} 593 594static int 595acpi_pwr_dereference_resource(struct acpi_powerconsumer *pc) 596{ 597 struct acpi_powerreference *pr; 598 int changed; 599 600 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 601 ACPI_SERIAL_ASSERT(powerres); 602 603 changed = 0; 604 while ((pr = TAILQ_FIRST(&pc->ac_references)) != NULL) { 605 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "removing reference to %s\n", 606 acpi_name(pr->ar_resource->ap_resource))); 607 TAILQ_REMOVE(&pr->ar_resource->ap_references, pr, ar_rlink); 608 TAILQ_REMOVE(&pc->ac_references, pr, ar_clink); 609 free(pr, M_ACPIPWR); 610 changed = 1; 611 } 612 613 return (changed); 614} 615 616/* 617 * Switch power resources to conform to the desired state. 618 * 619 * Consumers may have modified the power resource list in an arbitrary 620 * fashion; we sweep it in sequence order. 621 */ 622static ACPI_STATUS 623acpi_pwr_switch_power(void) 624{ 625 struct acpi_powerresource *rp; 626 ACPI_STATUS status; 627 int cur; 628 629 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 630 ACPI_SERIAL_ASSERT(powerres); 631 632 /* 633 * Sweep the list forwards turning things on. 634 */ 635 TAILQ_FOREACH(rp, &acpi_powerresources, ap_link) { 636 if (TAILQ_FIRST(&rp->ap_references) == NULL) { 637 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 638 "%s has no references, not turning on\n", 639 acpi_name(rp->ap_resource))); 640 continue; 641 } 642 643 /* We could cache this if we trusted it not to change under us */ 644 status = acpi_GetInteger(rp->ap_resource, "_STA", &cur); 645 if (ACPI_FAILURE(status)) { 646 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "can't get status of %s - %d\n", 647 acpi_name(rp->ap_resource), status)); 648 /* XXX is this correct? Always switch if in doubt? */ 649 continue; 650 } else if (rp->ap_state == ACPI_PWR_UNK) 651 rp->ap_state = cur; 652 653 /* 654 * Switch if required. Note that we ignore the result of the switch 655 * effort; we don't know what to do if it fails, so checking wouldn't 656 * help much. 657 */ 658 if (rp->ap_state != ACPI_PWR_ON) { 659 status = AcpiEvaluateObject(rp->ap_resource, "_ON", NULL, NULL); 660 if (ACPI_FAILURE(status)) { 661 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 662 "failed to switch %s on - %s\n", 663 acpi_name(rp->ap_resource), 664 AcpiFormatException(status))); 665 } else { 666 rp->ap_state = ACPI_PWR_ON; 667 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "switched %s on\n", 668 acpi_name(rp->ap_resource))); 669 } 670 } else { 671 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "%s is already on\n", 672 acpi_name(rp->ap_resource))); 673 } 674 } 675 676 /* Sweep the list backwards turning things off. */ 677 TAILQ_FOREACH_REVERSE(rp, &acpi_powerresources, acpi_powerresource_list, 678 ap_link) { 679 680 if (TAILQ_FIRST(&rp->ap_references) != NULL) { 681 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 682 "%s has references, not turning off\n", 683 acpi_name(rp->ap_resource))); 684 continue; 685 } 686 687 /* We could cache this if we trusted it not to change under us */ 688 status = acpi_GetInteger(rp->ap_resource, "_STA", &cur); 689 if (ACPI_FAILURE(status)) { 690 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "can't get status of %s - %d\n", 691 acpi_name(rp->ap_resource), status)); 692 /* XXX is this correct? Always switch if in doubt? */ 693 continue; 694 } else if (rp->ap_state == ACPI_PWR_UNK) 695 rp->ap_state = cur; 696 697 /* 698 * Switch if required. Note that we ignore the result of the switch 699 * effort; we don't know what to do if it fails, so checking wouldn't 700 * help much. 701 */ 702 if (rp->ap_state != ACPI_PWR_OFF) { 703 status = AcpiEvaluateObject(rp->ap_resource, "_OFF", NULL, NULL); 704 if (ACPI_FAILURE(status)) { 705 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 706 "failed to switch %s off - %s\n", 707 acpi_name(rp->ap_resource), 708 AcpiFormatException(status))); 709 } else { 710 rp->ap_state = ACPI_PWR_OFF; 711 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "switched %s off\n", 712 acpi_name(rp->ap_resource))); 713 } 714 } else { 715 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "%s is already off\n", 716 acpi_name(rp->ap_resource))); 717 } 718 } 719 720 return_ACPI_STATUS (AE_OK); 721} 722 723/* 724 * Find a power resource's control structure. 725 */ 726static struct acpi_powerresource * 727acpi_pwr_find_resource(ACPI_HANDLE res) 728{ 729 struct acpi_powerresource *rp; 730 731 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 732 ACPI_SERIAL_ASSERT(powerres); 733 734 TAILQ_FOREACH(rp, &acpi_powerresources, ap_link) { 735 if (rp->ap_resource == res) 736 break; 737 } 738 739 return_PTR (rp); 740} 741 742/* 743 * Find a power consumer's control structure. 744 */ 745static struct acpi_powerconsumer * 746acpi_pwr_find_consumer(ACPI_HANDLE consumer) 747{ 748 struct acpi_powerconsumer *pc; 749 750 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 751 ACPI_SERIAL_ASSERT(powerres); 752 753 TAILQ_FOREACH(pc, &acpi_powerconsumers, ac_link) { 754 if (pc->ac_consumer == consumer) 755 break; 756 } 757 758 return_PTR (pc); 759} 760