acpi_powerres.c revision 139339
190075Sobrien/*- 290075Sobrien * Copyright (c) 2001 Michael Smith 390075Sobrien * All rights reserved. 490075Sobrien * 590075Sobrien * Redistribution and use in source and binary forms, with or without 690075Sobrien * modification, are permitted provided that the following conditions 790075Sobrien * are met: 890075Sobrien * 1. Redistributions of source code must retain the above copyright 990075Sobrien * notice, this list of conditions and the following disclaimer. 1090075Sobrien * 2. Redistributions in binary form must reproduce the above copyright 1190075Sobrien * notice, this list of conditions and the following disclaimer in the 1290075Sobrien * documentation and/or other materials provided with the distribution. 1390075Sobrien * 1490075Sobrien * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 1590075Sobrien * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 1690075Sobrien * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 1790075Sobrien * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 1890075Sobrien * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 1990075Sobrien * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 2090075Sobrien * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 2190075Sobrien * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 2290075Sobrien * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 2390075Sobrien * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 2490075Sobrien * SUCH DAMAGE. 2590075Sobrien */ 2690075Sobrien 2790075Sobrien#include <sys/cdefs.h> 2890075Sobrien__FBSDID("$FreeBSD: head/sys/dev/acpica/acpi_powerres.c 139339 2004-12-27 05:36:47Z njl $"); 2990075Sobrien 3090075Sobrien#include "opt_acpi.h" 3190075Sobrien#include <sys/param.h> 3290075Sobrien#include <sys/kernel.h> 3390075Sobrien#include <sys/malloc.h> 3490075Sobrien#include <sys/bus.h> 3590075Sobrien 3690075Sobrien#include "acpi.h" 3790075Sobrien#include <dev/acpica/acpivar.h> 3890075Sobrien 3990075Sobrien/* 4090075Sobrien * ACPI power resource management. 4190075Sobrien * 4290075Sobrien * Power resource behaviour is slightly complicated by the fact that 4390075Sobrien * a single power resource may provide power for more than one device. 4490075Sobrien * Thus, we must track the device(s) being powered by a given power 4590075Sobrien * resource, and only deactivate it when there are no powered devices. 4690075Sobrien * 4790075Sobrien * Note that this only manages resources for known devices. There is an 4890075Sobrien * ugly case where we may turn of power to a device which is in use because 4990075Sobrien * we don't know that it depends on a given resource. We should perhaps 5090075Sobrien * try to be smarter about this, but a more complete solution would involve 5190075Sobrien * scanning all of the ACPI namespace to find devices we're not currently 5290075Sobrien * aware of, and this raises questions about whether they should be left 5390075Sobrien * on, turned off, etc. 5490075Sobrien */ 5590075Sobrien 5690075SobrienMALLOC_DEFINE(M_ACPIPWR, "acpipwr", "ACPI power resources"); 5790075Sobrien 5890075Sobrien/* Hooks for the ACPI CA debugging infrastructure */ 5990075Sobrien#define _COMPONENT ACPI_POWERRES 6090075SobrienACPI_MODULE_NAME("POWERRES") 6190075Sobrien 6290075Sobrien/* Return values from _STA on a power resource */ 6390075Sobrien#define ACPI_PWR_OFF 0 6490075Sobrien#define ACPI_PWR_ON 1 6590075Sobrien#define ACPI_PWR_UNK (-1) 6690075Sobrien 6790075Sobrien/* A relationship between a power resource and a consumer. */ 6890075Sobrienstruct acpi_powerreference { 6990075Sobrien struct acpi_powerconsumer *ar_consumer; 7090075Sobrien struct acpi_powerresource *ar_resource; 7190075Sobrien TAILQ_ENTRY(acpi_powerreference) ar_rlink; /* link on resource list */ 7290075Sobrien TAILQ_ENTRY(acpi_powerreference) ar_clink; /* link on consumer */ 7390075Sobrien}; 7490075Sobrien 7590075Sobrien/* A power-managed device. */ 7690075Sobrienstruct acpi_powerconsumer { 7790075Sobrien /* Device which is powered */ 7890075Sobrien ACPI_HANDLE ac_consumer; 7990075Sobrien int ac_state; 8090075Sobrien TAILQ_ENTRY(acpi_powerconsumer) ac_link; 8190075Sobrien TAILQ_HEAD(,acpi_powerreference) ac_references; 8290075Sobrien}; 8390075Sobrien 8490075Sobrien/* A power resource. */ 8590075Sobrienstruct acpi_powerresource { 8690075Sobrien TAILQ_ENTRY(acpi_powerresource) ap_link; 8790075Sobrien TAILQ_HEAD(,acpi_powerreference) ap_references; 8890075Sobrien ACPI_HANDLE ap_resource; 8990075Sobrien ACPI_INTEGER ap_systemlevel; 9090075Sobrien ACPI_INTEGER ap_order; 9190075Sobrien int ap_state; 9290075Sobrien}; 9390075Sobrien 9490075Sobrienstatic TAILQ_HEAD(acpi_powerresource_list, acpi_powerresource) 9590075Sobrien acpi_powerresources; 9690075Sobrienstatic TAILQ_HEAD(acpi_powerconsumer_list, acpi_powerconsumer) 9790075Sobrien acpi_powerconsumers; 9890075SobrienACPI_SERIAL_DECL(powerres, "ACPI power resources"); 9990075Sobrien 10090075Sobrienstatic ACPI_STATUS acpi_pwr_register_consumer(ACPI_HANDLE consumer); 10190075Sobrien#ifdef notyet 10290075Sobrienstatic ACPI_STATUS acpi_pwr_deregister_consumer(ACPI_HANDLE consumer); 10390075Sobrien#endif /* notyet */ 10490075Sobrienstatic ACPI_STATUS acpi_pwr_register_resource(ACPI_HANDLE res); 10596263Sobrien#ifdef notyet 10690075Sobrienstatic ACPI_STATUS acpi_pwr_deregister_resource(ACPI_HANDLE res); 10790075Sobrien#endif /* notyet */ 10890075Sobrienstatic void acpi_pwr_reference_resource(ACPI_OBJECT *obj, 10990075Sobrien void *arg); 11090075Sobrienstatic int acpi_pwr_dereference_resource(struct acpi_powerconsumer 11190075Sobrien *pc); 11290075Sobrienstatic ACPI_STATUS acpi_pwr_switch_power(void); 11390075Sobrienstatic struct acpi_powerresource 11490075Sobrien *acpi_pwr_find_resource(ACPI_HANDLE res); 11590075Sobrienstatic struct acpi_powerconsumer 11690075Sobrien *acpi_pwr_find_consumer(ACPI_HANDLE consumer); 11790075Sobrien 11890075Sobrien/* Initialise our lists. */ 11990075Sobrienstatic void 12090075Sobrienacpi_pwr_init(void *junk) 12190075Sobrien{ 12290075Sobrien TAILQ_INIT(&acpi_powerresources); 12390075Sobrien TAILQ_INIT(&acpi_powerconsumers); 12490075Sobrien} 12590075SobrienSYSINIT(acpi_powerresource, SI_SUB_TUNABLES, SI_ORDER_ANY, acpi_pwr_init, NULL); 12690075Sobrien 12790075Sobrien/* 12890075Sobrien * Register a power resource. 12990075Sobrien * 13090075Sobrien * It's OK to call this if we already know about the resource. 13190075Sobrien */ 13290075Sobrienstatic ACPI_STATUS 13390075Sobrienacpi_pwr_register_resource(ACPI_HANDLE res) 13490075Sobrien{ 13590075Sobrien ACPI_STATUS status; 13690075Sobrien ACPI_BUFFER buf; 13790075Sobrien ACPI_OBJECT *obj; 13890075Sobrien struct acpi_powerresource *rp, *srp; 13990075Sobrien 14090075Sobrien ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 14190075Sobrien ACPI_SERIAL_ASSERT(powerres); 14290075Sobrien 14390075Sobrien rp = NULL; 14490075Sobrien buf.Pointer = NULL; 14590075Sobrien 14690075Sobrien /* Look to see if we know about this resource */ 14790075Sobrien if (acpi_pwr_find_resource(res) != NULL) 14890075Sobrien return_ACPI_STATUS (AE_OK); /* already know about it */ 14990075Sobrien 15090075Sobrien /* Allocate a new resource */ 15190075Sobrien if ((rp = malloc(sizeof(*rp), M_ACPIPWR, M_NOWAIT | M_ZERO)) == NULL) { 15290075Sobrien status = AE_NO_MEMORY; 15390075Sobrien goto out; 15490075Sobrien } 15590075Sobrien TAILQ_INIT(&rp->ap_references); 15690075Sobrien rp->ap_resource = res; 15790075Sobrien 15890075Sobrien /* Get the Power Resource object */ 15990075Sobrien buf.Length = ACPI_ALLOCATE_BUFFER; 16090075Sobrien if (ACPI_FAILURE(status = AcpiEvaluateObject(res, NULL, NULL, &buf))) { 16190075Sobrien ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "no power resource object\n")); 16290075Sobrien goto out; 16390075Sobrien } 16490075Sobrien obj = buf.Pointer; 16590075Sobrien if (obj->Type != ACPI_TYPE_POWER) { 16690075Sobrien ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 16790075Sobrien "questionable power resource object %s\n", 16890075Sobrien acpi_name(res))); 16990075Sobrien status = AE_TYPE; 17090075Sobrien goto out; 17190075Sobrien } 17290075Sobrien rp->ap_systemlevel = obj->PowerResource.SystemLevel; 17390075Sobrien rp->ap_order = obj->PowerResource.ResourceOrder; 17490075Sobrien rp->ap_state = ACPI_PWR_UNK; 17590075Sobrien 17690075Sobrien /* Sort the resource into the list */ 17790075Sobrien status = AE_OK; 17890075Sobrien srp = TAILQ_FIRST(&acpi_powerresources); 17990075Sobrien if (srp == NULL || rp->ap_order < srp->ap_order) { 18090075Sobrien TAILQ_INSERT_HEAD(&acpi_powerresources, rp, ap_link); 18190075Sobrien goto done; 18290075Sobrien } 18390075Sobrien TAILQ_FOREACH(srp, &acpi_powerresources, ap_link) { 18490075Sobrien if (rp->ap_order < srp->ap_order) { 18590075Sobrien TAILQ_INSERT_BEFORE(srp, rp, ap_link); 18690075Sobrien goto done; 18790075Sobrien } 18890075Sobrien } 18990075Sobrien TAILQ_INSERT_TAIL(&acpi_powerresources, rp, ap_link); 19090075Sobrien 19190075Sobrien done: 19290075Sobrien ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 19390075Sobrien "registered power resource %s\n", acpi_name(res))); 19490075Sobrien 19590075Sobrien out: 19690075Sobrien if (buf.Pointer != NULL) 19790075Sobrien AcpiOsFree(buf.Pointer); 19890075Sobrien if (ACPI_FAILURE(status) && rp != NULL) 19990075Sobrien free(rp, M_ACPIPWR); 20090075Sobrien return_ACPI_STATUS (status); 20190075Sobrien} 20290075Sobrien 20390075Sobrien#ifdef notyet 20490075Sobrien/* 20590075Sobrien * Deregister a power resource. 20690075Sobrien */ 20790075Sobrienstatic ACPI_STATUS 20890075Sobrienacpi_pwr_deregister_resource(ACPI_HANDLE res) 20990075Sobrien{ 21090075Sobrien struct acpi_powerresource *rp; 21190075Sobrien 21290075Sobrien ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 21390075Sobrien ACPI_SERIAL_ASSERT(powerres); 21490075Sobrien 21590075Sobrien rp = NULL; 21690075Sobrien 21790075Sobrien /* Find the resource */ 21890075Sobrien if ((rp = acpi_pwr_find_resource(res)) == NULL) 21990075Sobrien return_ACPI_STATUS (AE_BAD_PARAMETER); 22090075Sobrien 22190075Sobrien /* Check that there are no consumers referencing this resource */ 22290075Sobrien if (TAILQ_FIRST(&rp->ap_references) != NULL) 22390075Sobrien return_ACPI_STATUS (AE_BAD_PARAMETER); 22490075Sobrien 22590075Sobrien /* Pull it off the list and free it */ 22690075Sobrien TAILQ_REMOVE(&acpi_powerresources, rp, ap_link); 22790075Sobrien free(rp, M_ACPIPWR); 22890075Sobrien 22990075Sobrien ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "deregistered power resource %s\n", 23090075Sobrien acpi_name(res))); 23190075Sobrien 23290075Sobrien return_ACPI_STATUS (AE_OK); 23390075Sobrien} 23490075Sobrien#endif /* notyet */ 235 236/* 237 * Register a power consumer. 238 * 239 * It's OK to call this if we already know about the consumer. 240 */ 241static ACPI_STATUS 242acpi_pwr_register_consumer(ACPI_HANDLE consumer) 243{ 244 struct acpi_powerconsumer *pc; 245 246 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 247 ACPI_SERIAL_ASSERT(powerres); 248 249 /* Check to see whether we know about this consumer already */ 250 if ((pc = acpi_pwr_find_consumer(consumer)) != NULL) 251 return_ACPI_STATUS (AE_OK); 252 253 /* Allocate a new power consumer */ 254 if ((pc = malloc(sizeof(*pc), M_ACPIPWR, M_NOWAIT)) == NULL) 255 return_ACPI_STATUS (AE_NO_MEMORY); 256 TAILQ_INSERT_HEAD(&acpi_powerconsumers, pc, ac_link); 257 TAILQ_INIT(&pc->ac_references); 258 pc->ac_consumer = consumer; 259 260 /* XXX we should try to find its current state */ 261 pc->ac_state = ACPI_STATE_UNKNOWN; 262 263 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "registered power consumer %s\n", 264 acpi_name(consumer))); 265 266 return_ACPI_STATUS (AE_OK); 267} 268 269#ifdef notyet 270/* 271 * Deregister a power consumer. 272 * 273 * This should only be done once the consumer has been powered off. 274 * (XXX is this correct? Check once implemented) 275 */ 276static ACPI_STATUS 277acpi_pwr_deregister_consumer(ACPI_HANDLE consumer) 278{ 279 struct acpi_powerconsumer *pc; 280 281 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 282 ACPI_SERIAL_ASSERT(powerres); 283 284 /* Find the consumer */ 285 if ((pc = acpi_pwr_find_consumer(consumer)) == NULL) 286 return_ACPI_STATUS (AE_BAD_PARAMETER); 287 288 /* Make sure the consumer's not referencing anything right now */ 289 if (TAILQ_FIRST(&pc->ac_references) != NULL) 290 return_ACPI_STATUS (AE_BAD_PARAMETER); 291 292 /* Pull the consumer off the list and free it */ 293 TAILQ_REMOVE(&acpi_powerconsumers, pc, ac_link); 294 free(pc, M_ACPIPWR); 295 296 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "deregistered power consumer %s\n", 297 acpi_name(consumer))); 298 299 return_ACPI_STATUS (AE_OK); 300} 301#endif /* notyet */ 302 303/* 304 * Set a power consumer to a particular power state. 305 */ 306ACPI_STATUS 307acpi_pwr_switch_consumer(ACPI_HANDLE consumer, int state) 308{ 309 struct acpi_powerconsumer *pc; 310 ACPI_HANDLE method_handle, reslist_handle, pr0_handle; 311 ACPI_BUFFER reslist_buffer; 312 ACPI_OBJECT *reslist_object; 313 ACPI_STATUS status; 314 char *method_name, *reslist_name; 315 int res_changed; 316 317 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 318 319 /* It's never ok to switch a non-existent consumer. */ 320 if (consumer == NULL) 321 return_ACPI_STATUS (AE_NOT_FOUND); 322 reslist_buffer.Pointer = NULL; 323 reslist_object = NULL; 324 ACPI_SERIAL_BEGIN(powerres); 325 326 /* Find the consumer */ 327 if ((pc = acpi_pwr_find_consumer(consumer)) == NULL) { 328 if (ACPI_FAILURE(status = acpi_pwr_register_consumer(consumer))) 329 goto out; 330 if ((pc = acpi_pwr_find_consumer(consumer)) == NULL) 331 panic("acpi added power consumer but can't find it"); 332 } 333 334 /* Check for valid transitions. We can only go to D0 from D3. */ 335 status = AE_BAD_PARAMETER; 336 if (pc->ac_state == ACPI_STATE_D3 && state != ACPI_STATE_D0) 337 goto out; 338 339 /* Find transition mechanism(s) */ 340 switch (state) { 341 case ACPI_STATE_D0: 342 method_name = "_PS0"; 343 reslist_name = "_PR0"; 344 break; 345 case ACPI_STATE_D1: 346 method_name = "_PS1"; 347 reslist_name = "_PR1"; 348 break; 349 case ACPI_STATE_D2: 350 method_name = "_PS2"; 351 reslist_name = "_PR2"; 352 break; 353 case ACPI_STATE_D3: 354 method_name = "_PS3"; 355 reslist_name = "_PR3"; 356 break; 357 default: 358 goto out; 359 } 360 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "setup to switch %s D%d -> D%d\n", 361 acpi_name(consumer), pc->ac_state, state)); 362 363 /* 364 * Verify that this state is supported, ie. one of method or 365 * reslist must be present. We need to do this before we go 366 * dereferencing resources (since we might be trying to go to 367 * a state we don't support). 368 * 369 * Note that if any states are supported, the device has to 370 * support D0 and D3. It's never an error to try to go to 371 * D0. 372 */ 373 if (ACPI_FAILURE(AcpiGetHandle(consumer, method_name, &method_handle))) 374 method_handle = NULL; 375 if (ACPI_FAILURE(AcpiGetHandle(consumer, reslist_name, &reslist_handle))) 376 reslist_handle = NULL; 377 if (reslist_handle == NULL && method_handle == NULL) { 378 if (state == ACPI_STATE_D0) { 379 pc->ac_state = ACPI_STATE_D0; 380 status = AE_OK; 381 goto out; 382 } 383 if (state != ACPI_STATE_D3) { 384 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 385 "attempt to set unsupported state D%d\n", state)); 386 goto out; 387 } 388 389 /* 390 * Turn off the resources listed in _PR0 to go to D3. If there is 391 * no _PR0 method, this object doesn't support ACPI power states. 392 */ 393 if (ACPI_FAILURE(AcpiGetHandle(consumer, "_PR0", &pr0_handle))) { 394 status = AE_NOT_FOUND; 395 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 396 "device missing _PR0 (desired state was D%d)\n", state)); 397 goto out; 398 } 399 reslist_buffer.Length = ACPI_ALLOCATE_BUFFER; 400 status = AcpiEvaluateObject(pr0_handle, NULL, NULL, &reslist_buffer); 401 if (ACPI_FAILURE(status)) { 402 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 403 "can't evaluate _PR0 for device %s, state D%d\n", 404 acpi_name(consumer), state)); 405 goto out; 406 } 407 reslist_object = (ACPI_OBJECT *)reslist_buffer.Pointer; 408 if (!ACPI_PKG_VALID(reslist_object, 1)) { 409 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 410 "invalid package object for state D%d\n", state)); 411 status = AE_TYPE; 412 goto out; 413 } 414 AcpiOsFree(reslist_buffer.Pointer); 415 reslist_buffer.Pointer = NULL; 416 reslist_object = NULL; 417 } 418 419 /* 420 * Check that we can actually fetch the list of power resources 421 */ 422 if (reslist_handle != NULL) { 423 reslist_buffer.Length = ACPI_ALLOCATE_BUFFER; 424 status = AcpiEvaluateObject(reslist_handle, NULL, NULL, 425 &reslist_buffer); 426 if (ACPI_FAILURE(status)) { 427 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 428 "can't evaluate resource list %s\n", 429 acpi_name(reslist_handle))); 430 goto out; 431 } 432 reslist_object = (ACPI_OBJECT *)reslist_buffer.Pointer; 433 if (reslist_object->Type != ACPI_TYPE_PACKAGE) { 434 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 435 "resource list is not ACPI_TYPE_PACKAGE (%d)\n", 436 reslist_object->Type)); 437 status = AE_TYPE; 438 goto out; 439 } 440 } 441 442 /* 443 * Now we are ready to switch, so kill off any current power 444 * resource references. 445 */ 446 res_changed = acpi_pwr_dereference_resource(pc); 447 448 /* 449 * Add new power resource references, if we have any. Traverse the 450 * package that we got from evaluating reslist_handle, and look up each 451 * of the resources that are referenced. 452 */ 453 if (reslist_object != NULL) { 454 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "referencing %d new resources\n", 455 reslist_object->Package.Count)); 456 acpi_ForeachPackageObject(reslist_object, acpi_pwr_reference_resource, 457 pc); 458 res_changed = 1; 459 } 460 461 /* 462 * If we changed anything in the resource list, we need to run a switch 463 * pass now. 464 */ 465 if (ACPI_FAILURE(status = acpi_pwr_switch_power())) { 466 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 467 "failed to switch resources from %s to D%d\n", 468 acpi_name(consumer), state)); 469 470 /* XXX is this appropriate? Should we return to previous state? */ 471 goto out; 472 } 473 474 /* Invoke power state switch method (if present) */ 475 if (method_handle != NULL) { 476 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 477 "invoking state transition method %s\n", 478 acpi_name(method_handle))); 479 status = AcpiEvaluateObject(method_handle, NULL, NULL, NULL); 480 if (ACPI_FAILURE(status)) { 481 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "failed to set state - %s\n", 482 AcpiFormatException(status))); 483 pc->ac_state = ACPI_STATE_UNKNOWN; 484 485 /* XXX Should we return to previous state? */ 486 goto out; 487 } 488 } 489 490 /* Transition was successful */ 491 pc->ac_state = state; 492 status = AE_OK; 493 494out: 495 ACPI_SERIAL_END(powerres); 496 if (reslist_buffer.Pointer != NULL) 497 AcpiOsFree(reslist_buffer.Pointer); 498 return_ACPI_STATUS (status); 499} 500 501/* Enable or disable a power resource for wake */ 502ACPI_STATUS 503acpi_pwr_wake_enable(ACPI_HANDLE consumer, int enable) 504{ 505 ACPI_STATUS status; 506 struct acpi_powerconsumer *pc; 507 struct acpi_prw_data prw; 508 int i; 509 510 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 511 512 if (consumer == NULL) 513 return (AE_BAD_PARAMETER); 514 515 ACPI_SERIAL_BEGIN(powerres); 516 if ((pc = acpi_pwr_find_consumer(consumer)) == NULL) { 517 if (ACPI_FAILURE(status = acpi_pwr_register_consumer(consumer))) 518 goto out; 519 if ((pc = acpi_pwr_find_consumer(consumer)) == NULL) 520 panic("acpi wake added power consumer but can't find it"); 521 } 522 523 status = AE_OK; 524 if (acpi_parse_prw(consumer, &prw) != 0) 525 goto out; 526 for (i = 0; i < prw.power_res_count; i++) 527 if (enable) 528 acpi_pwr_reference_resource(&prw.power_res[i], pc); 529 else 530 acpi_pwr_dereference_resource(pc); 531 532 if (prw.power_res_count > 0) 533 acpi_pwr_switch_power(); 534 535out: 536 ACPI_SERIAL_END(powerres); 537 return (status); 538} 539 540/* 541 * Called to create a reference between a power consumer and a power resource 542 * identified in the object. 543 */ 544static void 545acpi_pwr_reference_resource(ACPI_OBJECT *obj, void *arg) 546{ 547 struct acpi_powerconsumer *pc = (struct acpi_powerconsumer *)arg; 548 struct acpi_powerreference *pr; 549 struct acpi_powerresource *rp; 550 ACPI_HANDLE res; 551 ACPI_STATUS status; 552 553 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 554 ACPI_SERIAL_ASSERT(powerres); 555 556 res = acpi_GetReference(NULL, obj); 557 if (res == NULL) { 558 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 559 "can't create a power reference for object type %d\n", 560 obj->Type)); 561 return_VOID; 562 } 563 564 /* Create/look up the resource */ 565 if (ACPI_FAILURE(status = acpi_pwr_register_resource(res))) { 566 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 567 "couldn't register power resource %s - %s\n", 568 obj->String.Pointer, AcpiFormatException(status))); 569 return_VOID; 570 } 571 if ((rp = acpi_pwr_find_resource(res)) == NULL) { 572 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "power resource list corrupted\n")); 573 return_VOID; 574 } 575 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "found power resource %s\n", 576 acpi_name(rp->ap_resource))); 577 578 /* Create a reference between the consumer and resource */ 579 if ((pr = malloc(sizeof(*pr), M_ACPIPWR, M_NOWAIT | M_ZERO)) == NULL) { 580 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 581 "allocation failed for a power consumer reference\n")); 582 return_VOID; 583 } 584 pr->ar_consumer = pc; 585 pr->ar_resource = rp; 586 TAILQ_INSERT_TAIL(&pc->ac_references, pr, ar_clink); 587 TAILQ_INSERT_TAIL(&rp->ap_references, pr, ar_rlink); 588 589 return_VOID; 590} 591 592static int 593acpi_pwr_dereference_resource(struct acpi_powerconsumer *pc) 594{ 595 struct acpi_powerreference *pr; 596 int changed; 597 598 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 599 ACPI_SERIAL_ASSERT(powerres); 600 601 changed = 0; 602 while ((pr = TAILQ_FIRST(&pc->ac_references)) != NULL) { 603 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "removing reference to %s\n", 604 acpi_name(pr->ar_resource->ap_resource))); 605 TAILQ_REMOVE(&pr->ar_resource->ap_references, pr, ar_rlink); 606 TAILQ_REMOVE(&pc->ac_references, pr, ar_clink); 607 free(pr, M_ACPIPWR); 608 changed = 1; 609 } 610 611 return (changed); 612} 613 614/* 615 * Switch power resources to conform to the desired state. 616 * 617 * Consumers may have modified the power resource list in an arbitrary 618 * fashion; we sweep it in sequence order. 619 */ 620static ACPI_STATUS 621acpi_pwr_switch_power(void) 622{ 623 struct acpi_powerresource *rp; 624 ACPI_STATUS status; 625 int cur; 626 627 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 628 ACPI_SERIAL_ASSERT(powerres); 629 630 /* 631 * Sweep the list forwards turning things on. 632 */ 633 TAILQ_FOREACH(rp, &acpi_powerresources, ap_link) { 634 if (TAILQ_FIRST(&rp->ap_references) == NULL) { 635 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 636 "%s has no references, not turning on\n", 637 acpi_name(rp->ap_resource))); 638 continue; 639 } 640 641 /* We could cache this if we trusted it not to change under us */ 642 status = acpi_GetInteger(rp->ap_resource, "_STA", &cur); 643 if (ACPI_FAILURE(status)) { 644 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "can't get status of %s - %d\n", 645 acpi_name(rp->ap_resource), status)); 646 /* XXX is this correct? Always switch if in doubt? */ 647 continue; 648 } else if (rp->ap_state == ACPI_PWR_UNK) 649 rp->ap_state = cur; 650 651 /* 652 * Switch if required. Note that we ignore the result of the switch 653 * effort; we don't know what to do if it fails, so checking wouldn't 654 * help much. 655 */ 656 if (rp->ap_state != ACPI_PWR_ON) { 657 status = AcpiEvaluateObject(rp->ap_resource, "_ON", NULL, NULL); 658 if (ACPI_FAILURE(status)) { 659 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 660 "failed to switch %s on - %s\n", 661 acpi_name(rp->ap_resource), 662 AcpiFormatException(status))); 663 } else { 664 rp->ap_state = ACPI_PWR_ON; 665 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "switched %s on\n", 666 acpi_name(rp->ap_resource))); 667 } 668 } else { 669 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "%s is already on\n", 670 acpi_name(rp->ap_resource))); 671 } 672 } 673 674 /* Sweep the list backwards turning things off. */ 675 TAILQ_FOREACH_REVERSE(rp, &acpi_powerresources, acpi_powerresource_list, 676 ap_link) { 677 678 if (TAILQ_FIRST(&rp->ap_references) != NULL) { 679 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 680 "%s has references, not turning off\n", 681 acpi_name(rp->ap_resource))); 682 continue; 683 } 684 685 /* We could cache this if we trusted it not to change under us */ 686 status = acpi_GetInteger(rp->ap_resource, "_STA", &cur); 687 if (ACPI_FAILURE(status)) { 688 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "can't get status of %s - %d\n", 689 acpi_name(rp->ap_resource), status)); 690 /* XXX is this correct? Always switch if in doubt? */ 691 continue; 692 } else if (rp->ap_state == ACPI_PWR_UNK) 693 rp->ap_state = cur; 694 695 /* 696 * Switch if required. Note that we ignore the result of the switch 697 * effort; we don't know what to do if it fails, so checking wouldn't 698 * help much. 699 */ 700 if (rp->ap_state != ACPI_PWR_OFF) { 701 status = AcpiEvaluateObject(rp->ap_resource, "_OFF", NULL, NULL); 702 if (ACPI_FAILURE(status)) { 703 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, 704 "failed to switch %s off - %s\n", 705 acpi_name(rp->ap_resource), 706 AcpiFormatException(status))); 707 } else { 708 rp->ap_state = ACPI_PWR_OFF; 709 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "switched %s off\n", 710 acpi_name(rp->ap_resource))); 711 } 712 } else { 713 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "%s is already off\n", 714 acpi_name(rp->ap_resource))); 715 } 716 } 717 718 return_ACPI_STATUS (AE_OK); 719} 720 721/* 722 * Find a power resource's control structure. 723 */ 724static struct acpi_powerresource * 725acpi_pwr_find_resource(ACPI_HANDLE res) 726{ 727 struct acpi_powerresource *rp; 728 729 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 730 ACPI_SERIAL_ASSERT(powerres); 731 732 TAILQ_FOREACH(rp, &acpi_powerresources, ap_link) { 733 if (rp->ap_resource == res) 734 break; 735 } 736 737 return_PTR (rp); 738} 739 740/* 741 * Find a power consumer's control structure. 742 */ 743static struct acpi_powerconsumer * 744acpi_pwr_find_consumer(ACPI_HANDLE consumer) 745{ 746 struct acpi_powerconsumer *pc; 747 748 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__); 749 ACPI_SERIAL_ASSERT(powerres); 750 751 TAILQ_FOREACH(pc, &acpi_powerconsumers, ac_link) { 752 if (pc->ac_consumer == consumer) 753 break; 754 } 755 756 return_PTR (pc); 757} 758