acpi_powerres.c revision 193530
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: head/sys/dev/acpica/acpi_powerres.c 193530 2009-06-05 18:44:36Z jkim $");
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 of 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
58MALLOC_DEFINE(M_ACPIPWR, "acpipwr", "ACPI power resources");
59
60/* Hooks for the ACPI CA debugging infrastructure */
61#define _COMPONENT	ACPI_POWERRES
62ACPI_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#define ACPI_PWR_UNK	(-1)
68
69/* A relationship between a power resource and a consumer. */
70struct acpi_powerreference {
71    struct acpi_powerconsumer		*ar_consumer;
72    struct acpi_powerresource		*ar_resource;
73    TAILQ_ENTRY(acpi_powerreference)	ar_rlink; /* link on resource list */
74    TAILQ_ENTRY(acpi_powerreference)	ar_clink; /* link on consumer */
75};
76
77/* A power-managed device. */
78struct acpi_powerconsumer {
79    /* Device which is powered */
80    ACPI_HANDLE				ac_consumer;
81    int					ac_state;
82    TAILQ_ENTRY(acpi_powerconsumer)	ac_link;
83    TAILQ_HEAD(,acpi_powerreference)	ac_references;
84};
85
86/* A power resource. */
87struct acpi_powerresource {
88    TAILQ_ENTRY(acpi_powerresource)	ap_link;
89    TAILQ_HEAD(,acpi_powerreference)	ap_references;
90    ACPI_HANDLE				ap_resource;
91    ACPI_INTEGER			ap_systemlevel;
92    ACPI_INTEGER			ap_order;
93    int					ap_state;
94};
95
96static TAILQ_HEAD(acpi_powerresource_list, acpi_powerresource)
97	acpi_powerresources;
98static TAILQ_HEAD(acpi_powerconsumer_list, acpi_powerconsumer)
99	acpi_powerconsumers;
100ACPI_SERIAL_DECL(powerres, "ACPI power resources");
101
102static ACPI_STATUS	acpi_pwr_register_consumer(ACPI_HANDLE consumer);
103#ifdef notyet
104static ACPI_STATUS	acpi_pwr_deregister_consumer(ACPI_HANDLE consumer);
105#endif /* notyet */
106static ACPI_STATUS	acpi_pwr_register_resource(ACPI_HANDLE res);
107#ifdef notyet
108static ACPI_STATUS	acpi_pwr_deregister_resource(ACPI_HANDLE res);
109#endif /* notyet */
110static void		acpi_pwr_reference_resource(ACPI_OBJECT *obj,
111						    void *arg);
112static int		acpi_pwr_dereference_resource(struct acpi_powerconsumer
113			    *pc);
114static ACPI_STATUS	acpi_pwr_switch_power(void);
115static struct acpi_powerresource
116			*acpi_pwr_find_resource(ACPI_HANDLE res);
117static struct acpi_powerconsumer
118			*acpi_pwr_find_consumer(ACPI_HANDLE consumer);
119
120/* Initialise our lists. */
121static void
122acpi_pwr_init(void *junk)
123{
124    TAILQ_INIT(&acpi_powerresources);
125    TAILQ_INIT(&acpi_powerconsumers);
126}
127SYSINIT(acpi_powerresource, SI_SUB_TUNABLES, SI_ORDER_ANY, acpi_pwr_init, NULL);
128
129/*
130 * Register a power resource.
131 *
132 * It's OK to call this if we already know about the resource.
133 */
134static ACPI_STATUS
135acpi_pwr_register_resource(ACPI_HANDLE res)
136{
137    ACPI_STATUS			status;
138    ACPI_BUFFER			buf;
139    ACPI_OBJECT			*obj;
140    struct acpi_powerresource	*rp, *srp;
141
142    ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
143    ACPI_SERIAL_ASSERT(powerres);
144
145    rp = NULL;
146    buf.Pointer = NULL;
147
148    /* Look to see if we know about this resource */
149    if (acpi_pwr_find_resource(res) != NULL)
150	return_ACPI_STATUS (AE_OK);		/* already know about it */
151
152    /* Allocate a new resource */
153    if ((rp = malloc(sizeof(*rp), M_ACPIPWR, M_NOWAIT | M_ZERO)) == NULL) {
154	status = AE_NO_MEMORY;
155	goto out;
156    }
157    TAILQ_INIT(&rp->ap_references);
158    rp->ap_resource = res;
159
160    /* Get the Power Resource object */
161    buf.Length = ACPI_ALLOCATE_BUFFER;
162    if (ACPI_FAILURE(status = AcpiEvaluateObject(res, NULL, NULL, &buf))) {
163	ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "no power resource object\n"));
164	goto out;
165    }
166    obj = buf.Pointer;
167    if (obj->Type != ACPI_TYPE_POWER) {
168	ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS,
169			 "questionable power resource object %s\n",
170			 acpi_name(res)));
171	status = AE_TYPE;
172	goto out;
173    }
174    rp->ap_systemlevel = obj->PowerResource.SystemLevel;
175    rp->ap_order = obj->PowerResource.ResourceOrder;
176    rp->ap_state = ACPI_PWR_UNK;
177
178    /* Sort the resource into the list */
179    status = AE_OK;
180    srp = TAILQ_FIRST(&acpi_powerresources);
181    if (srp == NULL || rp->ap_order < srp->ap_order) {
182	TAILQ_INSERT_HEAD(&acpi_powerresources, rp, ap_link);
183	goto done;
184    }
185    TAILQ_FOREACH(srp, &acpi_powerresources, ap_link) {
186	if (rp->ap_order < srp->ap_order) {
187	    TAILQ_INSERT_BEFORE(srp, rp, ap_link);
188	    goto done;
189	}
190    }
191    TAILQ_INSERT_TAIL(&acpi_powerresources, rp, ap_link);
192
193 done:
194    ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS,
195		     "registered power resource %s\n", acpi_name(res)));
196
197 out:
198    if (buf.Pointer != NULL)
199	AcpiOsFree(buf.Pointer);
200    if (ACPI_FAILURE(status) && rp != NULL)
201	free(rp, M_ACPIPWR);
202    return_ACPI_STATUS (status);
203}
204
205#ifdef notyet
206/*
207 * Deregister a power resource.
208 */
209static ACPI_STATUS
210acpi_pwr_deregister_resource(ACPI_HANDLE res)
211{
212    struct acpi_powerresource	*rp;
213
214    ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
215    ACPI_SERIAL_ASSERT(powerres);
216
217    rp = NULL;
218
219    /* Find the resource */
220    if ((rp = acpi_pwr_find_resource(res)) == NULL)
221	return_ACPI_STATUS (AE_BAD_PARAMETER);
222
223    /* Check that there are no consumers referencing this resource */
224    if (TAILQ_FIRST(&rp->ap_references) != NULL)
225	return_ACPI_STATUS (AE_BAD_PARAMETER);
226
227    /* Pull it off the list and free it */
228    TAILQ_REMOVE(&acpi_powerresources, rp, ap_link);
229    free(rp, M_ACPIPWR);
230
231    ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "deregistered power resource %s\n",
232		     acpi_name(res)));
233
234    return_ACPI_STATUS (AE_OK);
235}
236#endif /* notyet */
237
238/*
239 * Register a power consumer.
240 *
241 * It's OK to call this if we already know about the consumer.
242 */
243static ACPI_STATUS
244acpi_pwr_register_consumer(ACPI_HANDLE consumer)
245{
246    struct acpi_powerconsumer	*pc;
247
248    ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
249    ACPI_SERIAL_ASSERT(powerres);
250
251    /* Check to see whether we know about this consumer already */
252    if (acpi_pwr_find_consumer(consumer) != NULL)
253	return_ACPI_STATUS (AE_OK);
254
255    /* Allocate a new power consumer */
256    if ((pc = malloc(sizeof(*pc), M_ACPIPWR, M_NOWAIT)) == NULL)
257	return_ACPI_STATUS (AE_NO_MEMORY);
258    TAILQ_INSERT_HEAD(&acpi_powerconsumers, pc, ac_link);
259    TAILQ_INIT(&pc->ac_references);
260    pc->ac_consumer = consumer;
261
262    /* XXX we should try to find its current state */
263    pc->ac_state = ACPI_STATE_UNKNOWN;
264
265    ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "registered power consumer %s\n",
266		     acpi_name(consumer)));
267
268    return_ACPI_STATUS (AE_OK);
269}
270
271#ifdef notyet
272/*
273 * Deregister a power consumer.
274 *
275 * This should only be done once the consumer has been powered off.
276 * (XXX is this correct?  Check once implemented)
277 */
278static ACPI_STATUS
279acpi_pwr_deregister_consumer(ACPI_HANDLE consumer)
280{
281    struct acpi_powerconsumer	*pc;
282
283    ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
284    ACPI_SERIAL_ASSERT(powerres);
285
286    /* Find the consumer */
287    if ((pc = acpi_pwr_find_consumer(consumer)) == NULL)
288	return_ACPI_STATUS (AE_BAD_PARAMETER);
289
290    /* Make sure the consumer's not referencing anything right now */
291    if (TAILQ_FIRST(&pc->ac_references) != NULL)
292	return_ACPI_STATUS (AE_BAD_PARAMETER);
293
294    /* Pull the consumer off the list and free it */
295    TAILQ_REMOVE(&acpi_powerconsumers, pc, ac_link);
296    free(pc, M_ACPIPWR);
297
298    ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "deregistered power consumer %s\n",
299		     acpi_name(consumer)));
300
301    return_ACPI_STATUS (AE_OK);
302}
303#endif /* notyet */
304
305/*
306 * Set a power consumer to a particular power state.
307 */
308ACPI_STATUS
309acpi_pwr_switch_consumer(ACPI_HANDLE consumer, int state)
310{
311    struct acpi_powerconsumer	*pc;
312    ACPI_HANDLE			method_handle, reslist_handle, pr0_handle;
313    ACPI_BUFFER			reslist_buffer;
314    ACPI_OBJECT			*reslist_object;
315    ACPI_STATUS			status;
316    char			*method_name, *reslist_name;
317    int				res_changed;
318
319    ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
320
321    /* It's never ok to switch a non-existent consumer. */
322    if (consumer == NULL)
323	return_ACPI_STATUS (AE_NOT_FOUND);
324    reslist_buffer.Pointer = NULL;
325    reslist_object = NULL;
326    ACPI_SERIAL_BEGIN(powerres);
327
328    /* Find the consumer */
329    if ((pc = acpi_pwr_find_consumer(consumer)) == NULL) {
330	if (ACPI_FAILURE(status = acpi_pwr_register_consumer(consumer)))
331	    goto out;
332	if ((pc = acpi_pwr_find_consumer(consumer)) == NULL)
333	    panic("acpi added power consumer but can't find it");
334    }
335
336    /* Check for valid transitions.  We can only go to D0 from D3. */
337    status = AE_BAD_PARAMETER;
338    if (pc->ac_state == ACPI_STATE_D3 && state != ACPI_STATE_D0)
339	goto out;
340
341    /* Find transition mechanism(s) */
342    switch (state) {
343    case ACPI_STATE_D0:
344	method_name = "_PS0";
345	reslist_name = "_PR0";
346	break;
347    case ACPI_STATE_D1:
348	method_name = "_PS1";
349	reslist_name = "_PR1";
350	break;
351    case ACPI_STATE_D2:
352	method_name = "_PS2";
353	reslist_name = "_PR2";
354	break;
355    case ACPI_STATE_D3:
356	method_name = "_PS3";
357	reslist_name = "_PR3";
358	break;
359    default:
360	goto out;
361    }
362    ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "setup to switch %s D%d -> D%d\n",
363		     acpi_name(consumer), pc->ac_state, state));
364
365    /*
366     * Verify that this state is supported, ie. one of method or
367     * reslist must be present.  We need to do this before we go
368     * dereferencing resources (since we might be trying to go to
369     * a state we don't support).
370     *
371     * Note that if any states are supported, the device has to
372     * support D0 and D3.  It's never an error to try to go to
373     * D0.
374     */
375    if (ACPI_FAILURE(AcpiGetHandle(consumer, method_name, &method_handle)))
376	method_handle = NULL;
377    if (ACPI_FAILURE(AcpiGetHandle(consumer, reslist_name, &reslist_handle)))
378	reslist_handle = NULL;
379    if (reslist_handle == NULL && method_handle == NULL) {
380	if (state == ACPI_STATE_D0) {
381	    pc->ac_state = ACPI_STATE_D0;
382	    status = AE_OK;
383	    goto out;
384	}
385	if (state != ACPI_STATE_D3) {
386	    ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS,
387		"attempt to set unsupported state D%d\n", state));
388	    goto out;
389	}
390
391	/*
392	 * Turn off the resources listed in _PR0 to go to D3.  If there is
393	 * no _PR0 method, this object doesn't support ACPI power states.
394	 */
395	if (ACPI_FAILURE(AcpiGetHandle(consumer, "_PR0", &pr0_handle))) {
396	    status = AE_NOT_FOUND;
397	    ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS,
398		"device missing _PR0 (desired state was D%d)\n", state));
399	    goto out;
400	}
401	reslist_buffer.Length = ACPI_ALLOCATE_BUFFER;
402	status = AcpiEvaluateObject(pr0_handle, NULL, NULL, &reslist_buffer);
403	if (ACPI_FAILURE(status)) {
404	    ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS,
405		"can't evaluate _PR0 for device %s, state D%d\n",
406		acpi_name(consumer), state));
407	    goto out;
408	}
409	reslist_object = (ACPI_OBJECT *)reslist_buffer.Pointer;
410	if (!ACPI_PKG_VALID(reslist_object, 1)) {
411	    ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS,
412		"invalid package object for state D%d\n", state));
413	    status = AE_TYPE;
414	    goto out;
415	}
416	AcpiOsFree(reslist_buffer.Pointer);
417	reslist_buffer.Pointer = NULL;
418	reslist_object = NULL;
419    }
420
421    /*
422     * Check that we can actually fetch the list of power resources
423     */
424    if (reslist_handle != NULL) {
425	reslist_buffer.Length = ACPI_ALLOCATE_BUFFER;
426	status = AcpiEvaluateObject(reslist_handle, NULL, NULL,
427				    &reslist_buffer);
428	if (ACPI_FAILURE(status)) {
429	    ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS,
430			     "can't evaluate resource list %s\n",
431			     acpi_name(reslist_handle)));
432	    goto out;
433	}
434	reslist_object = (ACPI_OBJECT *)reslist_buffer.Pointer;
435	if (reslist_object->Type != ACPI_TYPE_PACKAGE) {
436	    ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS,
437			     "resource list is not ACPI_TYPE_PACKAGE (%d)\n",
438			     reslist_object->Type));
439	    status = AE_TYPE;
440	    goto out;
441	}
442    }
443
444    /*
445     * Now we are ready to switch, so kill off any current power
446     * resource references.
447     */
448    res_changed = acpi_pwr_dereference_resource(pc);
449
450    /*
451     * Add new power resource references, if we have any.  Traverse the
452     * package that we got from evaluating reslist_handle, and look up each
453     * of the resources that are referenced.
454     */
455    if (reslist_object != NULL) {
456	ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "referencing %d new resources\n",
457			  reslist_object->Package.Count));
458	acpi_ForeachPackageObject(reslist_object, acpi_pwr_reference_resource,
459				  pc);
460	res_changed = 1;
461    }
462
463    /*
464     * If we changed anything in the resource list, we need to run a switch
465     * pass now.
466     */
467    if (ACPI_FAILURE(status = acpi_pwr_switch_power())) {
468	ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS,
469			 "failed to switch resources from %s to D%d\n",
470			  acpi_name(consumer), state));
471
472	/* XXX is this appropriate?  Should we return to previous state? */
473	goto out;
474    }
475
476    /* Invoke power state switch method (if present) */
477    if (method_handle != NULL) {
478	ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS,
479			 "invoking state transition method %s\n",
480			 acpi_name(method_handle)));
481	status = AcpiEvaluateObject(method_handle, NULL, NULL, NULL);
482	if (ACPI_FAILURE(status)) {
483		ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "failed to set state - %s\n",
484				 AcpiFormatException(status)));
485		pc->ac_state = ACPI_STATE_UNKNOWN;
486
487		/* XXX Should we return to previous state? */
488		goto out;
489	}
490    }
491
492    /* Transition was successful */
493    pc->ac_state = state;
494    status = AE_OK;
495
496out:
497    ACPI_SERIAL_END(powerres);
498    if (reslist_buffer.Pointer != NULL)
499	AcpiOsFree(reslist_buffer.Pointer);
500    return_ACPI_STATUS (status);
501}
502
503/* Enable or disable a power resource for wake */
504ACPI_STATUS
505acpi_pwr_wake_enable(ACPI_HANDLE consumer, int enable)
506{
507    ACPI_STATUS status;
508    struct acpi_powerconsumer *pc;
509    struct acpi_prw_data prw;
510    int i;
511
512    ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
513
514    if (consumer == NULL)
515	return (AE_BAD_PARAMETER);
516
517    ACPI_SERIAL_BEGIN(powerres);
518    if ((pc = acpi_pwr_find_consumer(consumer)) == NULL) {
519	if (ACPI_FAILURE(status = acpi_pwr_register_consumer(consumer)))
520	    goto out;
521	if ((pc = acpi_pwr_find_consumer(consumer)) == NULL)
522	    panic("acpi wake added power consumer but can't find it");
523    }
524
525    status = AE_OK;
526    if (acpi_parse_prw(consumer, &prw) != 0)
527	goto out;
528    for (i = 0; i < prw.power_res_count; i++)
529	if (enable)
530	    acpi_pwr_reference_resource(&prw.power_res[i], pc);
531	else
532	    acpi_pwr_dereference_resource(pc);
533
534    if (prw.power_res_count > 0)
535	acpi_pwr_switch_power();
536
537out:
538    ACPI_SERIAL_END(powerres);
539    return (status);
540}
541
542/*
543 * Called to create a reference between a power consumer and a power resource
544 * identified in the object.
545 */
546static void
547acpi_pwr_reference_resource(ACPI_OBJECT *obj, void *arg)
548{
549    struct acpi_powerconsumer	*pc = (struct acpi_powerconsumer *)arg;
550    struct acpi_powerreference	*pr;
551    struct acpi_powerresource	*rp;
552    ACPI_HANDLE			res;
553    ACPI_STATUS			status;
554
555    ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
556    ACPI_SERIAL_ASSERT(powerres);
557
558    res = acpi_GetReference(NULL, obj);
559    if (res == NULL) {
560	ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS,
561			 "can't create a power reference for object type %d\n",
562			 obj->Type));
563	return_VOID;
564    }
565
566    /* Create/look up the resource */
567    if (ACPI_FAILURE(status = acpi_pwr_register_resource(res))) {
568	ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS,
569			 "couldn't register power resource %s - %s\n",
570			 obj->String.Pointer, AcpiFormatException(status)));
571	return_VOID;
572    }
573    if ((rp = acpi_pwr_find_resource(res)) == NULL) {
574	ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "power resource list corrupted\n"));
575	return_VOID;
576    }
577    ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "found power resource %s\n",
578		     acpi_name(rp->ap_resource)));
579
580    /* Create a reference between the consumer and resource */
581    if ((pr = malloc(sizeof(*pr), M_ACPIPWR, M_NOWAIT | M_ZERO)) == NULL) {
582	ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS,
583			 "allocation failed for a power consumer reference\n"));
584	return_VOID;
585    }
586    pr->ar_consumer = pc;
587    pr->ar_resource = rp;
588    TAILQ_INSERT_TAIL(&pc->ac_references, pr, ar_clink);
589    TAILQ_INSERT_TAIL(&rp->ap_references, pr, ar_rlink);
590
591    return_VOID;
592}
593
594static int
595acpi_pwr_dereference_resource(struct acpi_powerconsumer *pc)
596{
597    struct acpi_powerreference *pr;
598    int changed;
599
600    ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
601    ACPI_SERIAL_ASSERT(powerres);
602
603    changed = 0;
604    while ((pr = TAILQ_FIRST(&pc->ac_references)) != NULL) {
605        ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "removing reference to %s\n",
606                         acpi_name(pr->ar_resource->ap_resource)));
607        TAILQ_REMOVE(&pr->ar_resource->ap_references, pr, ar_rlink);
608        TAILQ_REMOVE(&pc->ac_references, pr, ar_clink);
609        free(pr, M_ACPIPWR);
610        changed = 1;
611    }
612
613    return (changed);
614}
615
616/*
617 * Switch power resources to conform to the desired state.
618 *
619 * Consumers may have modified the power resource list in an arbitrary
620 * fashion; we sweep it in sequence order.
621 */
622static ACPI_STATUS
623acpi_pwr_switch_power(void)
624{
625    struct acpi_powerresource	*rp;
626    ACPI_STATUS			status;
627    int				cur;
628
629    ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
630    ACPI_SERIAL_ASSERT(powerres);
631
632    /*
633     * Sweep the list forwards turning things on.
634     */
635    TAILQ_FOREACH(rp, &acpi_powerresources, ap_link) {
636	if (TAILQ_FIRST(&rp->ap_references) == NULL) {
637	    ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS,
638			     "%s has no references, not turning on\n",
639			     acpi_name(rp->ap_resource)));
640	    continue;
641	}
642
643	/* We could cache this if we trusted it not to change under us */
644	status = acpi_GetInteger(rp->ap_resource, "_STA", &cur);
645	if (ACPI_FAILURE(status)) {
646	    ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "can't get status of %s - %d\n",
647			      acpi_name(rp->ap_resource), status));
648	    /* XXX is this correct?  Always switch if in doubt? */
649	    continue;
650	} else if (rp->ap_state == ACPI_PWR_UNK)
651	    rp->ap_state = cur;
652
653	/*
654	 * Switch if required.  Note that we ignore the result of the switch
655	 * effort; we don't know what to do if it fails, so checking wouldn't
656	 * help much.
657	 */
658	if (rp->ap_state != ACPI_PWR_ON) {
659	    status = AcpiEvaluateObject(rp->ap_resource, "_ON", NULL, NULL);
660	    if (ACPI_FAILURE(status)) {
661		ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS,
662				 "failed to switch %s on - %s\n",
663				 acpi_name(rp->ap_resource),
664				 AcpiFormatException(status)));
665	    } else {
666		rp->ap_state = ACPI_PWR_ON;
667		ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "switched %s on\n",
668				 acpi_name(rp->ap_resource)));
669	    }
670	} else {
671	    ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "%s is already on\n",
672			     acpi_name(rp->ap_resource)));
673	}
674    }
675
676    /* Sweep the list backwards turning things off. */
677    TAILQ_FOREACH_REVERSE(rp, &acpi_powerresources, acpi_powerresource_list,
678	ap_link) {
679
680	if (TAILQ_FIRST(&rp->ap_references) != NULL) {
681	    ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS,
682			     "%s has references, not turning off\n",
683			     acpi_name(rp->ap_resource)));
684	    continue;
685	}
686
687	/* We could cache this if we trusted it not to change under us */
688	status = acpi_GetInteger(rp->ap_resource, "_STA", &cur);
689	if (ACPI_FAILURE(status)) {
690	    ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "can't get status of %s - %d\n",
691			      acpi_name(rp->ap_resource), status));
692	    /* XXX is this correct?  Always switch if in doubt? */
693	    continue;
694	} else if (rp->ap_state == ACPI_PWR_UNK)
695	    rp->ap_state = cur;
696
697	/*
698	 * Switch if required.  Note that we ignore the result of the switch
699	 * effort; we don't know what to do if it fails, so checking wouldn't
700	 * help much.
701	 */
702	if (rp->ap_state != ACPI_PWR_OFF) {
703	    status = AcpiEvaluateObject(rp->ap_resource, "_OFF", NULL, NULL);
704	    if (ACPI_FAILURE(status)) {
705		ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS,
706				 "failed to switch %s off - %s\n",
707				 acpi_name(rp->ap_resource),
708				 AcpiFormatException(status)));
709	    } else {
710		rp->ap_state = ACPI_PWR_OFF;
711		ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "switched %s off\n",
712				 acpi_name(rp->ap_resource)));
713	    }
714	} else {
715	    ACPI_DEBUG_PRINT((ACPI_DB_OBJECTS, "%s is already off\n",
716			     acpi_name(rp->ap_resource)));
717	}
718    }
719
720    return_ACPI_STATUS (AE_OK);
721}
722
723/*
724 * Find a power resource's control structure.
725 */
726static struct acpi_powerresource *
727acpi_pwr_find_resource(ACPI_HANDLE res)
728{
729    struct acpi_powerresource	*rp;
730
731    ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
732    ACPI_SERIAL_ASSERT(powerres);
733
734    TAILQ_FOREACH(rp, &acpi_powerresources, ap_link) {
735	if (rp->ap_resource == res)
736	    break;
737    }
738
739    return_PTR (rp);
740}
741
742/*
743 * Find a power consumer's control structure.
744 */
745static struct acpi_powerconsumer *
746acpi_pwr_find_consumer(ACPI_HANDLE consumer)
747{
748    struct acpi_powerconsumer	*pc;
749
750    ACPI_FUNCTION_TRACE((char *)(uintptr_t)__func__);
751    ACPI_SERIAL_ASSERT(powerres);
752
753    TAILQ_FOREACH(pc, &acpi_powerconsumers, ac_link) {
754	if (pc->ac_consumer == consumer)
755	    break;
756    }
757
758    return_PTR (pc);
759}
760