Home | History | Annotate | Line # | Download | only in acpi
acpi_power.c revision 1.10
      1  1.10  jruoho /* $NetBSD: acpi_power.c,v 1.10 2010/04/26 13:38:42 jruoho Exp $ */
      2   1.1  jruoho 
      3   1.1  jruoho /*-
      4   1.1  jruoho  * Copyright (c) 2009, 2010 The NetBSD Foundation, Inc.
      5   1.1  jruoho  * All rights reserved.
      6   1.1  jruoho  *
      7   1.1  jruoho  * This code is derived from software contributed to The NetBSD Foundation
      8   1.1  jruoho  * by Jukka Ruohonen.
      9   1.1  jruoho  *
     10   1.1  jruoho  * Redistribution and use in source and binary forms, with or without
     11   1.1  jruoho  * modification, are permitted provided that the following conditions
     12   1.1  jruoho  * are met:
     13   1.1  jruoho  * 1. Redistributions of source code must retain the above copyright
     14   1.1  jruoho  *    notice, this list of conditions and the following disclaimer.
     15   1.1  jruoho  * 2. Redistributions in binary form must reproduce the above copyright
     16   1.1  jruoho  *    notice, this list of conditions and the following disclaimer in the
     17   1.1  jruoho  *    documentation and/or other materials provided with the distribution.
     18   1.1  jruoho  *
     19   1.1  jruoho  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20   1.1  jruoho  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21   1.1  jruoho  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22   1.1  jruoho  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23   1.1  jruoho  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24   1.1  jruoho  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25   1.1  jruoho  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26   1.1  jruoho  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27   1.1  jruoho  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28   1.1  jruoho  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29   1.1  jruoho  * POSSIBILITY OF SUCH DAMAGE.
     30   1.1  jruoho  */
     31   1.1  jruoho 
     32   1.1  jruoho /*-
     33   1.1  jruoho  * Copyright (c) 2001 Michael Smith
     34   1.1  jruoho  * All rights reserved.
     35   1.1  jruoho  *
     36   1.1  jruoho  * Redistribution and use in source and binary forms, with or without
     37   1.1  jruoho  * modification, are permitted provided that the following conditions
     38   1.1  jruoho  * are met:
     39   1.1  jruoho  * 1. Redistributions of source code must retain the above copyright
     40   1.1  jruoho  *    notice, this list of conditions and the following disclaimer.
     41   1.1  jruoho  * 2. Redistributions in binary form must reproduce the above copyright
     42   1.1  jruoho  *    notice, this list of conditions and the following disclaimer in the
     43   1.1  jruoho  *    documentation and/or other materials provided with the distribution.
     44   1.1  jruoho  *
     45   1.1  jruoho  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
     46   1.1  jruoho  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     47   1.1  jruoho  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     48   1.1  jruoho  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
     49   1.1  jruoho  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     50   1.1  jruoho  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     51   1.1  jruoho  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     52   1.1  jruoho  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     53   1.1  jruoho  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     54   1.1  jruoho  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     55   1.1  jruoho  * SUCH DAMAGE.
     56   1.1  jruoho  */
     57   1.1  jruoho 
     58   1.1  jruoho #include <sys/cdefs.h>
     59  1.10  jruoho __KERNEL_RCSID(0, "$NetBSD: acpi_power.c,v 1.10 2010/04/26 13:38:42 jruoho Exp $");
     60   1.1  jruoho 
     61   1.1  jruoho #include <sys/param.h>
     62   1.1  jruoho #include <sys/kmem.h>
     63   1.1  jruoho #include <sys/mutex.h>
     64   1.4  jruoho #include <sys/sysctl.h>
     65   1.1  jruoho 
     66   1.1  jruoho #include <dev/acpi/acpireg.h>
     67   1.1  jruoho #include <dev/acpi/acpivar.h>
     68   1.1  jruoho #include <dev/acpi/acpi_power.h>
     69   1.1  jruoho 
     70   1.1  jruoho #define _COMPONENT			ACPI_BUS_COMPONENT
     71   1.1  jruoho ACPI_MODULE_NAME			("acpi_power")
     72   1.1  jruoho 
     73   1.1  jruoho /*
     74   1.1  jruoho  * References.
     75   1.1  jruoho  */
     76   1.1  jruoho struct acpi_power_ref {
     77   1.1  jruoho 	ACPI_HANDLE			ref_handle;
     78   1.1  jruoho 
     79   1.1  jruoho 	SIMPLEQ_ENTRY(acpi_power_ref)	ref_list;
     80   1.1  jruoho };
     81   1.1  jruoho 
     82   1.1  jruoho /*
     83   1.1  jruoho  * Resources.
     84   1.1  jruoho  */
     85   1.1  jruoho struct acpi_power_res {
     86   1.1  jruoho 	ACPI_HANDLE			res_handle;
     87   1.1  jruoho 	ACPI_INTEGER			res_level;
     88   1.1  jruoho 	ACPI_INTEGER			res_order;
     89   1.1  jruoho 	char				res_name[5];
     90   1.1  jruoho 	kmutex_t			res_mutex;
     91   1.1  jruoho 
     92   1.1  jruoho 	TAILQ_ENTRY(acpi_power_res)	res_list;
     93   1.1  jruoho 	SIMPLEQ_HEAD(, acpi_power_ref)	ref_head;
     94   1.1  jruoho };
     95   1.1  jruoho 
     96   1.1  jruoho static TAILQ_HEAD(, acpi_power_res) res_head =
     97   1.1  jruoho 	TAILQ_HEAD_INITIALIZER(res_head);
     98   1.1  jruoho 
     99   1.4  jruoho static const struct sysctlnode	*anode = NULL;
    100   1.4  jruoho 
    101   1.1  jruoho static struct acpi_power_res	*acpi_power_res_init(ACPI_HANDLE);
    102   1.1  jruoho static struct acpi_power_res	*acpi_power_res_get(ACPI_HANDLE);
    103   1.1  jruoho 
    104   1.1  jruoho #if 0
    105   1.1  jruoho static ACPI_STATUS	 acpi_power_get_direct(struct acpi_devnode *);
    106   1.1  jruoho #endif
    107   1.1  jruoho 
    108   1.1  jruoho static ACPI_STATUS	 acpi_power_get_indirect(struct acpi_devnode *);
    109   1.1  jruoho static ACPI_STATUS	 acpi_power_switch(struct acpi_devnode *,
    110   1.1  jruoho 						   int, bool);
    111   1.1  jruoho static ACPI_STATUS	 acpi_power_res_on(ACPI_OBJECT *, void *);
    112   1.1  jruoho static ACPI_STATUS	 acpi_power_res_off(ACPI_OBJECT *, void *);
    113   1.1  jruoho static ACPI_STATUS	 acpi_power_res_ref(struct acpi_power_res *,
    114   1.1  jruoho 					    ACPI_HANDLE);
    115   1.1  jruoho static ACPI_STATUS	 acpi_power_res_deref(struct acpi_power_res *,
    116   1.1  jruoho 					      ACPI_HANDLE);
    117   1.1  jruoho static ACPI_STATUS	 acpi_power_res_sta(ACPI_OBJECT *, void *);
    118   1.1  jruoho 
    119   1.1  jruoho static ACPI_OBJECT	*acpi_power_pkg_get(ACPI_HANDLE, int);
    120   1.4  jruoho static int		 acpi_power_sysctl(SYSCTLFN_ARGS);
    121   1.1  jruoho static const char	*acpi_xname(ACPI_HANDLE);
    122   1.1  jruoho 
    123   1.1  jruoho void
    124   1.1  jruoho acpi_power_res_add(struct acpi_devnode *ad)
    125   1.1  jruoho {
    126   1.1  jruoho 	struct acpi_power_res *res;
    127   1.1  jruoho 
    128   1.1  jruoho 	KASSERT(ad != NULL && ad->ad_root != NULL);
    129   1.1  jruoho 	KASSERT(ad->ad_devinfo->Type == ACPI_TYPE_POWER);
    130   1.1  jruoho 
    131   1.1  jruoho 	res = acpi_power_res_init(ad->ad_handle);
    132   1.1  jruoho 
    133   1.1  jruoho 	if (res == NULL)
    134   1.1  jruoho 		aprint_error_dev(ad->ad_root, "failed to "
    135   1.1  jruoho 		    "add power resource %s\n", ad->ad_name);
    136   1.1  jruoho }
    137   1.1  jruoho 
    138   1.1  jruoho static struct acpi_power_res *
    139   1.1  jruoho acpi_power_res_init(ACPI_HANDLE hdl)
    140   1.1  jruoho {
    141   1.1  jruoho 	struct acpi_power_res *tmp = NULL;
    142   1.1  jruoho 	struct acpi_power_res *res = NULL;
    143   1.1  jruoho 	ACPI_OBJECT *obj;
    144   1.1  jruoho 	ACPI_BUFFER buf;
    145   1.1  jruoho 	ACPI_STATUS rv;
    146   1.1  jruoho 
    147   1.1  jruoho 	rv = acpi_eval_struct(hdl, NULL, &buf);
    148   1.1  jruoho 
    149   1.1  jruoho 	if (ACPI_FAILURE(rv))
    150   1.1  jruoho 		goto out;
    151   1.1  jruoho 
    152   1.1  jruoho 	obj = buf.Pointer;
    153   1.1  jruoho 
    154   1.1  jruoho 	if (obj->Type != ACPI_TYPE_POWER) {
    155   1.1  jruoho 		rv = AE_TYPE;
    156   1.1  jruoho 		goto out;
    157   1.1  jruoho 	}
    158   1.1  jruoho 
    159   1.1  jruoho 	res = kmem_zalloc(sizeof(*res), KM_SLEEP);
    160   1.1  jruoho 
    161   1.1  jruoho 	if (res == NULL) {
    162   1.1  jruoho 		rv = AE_NO_MEMORY;
    163   1.1  jruoho 		goto out;
    164   1.1  jruoho 	}
    165   1.1  jruoho 
    166   1.1  jruoho 	res->res_handle = hdl;
    167   1.1  jruoho 	res->res_level = obj->PowerResource.SystemLevel;
    168   1.1  jruoho 	res->res_order = obj->PowerResource.ResourceOrder;
    169   1.1  jruoho 
    170   1.1  jruoho 	(void)strlcpy(res->res_name,
    171   1.1  jruoho 	    acpi_xname(hdl), sizeof(res->res_name));
    172   1.1  jruoho 
    173   1.1  jruoho 	SIMPLEQ_INIT(&res->ref_head);
    174   1.1  jruoho 	mutex_init(&res->res_mutex, MUTEX_DEFAULT, IPL_NONE);
    175   1.1  jruoho 
    176   1.1  jruoho 	/*
    177   1.1  jruoho 	 * Power resources should be ordered.
    178   1.1  jruoho 	 *
    179   1.1  jruoho 	 * These *should* be enabled from low values to high
    180   1.1  jruoho 	 * values and disabled from high values to low values.
    181   1.1  jruoho 	 */
    182   1.1  jruoho 	TAILQ_FOREACH(tmp, &res_head, res_list) {
    183   1.1  jruoho 
    184   1.1  jruoho 		if (res->res_order < tmp->res_order) {
    185   1.1  jruoho 			TAILQ_INSERT_BEFORE(tmp, res, res_list);
    186   1.1  jruoho 			break;
    187   1.1  jruoho 		}
    188   1.1  jruoho 	}
    189   1.1  jruoho 
    190   1.1  jruoho 	if (tmp == NULL)
    191   1.1  jruoho 		TAILQ_INSERT_TAIL(&res_head, res, res_list);
    192   1.1  jruoho 
    193   1.1  jruoho out:
    194   1.1  jruoho 	if (buf.Pointer != NULL)
    195   1.1  jruoho 		ACPI_FREE(buf.Pointer);
    196   1.1  jruoho 
    197   1.1  jruoho 	return res;
    198   1.1  jruoho }
    199   1.1  jruoho 
    200   1.1  jruoho static struct acpi_power_res *
    201   1.1  jruoho acpi_power_res_get(ACPI_HANDLE hdl)
    202   1.1  jruoho {
    203   1.1  jruoho 	struct acpi_power_res *res;
    204   1.1  jruoho 
    205   1.1  jruoho 	TAILQ_FOREACH(res, &res_head, res_list) {
    206   1.1  jruoho 
    207   1.1  jruoho 		if (res->res_handle == hdl)
    208   1.1  jruoho 			return res;
    209   1.1  jruoho 	}
    210   1.1  jruoho 
    211   1.1  jruoho 	return acpi_power_res_init(hdl);
    212   1.1  jruoho }
    213   1.1  jruoho 
    214   1.1  jruoho bool
    215   1.1  jruoho acpi_power_register(struct acpi_devnode *ad)
    216   1.1  jruoho {
    217   1.1  jruoho 
    218   1.1  jruoho 	KASSERT(ad != NULL && ad->ad_root != NULL);
    219   1.1  jruoho 
    220   1.1  jruoho 	if ((ad->ad_flags & ACPI_DEVICE_POWER) == 0)
    221   1.1  jruoho 		return false;
    222   1.1  jruoho 
    223   1.1  jruoho 	return true;
    224   1.1  jruoho }
    225   1.1  jruoho 
    226   1.1  jruoho void
    227   1.1  jruoho acpi_power_deregister(struct acpi_devnode *ad)
    228   1.1  jruoho {
    229   1.1  jruoho 	struct acpi_power_res *res;
    230   1.1  jruoho 
    231   1.1  jruoho 	KASSERT(ad != NULL && ad->ad_root != NULL);
    232   1.1  jruoho 
    233   1.1  jruoho 	if ((ad->ad_flags & ACPI_DEVICE_POWER) == 0)
    234   1.1  jruoho 		return;
    235   1.1  jruoho 
    236   1.1  jruoho 	/*
    237   1.1  jruoho 	 * Remove all references in each resource.
    238   1.1  jruoho 	 */
    239   1.1  jruoho 	TAILQ_FOREACH(res, &res_head, res_list)
    240   1.1  jruoho 	    (void)acpi_power_res_deref(res, ad->ad_handle);
    241   1.1  jruoho }
    242   1.1  jruoho 
    243   1.6  jruoho void
    244   1.6  jruoho acpi_power_deregister_from_handle(ACPI_HANDLE hdl)
    245   1.6  jruoho {
    246   1.7  jruoho 	struct acpi_devnode *ad = acpi_get_node(hdl);
    247   1.6  jruoho 
    248   1.7  jruoho 	if (ad == NULL)
    249   1.6  jruoho 		return;
    250   1.6  jruoho 
    251   1.7  jruoho 	acpi_power_deregister(ad);
    252   1.6  jruoho }
    253   1.6  jruoho 
    254   1.1  jruoho /*
    255   1.1  jruoho  * Get the D-state of an ACPI device node.
    256   1.1  jruoho  */
    257   1.1  jruoho bool
    258   1.1  jruoho acpi_power_get(struct acpi_devnode *ad, int *state)
    259   1.1  jruoho {
    260   1.1  jruoho 	ACPI_STATUS rv;
    261   1.1  jruoho 
    262   1.1  jruoho 	if ((ad->ad_flags & ACPI_DEVICE_POWER) == 0) {
    263   1.1  jruoho 		rv = AE_SUPPORT;
    264   1.1  jruoho 		goto fail;
    265   1.1  jruoho 	}
    266   1.1  jruoho 
    267   1.1  jruoho 	rv = acpi_power_get_indirect(ad);
    268   1.1  jruoho 
    269   1.1  jruoho 	if (ACPI_FAILURE(rv))
    270   1.1  jruoho 		goto fail;
    271   1.1  jruoho 
    272   1.1  jruoho 	KASSERT(ad->ad_state != ACPI_STATE_ERROR);
    273   1.1  jruoho 
    274   1.1  jruoho 	if (ad->ad_state < ACPI_STATE_D0 || ad->ad_state > ACPI_STATE_D3) {
    275   1.1  jruoho 		rv = AE_BAD_VALUE;
    276   1.1  jruoho 		goto fail;
    277   1.1  jruoho 	}
    278   1.1  jruoho 
    279   1.1  jruoho 	if (state != NULL)
    280   1.1  jruoho 		*state = ad->ad_state;
    281   1.1  jruoho 
    282   1.1  jruoho 	return true;
    283   1.1  jruoho 
    284   1.1  jruoho fail:
    285   1.1  jruoho 	ad->ad_state = ACPI_STATE_ERROR;
    286   1.1  jruoho 
    287   1.1  jruoho 	if (state != NULL)
    288   1.1  jruoho 		*state = ad->ad_state;
    289   1.1  jruoho 
    290   1.1  jruoho 	aprint_error_dev(ad->ad_root, "failed to get power state "
    291   1.1  jruoho 	    "for %s: %s\n", ad->ad_name, AcpiFormatException(rv));
    292   1.1  jruoho 
    293   1.1  jruoho 	return false;
    294   1.1  jruoho }
    295   1.1  jruoho 
    296   1.1  jruoho #if 0
    297   1.1  jruoho /*
    298   1.1  jruoho  * Unfortunately, comparable to _STA, there are systems
    299   1.1  jruoho  * where the convenient _PSC is implemented incorrectly.
    300   1.1  jruoho  */
    301   1.1  jruoho static ACPI_STATUS
    302   1.1  jruoho acpi_power_get_direct(struct acpi_devnode *ad)
    303   1.1  jruoho {
    304   1.1  jruoho 	ACPI_INTEGER val = 0;
    305   1.1  jruoho 	ACPI_STATUS rv;
    306   1.1  jruoho 
    307   1.1  jruoho 	rv = acpi_eval_integer(ad->ad_handle, "_PSC", &val);
    308   1.1  jruoho 
    309   1.1  jruoho 	KDASSERT((uint64_t)val < INT_MAX);
    310   1.1  jruoho 
    311   1.1  jruoho 	ad->ad_state = (int)val;
    312   1.1  jruoho 
    313   1.1  jruoho 	return rv;
    314   1.1  jruoho }
    315   1.1  jruoho #endif
    316   1.1  jruoho 
    317   1.1  jruoho static ACPI_STATUS
    318   1.1  jruoho acpi_power_get_indirect(struct acpi_devnode *ad)
    319   1.1  jruoho {
    320   1.1  jruoho 	ACPI_OBJECT *pkg;
    321   1.1  jruoho 	ACPI_STATUS rv;
    322   1.1  jruoho 	int i;
    323   1.1  jruoho 
    324   1.1  jruoho 	CTASSERT(ACPI_STATE_D0 == 0 && ACPI_STATE_D1 == 1);
    325   1.1  jruoho 	CTASSERT(ACPI_STATE_D2 == 2 && ACPI_STATE_D3 == 3);
    326   1.1  jruoho 
    327   1.1  jruoho 	/*
    328   1.1  jruoho 	 * The device is in a given D-state if all resources are on.
    329   1.1  jruoho 	 * To derive this, evaluate all elements in each _PRx package
    330   1.1  jruoho 	 * (x = 0 ... 3) and break if the noted condition becomes true.
    331   1.1  jruoho 	 */
    332   1.1  jruoho 	for (ad->ad_state = ACPI_STATE_D3, i = 0; i < ACPI_STATE_D3; i++) {
    333   1.1  jruoho 
    334   1.1  jruoho 		pkg = acpi_power_pkg_get(ad->ad_handle, i);
    335   1.1  jruoho 
    336   1.1  jruoho 		if (pkg == NULL)
    337   1.1  jruoho 			continue;
    338   1.1  jruoho 
    339   1.1  jruoho 		/*
    340   1.1  jruoho 		 * For each element in the _PRx package, evaluate _STA
    341   1.1  jruoho 		 * and return AE_OK only if all power resources are on.
    342   1.1  jruoho 		 */
    343   1.1  jruoho 		rv = acpi_foreach_package_object(pkg, acpi_power_res_sta, ad);
    344   1.1  jruoho 
    345   1.9  jruoho 		if (ACPI_FAILURE(rv) && rv != AE_CTRL_FALSE)
    346   1.1  jruoho 			goto out;
    347   1.1  jruoho 
    348   1.1  jruoho 		if (ACPI_SUCCESS(rv)) {
    349   1.1  jruoho 			ad->ad_state = i;
    350   1.1  jruoho 			goto out;
    351   1.1  jruoho 		}
    352   1.1  jruoho 
    353   1.1  jruoho 		ACPI_FREE(pkg); pkg = NULL;
    354   1.1  jruoho 	}
    355   1.1  jruoho 
    356   1.1  jruoho 	KASSERT(ad->ad_state == ACPI_STATE_D3);
    357   1.1  jruoho 
    358   1.1  jruoho 	return AE_OK;
    359   1.1  jruoho 
    360   1.1  jruoho out:
    361   1.1  jruoho 	ACPI_FREE(pkg);
    362   1.1  jruoho 
    363   1.1  jruoho 	return rv;
    364   1.1  jruoho }
    365   1.1  jruoho 
    366   1.1  jruoho /*
    367   1.1  jruoho  * Set the D-state of an ACPI device node.
    368   1.1  jruoho  */
    369   1.1  jruoho bool
    370   1.1  jruoho acpi_power_set(struct acpi_devnode *ad, int state)
    371   1.1  jruoho {
    372   1.1  jruoho 	ACPI_STATUS rv;
    373   1.1  jruoho 	char path[5];
    374   1.1  jruoho 	int old;
    375   1.1  jruoho 
    376   1.1  jruoho 	KASSERT(ad != NULL && ad->ad_root != NULL);
    377   1.1  jruoho 
    378   1.1  jruoho 	if (state < ACPI_STATE_D0 || state > ACPI_STATE_D3) {
    379   1.1  jruoho 		rv = AE_BAD_PARAMETER;
    380   1.1  jruoho 		goto fail;
    381   1.1  jruoho 	}
    382   1.1  jruoho 
    383   1.1  jruoho 	if ((ad->ad_flags & ACPI_DEVICE_POWER) == 0) {
    384   1.1  jruoho 		rv = AE_SUPPORT;
    385   1.1  jruoho 		goto fail;
    386   1.1  jruoho 	}
    387   1.1  jruoho 
    388   1.1  jruoho 	if (acpi_power_get(ad, &old) != true) {
    389   1.1  jruoho 		rv = AE_NOT_FOUND;
    390   1.1  jruoho 		goto fail;
    391   1.1  jruoho 	}
    392   1.1  jruoho 
    393   1.1  jruoho 	KASSERT(ad->ad_state == old);
    394   1.1  jruoho 	KASSERT(ad->ad_state != ACPI_STATE_ERROR);
    395   1.1  jruoho 
    396   1.1  jruoho 	if (ad->ad_state == state) {
    397   1.1  jruoho 		rv = AE_ALREADY_EXISTS;
    398   1.1  jruoho 		goto fail;
    399   1.1  jruoho 	}
    400   1.1  jruoho 
    401   1.1  jruoho 	/*
    402   1.1  jruoho 	 * It is only possible to go to D0 ("on") from D3 ("off").
    403   1.1  jruoho 	 */
    404   1.1  jruoho 	if (ad->ad_state == ACPI_STATE_D3 && state != ACPI_STATE_D0) {
    405   1.1  jruoho 		rv = AE_BAD_PARAMETER;
    406   1.1  jruoho 		goto fail;
    407   1.1  jruoho 	}
    408   1.1  jruoho 
    409   1.1  jruoho 	/*
    410   1.1  jruoho 	 * We first sweep through the resources required
    411   1.1  jruoho 	 * for the target state, turning things on and
    412   1.1  jruoho 	 * building references. After this we dereference
    413   1.1  jruoho 	 * the resources required for the current state,
    414   1.1  jruoho 	 * turning the resources off as we go.
    415   1.1  jruoho 	 */
    416   1.1  jruoho 	rv = acpi_power_switch(ad, state, true);
    417   1.1  jruoho 
    418   1.1  jruoho 	if (ACPI_FAILURE(rv))
    419   1.1  jruoho 		goto fail;
    420   1.1  jruoho 
    421   1.1  jruoho 	rv = acpi_power_switch(ad, ad->ad_state, false);
    422   1.1  jruoho 
    423   1.1  jruoho 	if (ACPI_FAILURE(rv))
    424   1.1  jruoho 		goto fail;
    425   1.1  jruoho 
    426   1.1  jruoho 	ad->ad_state = state;
    427   1.1  jruoho 
    428   1.1  jruoho 	/*
    429   1.1  jruoho 	 * Last but not least, invoke the power
    430   1.1  jruoho 	 * state switch method, if available.
    431   1.1  jruoho 	 */
    432   1.1  jruoho 	(void)snprintf(path, sizeof(path), "_PS%d", state);
    433   1.1  jruoho 	(void)AcpiEvaluateObject(ad->ad_handle, path, NULL, NULL);
    434   1.1  jruoho 
    435   1.1  jruoho 	aprint_debug_dev(ad->ad_root, "%s turned from "
    436   1.1  jruoho 	    "D%d to D%d\n", ad->ad_name, old, state);
    437   1.1  jruoho 
    438   1.1  jruoho 	return true;
    439   1.1  jruoho 
    440   1.1  jruoho fail:
    441   1.2  jruoho 	ad->ad_state = ACPI_STATE_ERROR;
    442   1.1  jruoho 
    443   1.2  jruoho 	aprint_error_dev(ad->ad_root, "failed to set power state to D%d "
    444   1.2  jruoho 	    "for %s: %s\n", state, ad->ad_name, AcpiFormatException(rv));
    445   1.1  jruoho 
    446   1.2  jruoho 	return false;
    447   1.1  jruoho }
    448   1.1  jruoho 
    449   1.1  jruoho /*
    450   1.1  jruoho  * Set the D-state of an ACPI device node from a handle.
    451   1.1  jruoho  */
    452   1.1  jruoho bool
    453   1.1  jruoho acpi_power_set_from_handle(ACPI_HANDLE hdl, int state)
    454   1.1  jruoho {
    455   1.7  jruoho 	struct acpi_devnode *ad = acpi_get_node(hdl);
    456   1.1  jruoho 
    457   1.7  jruoho 	if (ad == NULL)
    458   1.1  jruoho 		return false;
    459   1.1  jruoho 
    460   1.7  jruoho 	return acpi_power_set(ad, state);
    461   1.1  jruoho }
    462   1.1  jruoho 
    463   1.1  jruoho static ACPI_STATUS
    464   1.1  jruoho acpi_power_switch(struct acpi_devnode *ad, int state, bool on)
    465   1.1  jruoho {
    466   1.1  jruoho 	ACPI_OBJECT *pkg;
    467   1.1  jruoho 	ACPI_STATUS rv;
    468   1.1  jruoho 
    469   1.1  jruoho 	pkg = acpi_power_pkg_get(ad->ad_handle, state);
    470   1.1  jruoho 
    471   1.1  jruoho 	if (pkg == NULL)
    472   1.1  jruoho 		return AE_NOT_EXIST;
    473   1.1  jruoho 
    474   1.1  jruoho 	if (on != false)
    475   1.1  jruoho 		rv = acpi_foreach_package_object(pkg, acpi_power_res_on, ad);
    476   1.1  jruoho 	else
    477   1.1  jruoho 		rv = acpi_foreach_package_object(pkg, acpi_power_res_off, ad);
    478   1.1  jruoho 
    479   1.1  jruoho 	ACPI_FREE(pkg);
    480   1.1  jruoho 
    481   1.1  jruoho 	return rv;
    482   1.1  jruoho }
    483   1.1  jruoho 
    484   1.1  jruoho static ACPI_STATUS
    485   1.1  jruoho acpi_power_res_on(ACPI_OBJECT *elm, void *arg)
    486   1.1  jruoho {
    487   1.1  jruoho 	struct acpi_devnode *ad = arg;
    488   1.1  jruoho 	struct acpi_power_res *res;
    489   1.1  jruoho 	ACPI_HANDLE hdl;
    490   1.1  jruoho 	ACPI_STATUS rv;
    491   1.1  jruoho 
    492   1.1  jruoho 	/*
    493   1.1  jruoho 	 * For each element in the _PRx package, first
    494   1.1  jruoho 	 * fetch the reference handle and then search
    495   1.1  jruoho 	 * for this handle from the power resource list.
    496   1.1  jruoho 	 */
    497   1.1  jruoho 	rv = acpi_eval_reference_handle(elm, &hdl);
    498   1.1  jruoho 
    499   1.1  jruoho 	if (ACPI_FAILURE(rv))
    500   1.1  jruoho 		return rv;
    501   1.1  jruoho 
    502   1.1  jruoho 	res = acpi_power_res_get(hdl);
    503   1.1  jruoho 
    504   1.1  jruoho 	if (res == NULL)
    505   1.1  jruoho 		return AE_NOT_FOUND;
    506   1.1  jruoho 
    507   1.1  jruoho 	/*
    508   1.1  jruoho 	 * Reference the resource.
    509   1.1  jruoho 	 */
    510   1.1  jruoho 	rv = acpi_power_res_ref(res, ad->ad_handle);
    511   1.1  jruoho 
    512   1.1  jruoho 	if (ACPI_FAILURE(rv))
    513   1.1  jruoho 		return rv;
    514   1.1  jruoho 
    515   1.1  jruoho 	/*
    516   1.1  jruoho 	 * Turn the resource on.
    517   1.1  jruoho 	 */
    518   1.1  jruoho 	return AcpiEvaluateObject(res->res_handle, "_ON", NULL, NULL);
    519   1.1  jruoho }
    520   1.1  jruoho 
    521   1.1  jruoho static ACPI_STATUS
    522   1.1  jruoho acpi_power_res_off(ACPI_OBJECT *elm, void *arg)
    523   1.1  jruoho {
    524   1.1  jruoho 	struct acpi_devnode *ad = arg;
    525   1.1  jruoho 	struct acpi_power_res *res;
    526   1.1  jruoho 	ACPI_HANDLE hdl;
    527   1.1  jruoho 	ACPI_STATUS rv;
    528   1.1  jruoho 
    529   1.1  jruoho 	rv = acpi_eval_reference_handle(elm, &hdl);
    530   1.1  jruoho 
    531   1.1  jruoho 	if (ACPI_FAILURE(rv))
    532   1.1  jruoho 		return rv;
    533   1.1  jruoho 
    534   1.1  jruoho 	res = acpi_power_res_get(hdl);
    535   1.1  jruoho 
    536   1.1  jruoho 	if (res == NULL)
    537   1.1  jruoho 		return AE_NOT_FOUND;
    538   1.1  jruoho 
    539   1.1  jruoho 	rv = acpi_power_res_deref(res, ad->ad_handle);
    540   1.1  jruoho 
    541   1.1  jruoho 	if (ACPI_FAILURE(rv))
    542   1.1  jruoho 		return rv;
    543   1.1  jruoho 
    544   1.1  jruoho 	return AcpiEvaluateObject(res->res_handle, "_OFF", NULL, NULL);
    545   1.1  jruoho }
    546   1.1  jruoho 
    547   1.1  jruoho static ACPI_STATUS
    548   1.1  jruoho acpi_power_res_ref(struct acpi_power_res *res, ACPI_HANDLE hdl)
    549   1.1  jruoho {
    550   1.1  jruoho 	struct acpi_power_ref *ref, *tmp;
    551   1.1  jruoho 
    552   1.1  jruoho 	ref = kmem_zalloc(sizeof(*ref), KM_SLEEP);
    553   1.1  jruoho 
    554   1.1  jruoho 	if (ref == NULL)
    555   1.1  jruoho 		return AE_NO_MEMORY;
    556   1.1  jruoho 
    557   1.1  jruoho 	mutex_enter(&res->res_mutex);
    558   1.1  jruoho 
    559   1.1  jruoho 	SIMPLEQ_FOREACH(tmp, &res->ref_head, ref_list) {
    560   1.1  jruoho 
    561   1.1  jruoho 		if (tmp->ref_handle == hdl)
    562   1.1  jruoho 			goto out;
    563   1.1  jruoho 	}
    564   1.1  jruoho 
    565   1.1  jruoho 	ref->ref_handle = hdl;
    566   1.1  jruoho 	SIMPLEQ_INSERT_TAIL(&res->ref_head, ref, ref_list);
    567   1.1  jruoho 	mutex_exit(&res->res_mutex);
    568   1.1  jruoho 
    569   1.8  jruoho 	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "%s referenced "
    570   1.8  jruoho 		"by %s?\n", res->res_name, acpi_xname(hdl)));
    571   1.1  jruoho 
    572   1.1  jruoho 	return AE_OK;
    573   1.1  jruoho 
    574   1.1  jruoho out:
    575   1.1  jruoho 	mutex_exit(&res->res_mutex);
    576   1.1  jruoho 	kmem_free(ref, sizeof(*ref));
    577   1.1  jruoho 
    578   1.8  jruoho 	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "%s already referenced "
    579   1.8  jruoho 		"by %s?\n", res->res_name, acpi_xname(hdl)));
    580   1.1  jruoho 
    581   1.1  jruoho 	return AE_OK;
    582   1.1  jruoho }
    583   1.1  jruoho 
    584   1.1  jruoho static ACPI_STATUS
    585   1.1  jruoho acpi_power_res_deref(struct acpi_power_res *res, ACPI_HANDLE hdl)
    586   1.1  jruoho {
    587   1.1  jruoho 	struct acpi_power_ref *ref;
    588   1.1  jruoho 
    589   1.1  jruoho 	mutex_enter(&res->res_mutex);
    590   1.1  jruoho 
    591   1.1  jruoho 	if (SIMPLEQ_EMPTY(&res->ref_head) != 0) {
    592   1.1  jruoho 		mutex_exit(&res->res_mutex);
    593   1.1  jruoho 		return AE_OK;
    594   1.1  jruoho 	}
    595   1.1  jruoho 
    596   1.1  jruoho 	SIMPLEQ_FOREACH(ref, &res->ref_head, ref_list) {
    597   1.1  jruoho 
    598   1.1  jruoho 		if (ref->ref_handle == hdl) {
    599   1.1  jruoho 			SIMPLEQ_REMOVE(&res->ref_head,
    600   1.1  jruoho 			    ref, acpi_power_ref, ref_list);
    601   1.1  jruoho 			mutex_exit(&res->res_mutex);
    602   1.1  jruoho 			kmem_free(ref, sizeof(*ref));
    603   1.1  jruoho 			mutex_enter(&res->res_mutex);
    604   1.1  jruoho 			break;
    605   1.1  jruoho 		}
    606   1.1  jruoho 	}
    607   1.1  jruoho 
    608   1.1  jruoho 	/*
    609   1.1  jruoho 	 * If the queue remains non-empty,
    610   1.1  jruoho 	 * something else is using the resource
    611   1.1  jruoho 	 * and hence it can not be turned off.
    612   1.1  jruoho 	 */
    613   1.1  jruoho 	if (SIMPLEQ_EMPTY(&res->ref_head) == 0) {
    614   1.1  jruoho 		mutex_exit(&res->res_mutex);
    615   1.1  jruoho 		return AE_ABORT_METHOD;
    616   1.1  jruoho 	}
    617   1.1  jruoho 
    618   1.1  jruoho 	mutex_exit(&res->res_mutex);
    619   1.1  jruoho 
    620   1.8  jruoho 	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "%s dereferenced "
    621   1.8  jruoho 		"by %s?\n", res->res_name, acpi_xname(hdl)));
    622   1.1  jruoho 
    623   1.1  jruoho 	return AE_OK;
    624   1.1  jruoho }
    625   1.1  jruoho 
    626   1.1  jruoho static ACPI_STATUS
    627   1.1  jruoho acpi_power_res_sta(ACPI_OBJECT *elm, void *arg)
    628   1.1  jruoho {
    629   1.1  jruoho 	ACPI_INTEGER val;
    630   1.1  jruoho 	ACPI_HANDLE hdl;
    631   1.1  jruoho 	ACPI_STATUS rv;
    632   1.1  jruoho 
    633   1.1  jruoho 	rv = acpi_eval_reference_handle(elm, &hdl);
    634   1.1  jruoho 
    635   1.1  jruoho 	if (ACPI_FAILURE(rv))
    636   1.1  jruoho 		goto fail;
    637   1.1  jruoho 
    638   1.1  jruoho 	rv = acpi_eval_integer(hdl, "_STA", &val);
    639   1.1  jruoho 
    640   1.1  jruoho 	if (ACPI_FAILURE(rv))
    641   1.1  jruoho 		goto fail;
    642   1.1  jruoho 
    643   1.1  jruoho 	KDASSERT((uint64_t)val < INT_MAX);
    644   1.1  jruoho 
    645   1.1  jruoho 	if ((int)val != ACPI_STA_POW_ON && (int)val != ACPI_STA_POW_OFF)
    646   1.1  jruoho 		return AE_BAD_VALUE;
    647   1.1  jruoho 
    648   1.1  jruoho 	if ((int)val != ACPI_STA_POW_ON)
    649   1.9  jruoho 		return AE_CTRL_FALSE;		/* XXX: Not an error. */
    650   1.1  jruoho 
    651   1.1  jruoho 	return AE_OK;
    652   1.1  jruoho 
    653   1.1  jruoho fail:
    654  1.10  jruoho 	if (rv == AE_CTRL_FALSE)
    655   1.1  jruoho 		rv = AE_ERROR;
    656   1.1  jruoho 
    657   1.8  jruoho 	ACPI_DEBUG_PRINT((ACPI_DB_DEBUG_OBJECT, "failed to evaluate _STA "
    658   1.8  jruoho 		"for %s: %s\n", acpi_xname(hdl), AcpiFormatException(rv)));
    659   1.1  jruoho 
    660   1.1  jruoho 	return rv;
    661   1.1  jruoho }
    662   1.1  jruoho 
    663   1.1  jruoho static ACPI_OBJECT *
    664   1.1  jruoho acpi_power_pkg_get(ACPI_HANDLE hdl, int state)
    665   1.1  jruoho {
    666   1.1  jruoho 	char path[5] = "_PR?";
    667   1.1  jruoho 	ACPI_OBJECT *obj;
    668   1.1  jruoho 	ACPI_BUFFER buf;
    669   1.1  jruoho 	ACPI_STATUS rv;
    670   1.1  jruoho 
    671   1.1  jruoho 	path[3] = '0' + state;
    672   1.1  jruoho 
    673   1.1  jruoho 	rv = acpi_eval_struct(hdl, path, &buf);
    674   1.1  jruoho 
    675   1.1  jruoho 	if (ACPI_FAILURE(rv))
    676   1.1  jruoho 		goto fail;
    677   1.1  jruoho 
    678   1.1  jruoho 	if (buf.Length == 0) {
    679   1.1  jruoho 		rv = AE_LIMIT;
    680   1.1  jruoho 		goto fail;
    681   1.1  jruoho 	}
    682   1.1  jruoho 
    683   1.1  jruoho 	obj = buf.Pointer;
    684   1.1  jruoho 
    685   1.1  jruoho 	if (obj->Type != ACPI_TYPE_PACKAGE) {
    686   1.1  jruoho 		rv = AE_TYPE;
    687   1.1  jruoho 		goto fail;
    688   1.1  jruoho 	}
    689   1.1  jruoho 
    690   1.1  jruoho 	if (obj->Package.Count == 0) {
    691   1.1  jruoho 		rv = AE_LIMIT;
    692   1.1  jruoho 		goto fail;
    693   1.1  jruoho 	}
    694   1.1  jruoho 
    695   1.1  jruoho 	return obj;
    696   1.1  jruoho 
    697   1.1  jruoho fail:
    698   1.1  jruoho 	if (buf.Pointer != NULL)
    699   1.1  jruoho 		ACPI_FREE(buf.Pointer);
    700   1.1  jruoho 
    701   1.8  jruoho 	ACPI_DEBUG_PRINT((ACPI_DB_DEBUG_OBJECT, "failed to evaluate %s for "
    702   1.8  jruoho 		"%s: %s\n", path, acpi_xname(hdl), AcpiFormatException(rv)));
    703   1.1  jruoho 
    704   1.1  jruoho 	return NULL;
    705   1.1  jruoho }
    706   1.1  jruoho 
    707   1.4  jruoho SYSCTL_SETUP(sysctl_acpi_power_setup, "sysctl hw.acpi.power subtree setup")
    708   1.4  jruoho {
    709   1.4  jruoho 	int err;
    710   1.4  jruoho 
    711   1.4  jruoho 	err = sysctl_createv(NULL, 0, NULL, &anode,
    712   1.4  jruoho 	    CTLFLAG_PERMANENT, CTLTYPE_NODE, "hw",
    713   1.4  jruoho 	    NULL, NULL, 0, NULL, 0,
    714   1.4  jruoho 	    CTL_HW, CTL_EOL);
    715   1.4  jruoho 
    716   1.4  jruoho 	if (err != 0)
    717   1.4  jruoho 		goto fail;
    718   1.4  jruoho 
    719   1.4  jruoho 	err = sysctl_createv(NULL, 0, &anode, &anode,
    720   1.4  jruoho 	    CTLFLAG_PERMANENT, CTLTYPE_NODE, "acpi",
    721   1.4  jruoho 	    NULL, NULL, 0, NULL, 0,
    722   1.4  jruoho 	    CTL_CREATE, CTL_EOL);
    723   1.4  jruoho 
    724   1.4  jruoho 	if (err != 0)
    725   1.4  jruoho 		goto fail;
    726   1.4  jruoho 
    727   1.4  jruoho 	err = sysctl_createv(NULL, 0, &anode, &anode,
    728   1.4  jruoho 	    CTLFLAG_PERMANENT, CTLTYPE_NODE,
    729   1.4  jruoho 	    "power", SYSCTL_DESCR("ACPI device power states"),
    730   1.4  jruoho 	    NULL, 0, NULL, 0,
    731   1.4  jruoho 	    CTL_CREATE, CTL_EOL);
    732   1.4  jruoho 
    733   1.4  jruoho 	if (err != 0)
    734   1.4  jruoho 		goto fail;
    735   1.4  jruoho 
    736   1.4  jruoho 	return;
    737   1.4  jruoho 
    738   1.4  jruoho fail:
    739   1.4  jruoho 	anode = NULL;
    740   1.4  jruoho }
    741   1.4  jruoho 
    742   1.4  jruoho void
    743   1.4  jruoho acpi_power_add(struct acpi_devnode *ad)
    744   1.4  jruoho {
    745   1.4  jruoho 	int err;
    746   1.4  jruoho 
    747   1.4  jruoho 	KASSERT(ad != NULL && ad->ad_root != NULL);
    748   1.4  jruoho 	KASSERT((ad->ad_flags & ACPI_DEVICE_POWER) != 0);
    749   1.4  jruoho 
    750   1.4  jruoho 	if (anode == NULL)
    751   1.4  jruoho 		return;
    752   1.4  jruoho 
    753   1.4  jruoho 	/*
    754   1.4  jruoho 	 * Make this read-only: because a single power resource
    755   1.4  jruoho 	 * may power multiple devices, it is unclear whether
    756   1.4  jruoho 	 * power resources should be controllable by an user.
    757   1.4  jruoho 	 */
    758   1.4  jruoho 	err = sysctl_createv(NULL, 0, &anode, NULL,
    759   1.4  jruoho 	    CTLFLAG_READONLY, CTLTYPE_STRING, ad->ad_name,
    760   1.5  jruoho 	    NULL, acpi_power_sysctl, 0, ad, 0,
    761   1.4  jruoho 	    CTL_CREATE, CTL_EOL);
    762   1.4  jruoho 
    763   1.4  jruoho 	if (err != 0)
    764   1.4  jruoho 		aprint_error_dev(ad->ad_root, "sysctl_createv"
    765   1.4  jruoho 		    "(hw.acpi.power.%s) failed (err %d)\n", ad->ad_name, err);
    766   1.4  jruoho }
    767   1.4  jruoho 
    768   1.4  jruoho static int
    769   1.4  jruoho acpi_power_sysctl(SYSCTLFN_ARGS)
    770   1.4  jruoho {
    771   1.5  jruoho 	struct acpi_devnode *ad;
    772   1.4  jruoho 	struct sysctlnode node;
    773   1.4  jruoho 	int err, state;
    774   1.4  jruoho 	char t[3];
    775   1.4  jruoho 
    776   1.4  jruoho 	node = *rnode;
    777   1.5  jruoho 	ad = rnode->sysctl_data;
    778   1.5  jruoho 
    779   1.5  jruoho 	if (acpi_power_get(ad, &state) != true)
    780   1.5  jruoho 		state = 0;
    781   1.4  jruoho 
    782   1.4  jruoho 	(void)memset(t, '\0', sizeof(t));
    783   1.4  jruoho 	(void)snprintf(t, sizeof(t), "D%d", state);
    784   1.4  jruoho 
    785   1.4  jruoho 	node.sysctl_data = &t;
    786   1.4  jruoho 
    787   1.4  jruoho 	err = sysctl_lookup(SYSCTLFN_CALL(&node));
    788   1.4  jruoho 
    789   1.4  jruoho 	if (err || newp == NULL)
    790   1.4  jruoho 		return err;
    791   1.4  jruoho 
    792   1.4  jruoho 	return 0;
    793   1.4  jruoho }
    794   1.4  jruoho 
    795   1.1  jruoho /*
    796   1.1  jruoho  * XXX: Move this to acpi_util.c by refactoring
    797   1.1  jruoho  *	acpi_name() to optionally return a single name.
    798   1.1  jruoho  */
    799   1.1  jruoho static const char *
    800   1.1  jruoho acpi_xname(ACPI_HANDLE hdl)
    801   1.1  jruoho {
    802   1.1  jruoho 	static char str[5];
    803   1.1  jruoho 	ACPI_BUFFER buf;
    804   1.1  jruoho 	ACPI_STATUS rv;
    805   1.1  jruoho 
    806   1.1  jruoho 	buf.Pointer = str;
    807   1.1  jruoho 	buf.Length = sizeof(str);
    808   1.1  jruoho 
    809   1.1  jruoho 	rv = AcpiGetName(hdl, ACPI_SINGLE_NAME, &buf);
    810   1.1  jruoho 
    811   1.1  jruoho 	if (ACPI_FAILURE(rv))
    812   1.1  jruoho 		return "????";
    813   1.1  jruoho 
    814   1.1  jruoho 	return str;
    815   1.1  jruoho }
    816