37#include <dev/acpica/acpivar.h>
38
39/*
40 * ACPI power resource management.
41 *
42 * Power resource behaviour is slightly complicated by the fact that
43 * a single power resource may provide power for more than one device.
44 * Thus, we must track the device(s) being powered by a given power
45 * resource, and only deactivate it when there are no powered devices.
46 *
47 * Note that this only manages resources for known devices. There is an
48 * ugly case where we may turn of power to a device which is in use because
49 * we don't know that it depends on a given resource. We should perhaps
50 * try to be smarter about this, but a more complete solution would involve
51 * scanning all of the ACPI namespace to find devices we're not currently
52 * aware of, and this raises questions about whether they should be left
53 * on, turned off, etc.
54 */
55
56MALLOC_DEFINE(M_ACPIPWR, "acpipwr", "ACPI power resources");
57
58/* Hooks for the ACPI CA debugging infrastructure */
59#define _COMPONENT ACPI_POWERRES
60ACPI_MODULE_NAME("POWERRES")
61
62/* Return values from _STA on a power resource */
63#define ACPI_PWR_OFF 0
64#define ACPI_PWR_ON 1
65#define ACPI_PWR_UNK (-1)
66
67/* A relationship between a power resource and a consumer. */
68struct acpi_powerreference {
69 struct acpi_powerconsumer *ar_consumer;
70 struct acpi_powerresource *ar_resource;
71 TAILQ_ENTRY(acpi_powerreference) ar_rlink; /* link on resource list */
72 TAILQ_ENTRY(acpi_powerreference) ar_clink; /* link on consumer */
73};
74
75/* A power-managed device. */
76struct acpi_powerconsumer {
77 /* Device which is powered */
78 ACPI_HANDLE ac_consumer;
79 int ac_state;
80 TAILQ_ENTRY(acpi_powerconsumer) ac_link;
81 TAILQ_HEAD(,acpi_powerreference) ac_references;
82};
83
84/* A power resource. */
85struct acpi_powerresource {
86 TAILQ_ENTRY(acpi_powerresource) ap_link;
87 TAILQ_HEAD(,acpi_powerreference) ap_references;
88 ACPI_HANDLE ap_resource;
89 ACPI_INTEGER ap_systemlevel;
90 ACPI_INTEGER ap_order;
91 int ap_state;
92};
93
94static TAILQ_HEAD(acpi_powerresource_list, acpi_powerresource)
95 acpi_powerresources;
96static TAILQ_HEAD(acpi_powerconsumer_list, acpi_powerconsumer)
97 acpi_powerconsumers;
98ACPI_SERIAL_DECL(powerres, "ACPI power resources");
99
100static ACPI_STATUS acpi_pwr_register_consumer(ACPI_HANDLE consumer);
101#ifdef notyet
102static ACPI_STATUS acpi_pwr_deregister_consumer(ACPI_HANDLE consumer);
103#endif /* notyet */
104static ACPI_STATUS acpi_pwr_register_resource(ACPI_HANDLE res);
105#ifdef notyet
106static ACPI_STATUS acpi_pwr_deregister_resource(ACPI_HANDLE res);
107#endif /* notyet */
108static void acpi_pwr_reference_resource(ACPI_OBJECT *obj,
109 void *arg);
110static int acpi_pwr_dereference_resource(struct acpi_powerconsumer
111 *pc);
112static ACPI_STATUS acpi_pwr_switch_power(void);
113static struct acpi_powerresource
114 *acpi_pwr_find_resource(ACPI_HANDLE res);
115static struct acpi_powerconsumer
116 *acpi_pwr_find_consumer(ACPI_HANDLE consumer);
117
118/* Initialise our lists. */
119static void
120acpi_pwr_init(void *junk)
121{
122 TAILQ_INIT(&acpi_powerresources);
123 TAILQ_INIT(&acpi_powerconsumers);
124}
125SYSINIT(acpi_powerresource, SI_SUB_TUNABLES, SI_ORDER_ANY, acpi_pwr_init, NULL);
126
127/*
128 * Register a power resource.
129 *
130 * It's OK to call this if we already know about the resource.
131 */
132static ACPI_STATUS
133acpi_pwr_register_resource(ACPI_HANDLE res)
134{
135 ACPI_STATUS status;
136 ACPI_BUFFER buf;
137 ACPI_OBJECT *obj;
138 struct acpi_powerresource *rp, *srp;
139
140 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
141 ACPI_SERIAL_ASSERT(powerres);
142
143 rp = NULL;
144 buf.Pointer = NULL;
145
146 /* Look to see if we know about this resource */
147 if (acpi_pwr_find_resource(res) != NULL)
148 return_ACPI_STATUS (AE_OK); /* already know about it */
149
150 /* Allocate a new resource */
151 if ((rp = malloc(sizeof(*rp), M_ACPIPWR, M_NOWAIT | M_ZERO)) == NULL) {
152 status = AE_NO_MEMORY;
153 goto out;
154 }
155 TAILQ_INIT(&rp->ap_references);
156 rp->ap_resource = res;
157
158 /* Get the Power Resource object */
159 buf.Length = ACPI_ALLOCATE_BUFFER;
160 if (ACPI_FAILURE(status = AcpiEvaluateObject(res, NULL, NULL, &buf))) {
161 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "no power resource object\n"));
162 goto out;
163 }
164 obj = buf.Pointer;
165 if (obj->Type != ACPI_TYPE_POWER) {
166 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS,
167 "questionable power resource object %s\n",
168 acpi_name(res)));
169 status = AE_TYPE;
170 goto out;
171 }
172 rp->ap_systemlevel = obj->PowerResource.SystemLevel;
173 rp->ap_order = obj->PowerResource.ResourceOrder;
174 rp->ap_state = ACPI_PWR_UNK;
175
176 /* Sort the resource into the list */
177 status = AE_OK;
178 srp = TAILQ_FIRST(&acpi_powerresources);
179 if (srp == NULL || rp->ap_order < srp->ap_order) {
180 TAILQ_INSERT_HEAD(&acpi_powerresources, rp, ap_link);
181 goto done;
182 }
183 TAILQ_FOREACH(srp, &acpi_powerresources, ap_link) {
184 if (rp->ap_order < srp->ap_order) {
185 TAILQ_INSERT_BEFORE(srp, rp, ap_link);
186 goto done;
187 }
188 }
189 TAILQ_INSERT_TAIL(&acpi_powerresources, rp, ap_link);
190
191 done:
192 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS,
193 "registered power resource %s\n", acpi_name(res)));
194
195 out:
196 if (buf.Pointer != NULL)
197 AcpiOsFree(buf.Pointer);
198 if (ACPI_FAILURE(status) && rp != NULL)
199 free(rp, M_ACPIPWR);
200 return_ACPI_STATUS (status);
201}
202
203#ifdef notyet
204/*
205 * Deregister a power resource.
206 */
207static ACPI_STATUS
208acpi_pwr_deregister_resource(ACPI_HANDLE res)
209{
210 struct acpi_powerresource *rp;
211
212 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
213 ACPI_SERIAL_ASSERT(powerres);
214
215 rp = NULL;
216
217 /* Find the resource */
218 if ((rp = acpi_pwr_find_resource(res)) == NULL)
219 return_ACPI_STATUS (AE_BAD_PARAMETER);
220
221 /* Check that there are no consumers referencing this resource */
222 if (TAILQ_FIRST(&rp->ap_references) != NULL)
223 return_ACPI_STATUS (AE_BAD_PARAMETER);
224
225 /* Pull it off the list and free it */
226 TAILQ_REMOVE(&acpi_powerresources, rp, ap_link);
227 free(rp, M_ACPIPWR);
228
229 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "deregistered power resource %s\n",
230 acpi_name(res)));
231
232 return_ACPI_STATUS (AE_OK);
233}
234#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}
| 37#include <dev/acpica/acpivar.h>
38
39/*
40 * ACPI power resource management.
41 *
42 * Power resource behaviour is slightly complicated by the fact that
43 * a single power resource may provide power for more than one device.
44 * Thus, we must track the device(s) being powered by a given power
45 * resource, and only deactivate it when there are no powered devices.
46 *
47 * Note that this only manages resources for known devices. There is an
48 * ugly case where we may turn of power to a device which is in use because
49 * we don't know that it depends on a given resource. We should perhaps
50 * try to be smarter about this, but a more complete solution would involve
51 * scanning all of the ACPI namespace to find devices we're not currently
52 * aware of, and this raises questions about whether they should be left
53 * on, turned off, etc.
54 */
55
56MALLOC_DEFINE(M_ACPIPWR, "acpipwr", "ACPI power resources");
57
58/* Hooks for the ACPI CA debugging infrastructure */
59#define _COMPONENT ACPI_POWERRES
60ACPI_MODULE_NAME("POWERRES")
61
62/* Return values from _STA on a power resource */
63#define ACPI_PWR_OFF 0
64#define ACPI_PWR_ON 1
65#define ACPI_PWR_UNK (-1)
66
67/* A relationship between a power resource and a consumer. */
68struct acpi_powerreference {
69 struct acpi_powerconsumer *ar_consumer;
70 struct acpi_powerresource *ar_resource;
71 TAILQ_ENTRY(acpi_powerreference) ar_rlink; /* link on resource list */
72 TAILQ_ENTRY(acpi_powerreference) ar_clink; /* link on consumer */
73};
74
75/* A power-managed device. */
76struct acpi_powerconsumer {
77 /* Device which is powered */
78 ACPI_HANDLE ac_consumer;
79 int ac_state;
80 TAILQ_ENTRY(acpi_powerconsumer) ac_link;
81 TAILQ_HEAD(,acpi_powerreference) ac_references;
82};
83
84/* A power resource. */
85struct acpi_powerresource {
86 TAILQ_ENTRY(acpi_powerresource) ap_link;
87 TAILQ_HEAD(,acpi_powerreference) ap_references;
88 ACPI_HANDLE ap_resource;
89 ACPI_INTEGER ap_systemlevel;
90 ACPI_INTEGER ap_order;
91 int ap_state;
92};
93
94static TAILQ_HEAD(acpi_powerresource_list, acpi_powerresource)
95 acpi_powerresources;
96static TAILQ_HEAD(acpi_powerconsumer_list, acpi_powerconsumer)
97 acpi_powerconsumers;
98ACPI_SERIAL_DECL(powerres, "ACPI power resources");
99
100static ACPI_STATUS acpi_pwr_register_consumer(ACPI_HANDLE consumer);
101#ifdef notyet
102static ACPI_STATUS acpi_pwr_deregister_consumer(ACPI_HANDLE consumer);
103#endif /* notyet */
104static ACPI_STATUS acpi_pwr_register_resource(ACPI_HANDLE res);
105#ifdef notyet
106static ACPI_STATUS acpi_pwr_deregister_resource(ACPI_HANDLE res);
107#endif /* notyet */
108static void acpi_pwr_reference_resource(ACPI_OBJECT *obj,
109 void *arg);
110static int acpi_pwr_dereference_resource(struct acpi_powerconsumer
111 *pc);
112static ACPI_STATUS acpi_pwr_switch_power(void);
113static struct acpi_powerresource
114 *acpi_pwr_find_resource(ACPI_HANDLE res);
115static struct acpi_powerconsumer
116 *acpi_pwr_find_consumer(ACPI_HANDLE consumer);
117
118/* Initialise our lists. */
119static void
120acpi_pwr_init(void *junk)
121{
122 TAILQ_INIT(&acpi_powerresources);
123 TAILQ_INIT(&acpi_powerconsumers);
124}
125SYSINIT(acpi_powerresource, SI_SUB_TUNABLES, SI_ORDER_ANY, acpi_pwr_init, NULL);
126
127/*
128 * Register a power resource.
129 *
130 * It's OK to call this if we already know about the resource.
131 */
132static ACPI_STATUS
133acpi_pwr_register_resource(ACPI_HANDLE res)
134{
135 ACPI_STATUS status;
136 ACPI_BUFFER buf;
137 ACPI_OBJECT *obj;
138 struct acpi_powerresource *rp, *srp;
139
140 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
141 ACPI_SERIAL_ASSERT(powerres);
142
143 rp = NULL;
144 buf.Pointer = NULL;
145
146 /* Look to see if we know about this resource */
147 if (acpi_pwr_find_resource(res) != NULL)
148 return_ACPI_STATUS (AE_OK); /* already know about it */
149
150 /* Allocate a new resource */
151 if ((rp = malloc(sizeof(*rp), M_ACPIPWR, M_NOWAIT | M_ZERO)) == NULL) {
152 status = AE_NO_MEMORY;
153 goto out;
154 }
155 TAILQ_INIT(&rp->ap_references);
156 rp->ap_resource = res;
157
158 /* Get the Power Resource object */
159 buf.Length = ACPI_ALLOCATE_BUFFER;
160 if (ACPI_FAILURE(status = AcpiEvaluateObject(res, NULL, NULL, &buf))) {
161 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "no power resource object\n"));
162 goto out;
163 }
164 obj = buf.Pointer;
165 if (obj->Type != ACPI_TYPE_POWER) {
166 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS,
167 "questionable power resource object %s\n",
168 acpi_name(res)));
169 status = AE_TYPE;
170 goto out;
171 }
172 rp->ap_systemlevel = obj->PowerResource.SystemLevel;
173 rp->ap_order = obj->PowerResource.ResourceOrder;
174 rp->ap_state = ACPI_PWR_UNK;
175
176 /* Sort the resource into the list */
177 status = AE_OK;
178 srp = TAILQ_FIRST(&acpi_powerresources);
179 if (srp == NULL || rp->ap_order < srp->ap_order) {
180 TAILQ_INSERT_HEAD(&acpi_powerresources, rp, ap_link);
181 goto done;
182 }
183 TAILQ_FOREACH(srp, &acpi_powerresources, ap_link) {
184 if (rp->ap_order < srp->ap_order) {
185 TAILQ_INSERT_BEFORE(srp, rp, ap_link);
186 goto done;
187 }
188 }
189 TAILQ_INSERT_TAIL(&acpi_powerresources, rp, ap_link);
190
191 done:
192 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS,
193 "registered power resource %s\n", acpi_name(res)));
194
195 out:
196 if (buf.Pointer != NULL)
197 AcpiOsFree(buf.Pointer);
198 if (ACPI_FAILURE(status) && rp != NULL)
199 free(rp, M_ACPIPWR);
200 return_ACPI_STATUS (status);
201}
202
203#ifdef notyet
204/*
205 * Deregister a power resource.
206 */
207static ACPI_STATUS
208acpi_pwr_deregister_resource(ACPI_HANDLE res)
209{
210 struct acpi_powerresource *rp;
211
212 ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
213 ACPI_SERIAL_ASSERT(powerres);
214
215 rp = NULL;
216
217 /* Find the resource */
218 if ((rp = acpi_pwr_find_resource(res)) == NULL)
219 return_ACPI_STATUS (AE_BAD_PARAMETER);
220
221 /* Check that there are no consumers referencing this resource */
222 if (TAILQ_FIRST(&rp->ap_references) != NULL)
223 return_ACPI_STATUS (AE_BAD_PARAMETER);
224
225 /* Pull it off the list and free it */
226 TAILQ_REMOVE(&acpi_powerresources, rp, ap_link);
227 free(rp, M_ACPIPWR);
228
229 ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "deregistered power resource %s\n",
230 acpi_name(res)));
231
232 return_ACPI_STATUS (AE_OK);
233}
234#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}
|