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