Home | History | Annotate | Line # | Download | only in acpi
acpi_power.c revision 1.26
      1  1.26  jruoho /* $NetBSD: acpi_power.c,v 1.26 2011/01/06 18:57:22 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.26  jruoho __KERNEL_RCSID(0, "$NetBSD: acpi_power.c,v 1.26 2011/01/06 18:57:22 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.24  jruoho #include <dev/acpi/acpi_pci.h>
     69   1.1  jruoho #include <dev/acpi/acpi_power.h>
     70   1.1  jruoho 
     71   1.1  jruoho #define _COMPONENT			ACPI_BUS_COMPONENT
     72   1.1  jruoho ACPI_MODULE_NAME			("acpi_power")
     73   1.1  jruoho 
     74  1.11  jruoho #define	ACPI_STA_POW_OFF		0x00
     75  1.11  jruoho #define	ACPI_STA_POW_ON			0x01
     76  1.11  jruoho 
     77   1.1  jruoho /*
     78   1.1  jruoho  * References.
     79   1.1  jruoho  */
     80   1.1  jruoho struct acpi_power_ref {
     81   1.1  jruoho 	ACPI_HANDLE			ref_handle;
     82   1.1  jruoho 
     83   1.1  jruoho 	SIMPLEQ_ENTRY(acpi_power_ref)	ref_list;
     84   1.1  jruoho };
     85   1.1  jruoho 
     86   1.1  jruoho /*
     87   1.1  jruoho  * Resources.
     88   1.1  jruoho  */
     89   1.1  jruoho struct acpi_power_res {
     90   1.1  jruoho 	ACPI_HANDLE			res_handle;
     91   1.1  jruoho 	ACPI_INTEGER			res_level;
     92   1.1  jruoho 	ACPI_INTEGER			res_order;
     93   1.1  jruoho 	char				res_name[5];
     94   1.1  jruoho 	kmutex_t			res_mutex;
     95   1.1  jruoho 
     96   1.1  jruoho 	TAILQ_ENTRY(acpi_power_res)	res_list;
     97   1.1  jruoho 	SIMPLEQ_HEAD(, acpi_power_ref)	ref_head;
     98   1.1  jruoho };
     99   1.1  jruoho 
    100   1.1  jruoho static TAILQ_HEAD(, acpi_power_res) res_head =
    101   1.1  jruoho 	TAILQ_HEAD_INITIALIZER(res_head);
    102   1.1  jruoho 
    103  1.23  gsutre static int32_t acpi_power_acpinode = CTL_EOL;
    104  1.23  gsutre static int32_t acpi_power_powernode = CTL_EOL;
    105   1.4  jruoho 
    106   1.1  jruoho static struct acpi_power_res	*acpi_power_res_init(ACPI_HANDLE);
    107   1.1  jruoho static struct acpi_power_res	*acpi_power_res_get(ACPI_HANDLE);
    108   1.1  jruoho 
    109   1.1  jruoho static ACPI_STATUS	 acpi_power_get_direct(struct acpi_devnode *);
    110   1.1  jruoho static ACPI_STATUS	 acpi_power_get_indirect(struct acpi_devnode *);
    111   1.1  jruoho static ACPI_STATUS	 acpi_power_switch(struct acpi_devnode *,
    112   1.1  jruoho 						   int, bool);
    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.22  jruoho static int		 acpi_power_sysctl(SYSCTLFN_PROTO);
    121   1.1  jruoho static const char	*acpi_xname(ACPI_HANDLE);
    122   1.1  jruoho 
    123   1.1  jruoho static struct acpi_power_res *
    124   1.1  jruoho acpi_power_res_init(ACPI_HANDLE hdl)
    125   1.1  jruoho {
    126   1.1  jruoho 	struct acpi_power_res *tmp = NULL;
    127   1.1  jruoho 	struct acpi_power_res *res = NULL;
    128   1.1  jruoho 	ACPI_OBJECT *obj;
    129   1.1  jruoho 	ACPI_BUFFER buf;
    130   1.1  jruoho 	ACPI_STATUS rv;
    131   1.1  jruoho 
    132   1.1  jruoho 	rv = acpi_eval_struct(hdl, NULL, &buf);
    133   1.1  jruoho 
    134   1.1  jruoho 	if (ACPI_FAILURE(rv))
    135   1.1  jruoho 		goto out;
    136   1.1  jruoho 
    137   1.1  jruoho 	obj = buf.Pointer;
    138   1.1  jruoho 
    139   1.1  jruoho 	if (obj->Type != ACPI_TYPE_POWER) {
    140   1.1  jruoho 		rv = AE_TYPE;
    141   1.1  jruoho 		goto out;
    142   1.1  jruoho 	}
    143   1.1  jruoho 
    144   1.1  jruoho 	res = kmem_zalloc(sizeof(*res), KM_SLEEP);
    145   1.1  jruoho 
    146   1.1  jruoho 	if (res == NULL) {
    147   1.1  jruoho 		rv = AE_NO_MEMORY;
    148   1.1  jruoho 		goto out;
    149   1.1  jruoho 	}
    150   1.1  jruoho 
    151   1.1  jruoho 	res->res_handle = hdl;
    152   1.1  jruoho 	res->res_level = obj->PowerResource.SystemLevel;
    153   1.1  jruoho 	res->res_order = obj->PowerResource.ResourceOrder;
    154   1.1  jruoho 
    155   1.1  jruoho 	(void)strlcpy(res->res_name,
    156   1.1  jruoho 	    acpi_xname(hdl), sizeof(res->res_name));
    157   1.1  jruoho 
    158   1.1  jruoho 	SIMPLEQ_INIT(&res->ref_head);
    159   1.1  jruoho 	mutex_init(&res->res_mutex, MUTEX_DEFAULT, IPL_NONE);
    160   1.1  jruoho 
    161   1.1  jruoho 	/*
    162   1.1  jruoho 	 * Power resources should be ordered.
    163   1.1  jruoho 	 *
    164   1.1  jruoho 	 * These *should* be enabled from low values to high
    165   1.1  jruoho 	 * values and disabled from high values to low values.
    166   1.1  jruoho 	 */
    167   1.1  jruoho 	TAILQ_FOREACH(tmp, &res_head, res_list) {
    168   1.1  jruoho 
    169   1.1  jruoho 		if (res->res_order < tmp->res_order) {
    170   1.1  jruoho 			TAILQ_INSERT_BEFORE(tmp, res, res_list);
    171   1.1  jruoho 			break;
    172   1.1  jruoho 		}
    173   1.1  jruoho 	}
    174   1.1  jruoho 
    175   1.1  jruoho 	if (tmp == NULL)
    176   1.1  jruoho 		TAILQ_INSERT_TAIL(&res_head, res, res_list);
    177   1.1  jruoho 
    178  1.15  jruoho 	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "%s added to the "
    179  1.15  jruoho 		"power resource queue\n", res->res_name));
    180  1.15  jruoho 
    181   1.1  jruoho out:
    182   1.1  jruoho 	if (buf.Pointer != NULL)
    183   1.1  jruoho 		ACPI_FREE(buf.Pointer);
    184   1.1  jruoho 
    185   1.1  jruoho 	return res;
    186   1.1  jruoho }
    187   1.1  jruoho 
    188   1.1  jruoho static struct acpi_power_res *
    189   1.1  jruoho acpi_power_res_get(ACPI_HANDLE hdl)
    190   1.1  jruoho {
    191   1.1  jruoho 	struct acpi_power_res *res;
    192   1.1  jruoho 
    193   1.1  jruoho 	TAILQ_FOREACH(res, &res_head, res_list) {
    194   1.1  jruoho 
    195   1.1  jruoho 		if (res->res_handle == hdl)
    196   1.1  jruoho 			return res;
    197   1.1  jruoho 	}
    198   1.1  jruoho 
    199   1.1  jruoho 	return acpi_power_res_init(hdl);
    200   1.1  jruoho }
    201   1.1  jruoho 
    202   1.1  jruoho bool
    203  1.17  jruoho acpi_power_register(ACPI_HANDLE hdl)
    204   1.1  jruoho {
    205  1.17  jruoho 	struct acpi_devnode *ad = acpi_get_node(hdl);
    206   1.1  jruoho 
    207  1.17  jruoho 	if (ad == NULL)
    208  1.17  jruoho 		return false;
    209   1.1  jruoho 
    210   1.1  jruoho 	if ((ad->ad_flags & ACPI_DEVICE_POWER) == 0)
    211   1.1  jruoho 		return false;
    212   1.1  jruoho 
    213   1.1  jruoho 	return true;
    214   1.1  jruoho }
    215   1.1  jruoho 
    216   1.1  jruoho void
    217  1.17  jruoho acpi_power_deregister(ACPI_HANDLE hdl)
    218   1.1  jruoho {
    219  1.17  jruoho 	struct acpi_devnode *ad = acpi_get_node(hdl);
    220   1.1  jruoho 	struct acpi_power_res *res;
    221   1.1  jruoho 
    222  1.17  jruoho 	if (ad == NULL)
    223  1.17  jruoho 		return;
    224   1.1  jruoho 
    225   1.1  jruoho 	if ((ad->ad_flags & ACPI_DEVICE_POWER) == 0)
    226   1.1  jruoho 		return;
    227   1.1  jruoho 
    228   1.1  jruoho 	/*
    229   1.1  jruoho 	 * Remove all references in each resource.
    230   1.1  jruoho 	 */
    231   1.1  jruoho 	TAILQ_FOREACH(res, &res_head, res_list)
    232   1.1  jruoho 	    (void)acpi_power_res_deref(res, ad->ad_handle);
    233   1.1  jruoho }
    234   1.1  jruoho 
    235   1.1  jruoho /*
    236   1.1  jruoho  * Get the D-state of an ACPI device node.
    237   1.1  jruoho  */
    238   1.1  jruoho bool
    239  1.17  jruoho acpi_power_get(ACPI_HANDLE hdl, int *state)
    240   1.1  jruoho {
    241  1.17  jruoho 	struct acpi_devnode *ad = acpi_get_node(hdl);
    242   1.1  jruoho 	ACPI_STATUS rv;
    243   1.1  jruoho 
    244  1.17  jruoho 	if (ad == NULL)
    245  1.17  jruoho 		return false;
    246  1.17  jruoho 
    247   1.1  jruoho 	if ((ad->ad_flags & ACPI_DEVICE_POWER) == 0) {
    248   1.1  jruoho 		rv = AE_SUPPORT;
    249   1.1  jruoho 		goto fail;
    250   1.1  jruoho 	}
    251   1.1  jruoho 
    252  1.12  jruoho 	/*
    253  1.26  jruoho 	 * As _PSC may be broken, first try to
    254  1.26  jruoho 	 * retrieve the power state indirectly
    255  1.26  jruoho 	 * via power resources.
    256  1.12  jruoho 	 */
    257   1.1  jruoho 	rv = acpi_power_get_indirect(ad);
    258   1.1  jruoho 
    259   1.1  jruoho 	if (ACPI_FAILURE(rv))
    260  1.12  jruoho 		rv = acpi_power_get_direct(ad);
    261  1.12  jruoho 
    262  1.12  jruoho 	if (ACPI_FAILURE(rv))
    263   1.1  jruoho 		goto fail;
    264   1.1  jruoho 
    265   1.1  jruoho 	KASSERT(ad->ad_state != ACPI_STATE_ERROR);
    266   1.1  jruoho 
    267   1.1  jruoho 	if (ad->ad_state < ACPI_STATE_D0 || ad->ad_state > ACPI_STATE_D3) {
    268   1.1  jruoho 		rv = AE_BAD_VALUE;
    269   1.1  jruoho 		goto fail;
    270   1.1  jruoho 	}
    271   1.1  jruoho 
    272   1.1  jruoho 	if (state != NULL)
    273   1.1  jruoho 		*state = ad->ad_state;
    274   1.1  jruoho 
    275   1.1  jruoho 	return true;
    276   1.1  jruoho 
    277   1.1  jruoho fail:
    278   1.1  jruoho 	ad->ad_state = ACPI_STATE_ERROR;
    279   1.1  jruoho 
    280   1.1  jruoho 	if (state != NULL)
    281   1.1  jruoho 		*state = ad->ad_state;
    282   1.1  jruoho 
    283   1.1  jruoho 	aprint_error_dev(ad->ad_root, "failed to get power state "
    284   1.1  jruoho 	    "for %s: %s\n", ad->ad_name, AcpiFormatException(rv));
    285   1.1  jruoho 
    286   1.1  jruoho 	return false;
    287   1.1  jruoho }
    288   1.1  jruoho 
    289   1.1  jruoho static ACPI_STATUS
    290   1.1  jruoho acpi_power_get_direct(struct acpi_devnode *ad)
    291   1.1  jruoho {
    292   1.1  jruoho 	ACPI_INTEGER val = 0;
    293   1.1  jruoho 	ACPI_STATUS rv;
    294   1.1  jruoho 
    295   1.1  jruoho 	rv = acpi_eval_integer(ad->ad_handle, "_PSC", &val);
    296   1.1  jruoho 
    297   1.1  jruoho 	KDASSERT((uint64_t)val < INT_MAX);
    298   1.1  jruoho 
    299   1.1  jruoho 	ad->ad_state = (int)val;
    300   1.1  jruoho 
    301   1.1  jruoho 	return rv;
    302   1.1  jruoho }
    303   1.1  jruoho 
    304   1.1  jruoho static ACPI_STATUS
    305   1.1  jruoho acpi_power_get_indirect(struct acpi_devnode *ad)
    306   1.1  jruoho {
    307   1.1  jruoho 	ACPI_OBJECT *pkg;
    308   1.1  jruoho 	ACPI_STATUS rv;
    309   1.1  jruoho 	int i;
    310   1.1  jruoho 
    311   1.1  jruoho 	CTASSERT(ACPI_STATE_D0 == 0 && ACPI_STATE_D1 == 1);
    312   1.1  jruoho 	CTASSERT(ACPI_STATE_D2 == 2 && ACPI_STATE_D3 == 3);
    313   1.1  jruoho 
    314   1.1  jruoho 	/*
    315   1.1  jruoho 	 * The device is in a given D-state if all resources are on.
    316   1.1  jruoho 	 * To derive this, evaluate all elements in each _PRx package
    317   1.1  jruoho 	 * (x = 0 ... 3) and break if the noted condition becomes true.
    318   1.1  jruoho 	 */
    319   1.1  jruoho 	for (ad->ad_state = ACPI_STATE_D3, i = 0; i < ACPI_STATE_D3; i++) {
    320   1.1  jruoho 
    321   1.1  jruoho 		pkg = acpi_power_pkg_get(ad->ad_handle, i);
    322   1.1  jruoho 
    323   1.1  jruoho 		if (pkg == NULL)
    324   1.1  jruoho 			continue;
    325   1.1  jruoho 
    326   1.1  jruoho 		/*
    327   1.1  jruoho 		 * For each element in the _PRx package, evaluate _STA
    328   1.1  jruoho 		 * and return AE_OK only if all power resources are on.
    329   1.1  jruoho 		 */
    330   1.1  jruoho 		rv = acpi_foreach_package_object(pkg, acpi_power_res_sta, ad);
    331   1.1  jruoho 
    332   1.9  jruoho 		if (ACPI_FAILURE(rv) && rv != AE_CTRL_FALSE)
    333   1.1  jruoho 			goto out;
    334   1.1  jruoho 
    335   1.1  jruoho 		if (ACPI_SUCCESS(rv)) {
    336   1.1  jruoho 			ad->ad_state = i;
    337   1.1  jruoho 			goto out;
    338   1.1  jruoho 		}
    339   1.1  jruoho 
    340   1.1  jruoho 		ACPI_FREE(pkg); pkg = NULL;
    341   1.1  jruoho 	}
    342   1.1  jruoho 
    343   1.1  jruoho 	KASSERT(ad->ad_state == ACPI_STATE_D3);
    344   1.1  jruoho 
    345   1.1  jruoho 	return AE_OK;
    346   1.1  jruoho 
    347   1.1  jruoho out:
    348   1.1  jruoho 	ACPI_FREE(pkg);
    349   1.1  jruoho 
    350   1.1  jruoho 	return rv;
    351   1.1  jruoho }
    352   1.1  jruoho 
    353   1.1  jruoho /*
    354   1.1  jruoho  * Set the D-state of an ACPI device node.
    355   1.1  jruoho  */
    356   1.1  jruoho bool
    357  1.17  jruoho acpi_power_set(ACPI_HANDLE hdl, int state)
    358   1.1  jruoho {
    359  1.17  jruoho 	struct acpi_devnode *ad = acpi_get_node(hdl);
    360   1.1  jruoho 	ACPI_STATUS rv;
    361   1.1  jruoho 	char path[5];
    362   1.1  jruoho 	int old;
    363   1.1  jruoho 
    364  1.17  jruoho 	if (ad == NULL)
    365  1.17  jruoho 		return false;
    366   1.1  jruoho 
    367  1.13  jruoho 	if ((ad->ad_flags & ACPI_DEVICE_POWER) == 0) {
    368  1.14  jruoho 		rv = AE_SUPPORT;
    369  1.14  jruoho 		goto fail;
    370  1.13  jruoho 	}
    371  1.13  jruoho 
    372   1.1  jruoho 	if (state < ACPI_STATE_D0 || state > ACPI_STATE_D3) {
    373   1.1  jruoho 		rv = AE_BAD_PARAMETER;
    374   1.1  jruoho 		goto fail;
    375   1.1  jruoho 	}
    376   1.1  jruoho 
    377  1.21  jruoho 	if (acpi_power_get(ad->ad_handle, &old) != true) {
    378   1.1  jruoho 		rv = AE_NOT_FOUND;
    379   1.1  jruoho 		goto fail;
    380   1.1  jruoho 	}
    381   1.1  jruoho 
    382   1.1  jruoho 	KASSERT(ad->ad_state == old);
    383   1.1  jruoho 	KASSERT(ad->ad_state != ACPI_STATE_ERROR);
    384   1.1  jruoho 
    385   1.1  jruoho 	if (ad->ad_state == state) {
    386   1.1  jruoho 		rv = AE_ALREADY_EXISTS;
    387   1.1  jruoho 		goto fail;
    388   1.1  jruoho 	}
    389   1.1  jruoho 
    390   1.1  jruoho 	/*
    391   1.1  jruoho 	 * It is only possible to go to D0 ("on") from D3 ("off").
    392   1.1  jruoho 	 */
    393   1.1  jruoho 	if (ad->ad_state == ACPI_STATE_D3 && state != ACPI_STATE_D0) {
    394   1.1  jruoho 		rv = AE_BAD_PARAMETER;
    395   1.1  jruoho 		goto fail;
    396   1.1  jruoho 	}
    397   1.1  jruoho 
    398   1.1  jruoho 	/*
    399  1.18  jruoho 	 * As noted in ACPI 4.0 (appendix A.2.1), the bus power state
    400  1.18  jruoho 	 * should never be lower than the highest state of one of its
    401  1.18  jruoho 	 * devices. Consequently, we cannot set the state to a lower
    402  1.18  jruoho 	 * (i.e. higher power) state than the parent device's state.
    403  1.18  jruoho 	 */
    404  1.20  jruoho 	if ((ad->ad_parent != NULL) &&
    405  1.20  jruoho 	    (ad->ad_parent->ad_flags & ACPI_DEVICE_POWER) != 0) {
    406  1.20  jruoho 
    407  1.20  jruoho 		if (ad->ad_parent->ad_state > state) {
    408  1.20  jruoho 			rv = AE_ABORT_METHOD;
    409  1.20  jruoho 			goto fail;
    410  1.20  jruoho 		}
    411  1.18  jruoho 	}
    412  1.18  jruoho 
    413  1.18  jruoho 	/*
    414  1.12  jruoho 	 * We first sweep through the resources required for the target
    415  1.12  jruoho 	 * state, turning things on and building references. After this
    416  1.12  jruoho 	 * we dereference the resources required for the current state,
    417   1.1  jruoho 	 * turning the resources off as we go.
    418   1.1  jruoho 	 */
    419   1.1  jruoho 	rv = acpi_power_switch(ad, state, true);
    420   1.1  jruoho 
    421  1.12  jruoho 	if (ACPI_FAILURE(rv) && rv != AE_CTRL_CONTINUE)
    422   1.1  jruoho 		goto fail;
    423   1.1  jruoho 
    424   1.1  jruoho 	rv = acpi_power_switch(ad, ad->ad_state, false);
    425   1.1  jruoho 
    426  1.12  jruoho 	if (ACPI_FAILURE(rv) && rv != AE_CTRL_CONTINUE)
    427   1.1  jruoho 		goto fail;
    428   1.1  jruoho 
    429   1.1  jruoho 	/*
    430  1.12  jruoho 	 * Last but not least, invoke the power state switch method,
    431  1.12  jruoho 	 * if available. Because some systems use only _PSx for the
    432  1.12  jruoho 	 * power state transitions, we do this even if there is no _PRx.
    433   1.1  jruoho 	 */
    434   1.1  jruoho 	(void)snprintf(path, sizeof(path), "_PS%d", state);
    435   1.1  jruoho 	(void)AcpiEvaluateObject(ad->ad_handle, path, NULL, NULL);
    436   1.1  jruoho 
    437  1.18  jruoho 	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "%s turned from "
    438  1.18  jruoho 		"D%d to D%d\n", ad->ad_name, old, state));
    439   1.1  jruoho 
    440  1.12  jruoho 	ad->ad_state = state;
    441  1.12  jruoho 
    442   1.1  jruoho 	return true;
    443   1.1  jruoho 
    444   1.1  jruoho fail:
    445   1.2  jruoho 	ad->ad_state = ACPI_STATE_ERROR;
    446   1.1  jruoho 
    447  1.14  jruoho 	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "failed to set power state to D%d "
    448  1.14  jruoho 		"for %s: %s\n", state, ad->ad_name, AcpiFormatException(rv)));
    449   1.1  jruoho 
    450   1.2  jruoho 	return false;
    451   1.1  jruoho }
    452   1.1  jruoho 
    453   1.1  jruoho static ACPI_STATUS
    454   1.1  jruoho acpi_power_switch(struct acpi_devnode *ad, int state, bool on)
    455   1.1  jruoho {
    456  1.16  jruoho 	ACPI_OBJECT *elm, *pkg;
    457  1.16  jruoho 	ACPI_STATUS rv = AE_OK;
    458  1.16  jruoho 	ACPI_HANDLE hdl;
    459  1.16  jruoho 	uint32_t i, n;
    460   1.1  jruoho 
    461  1.16  jruoho 	/*
    462  1.16  jruoho 	 * For each element in the _PRx package, fetch
    463  1.16  jruoho 	 * the reference handle, search for this handle
    464  1.16  jruoho 	 * from the power resource queue, and turn the
    465  1.16  jruoho 	 * resource behind the handle on or off.
    466  1.16  jruoho 	 */
    467   1.1  jruoho 	pkg = acpi_power_pkg_get(ad->ad_handle, state);
    468   1.1  jruoho 
    469   1.1  jruoho 	if (pkg == NULL)
    470  1.12  jruoho 		return AE_CTRL_CONTINUE;
    471   1.1  jruoho 
    472  1.16  jruoho 	n = pkg->Package.Count;
    473  1.16  jruoho 
    474  1.16  jruoho 	for (i = 0; i < n; i++) {
    475   1.1  jruoho 
    476  1.16  jruoho 		elm = &pkg->Package.Elements[i];
    477  1.16  jruoho 		rv = acpi_eval_reference_handle(elm, &hdl);
    478  1.16  jruoho 
    479  1.16  jruoho 		if (ACPI_FAILURE(rv))
    480  1.16  jruoho 			continue;
    481  1.16  jruoho 
    482  1.16  jruoho 		(void)acpi_power_res(hdl, ad->ad_handle, on);
    483  1.16  jruoho 	}
    484  1.12  jruoho 
    485   1.1  jruoho 	ACPI_FREE(pkg);
    486   1.1  jruoho 
    487   1.1  jruoho 	return rv;
    488   1.1  jruoho }
    489   1.1  jruoho 
    490  1.16  jruoho ACPI_STATUS
    491  1.16  jruoho acpi_power_res(ACPI_HANDLE hdl, ACPI_HANDLE ref, bool on)
    492   1.1  jruoho {
    493   1.1  jruoho 	struct acpi_power_res *res;
    494  1.16  jruoho 	const char *str;
    495   1.1  jruoho 	ACPI_STATUS rv;
    496   1.1  jruoho 
    497   1.1  jruoho 	/*
    498  1.16  jruoho 	 * Search for the resource.
    499   1.1  jruoho 	 */
    500   1.1  jruoho 	res = acpi_power_res_get(hdl);
    501   1.1  jruoho 
    502   1.1  jruoho 	if (res == NULL)
    503   1.1  jruoho 		return AE_NOT_FOUND;
    504   1.1  jruoho 
    505   1.1  jruoho 	/*
    506  1.16  jruoho 	 * (De)reference the resource.
    507   1.1  jruoho 	 */
    508  1.16  jruoho 	switch (on) {
    509  1.16  jruoho 
    510  1.16  jruoho 	case true:
    511  1.16  jruoho 		rv = acpi_power_res_ref(res, ref);
    512  1.16  jruoho 		str = "_ON";
    513  1.16  jruoho 		break;
    514  1.16  jruoho 
    515  1.16  jruoho 	case false:
    516  1.16  jruoho 		rv = acpi_power_res_deref(res, ref);
    517  1.16  jruoho 		str = "_OFF";
    518  1.16  jruoho 		break;
    519  1.16  jruoho 
    520  1.16  jruoho 	default:
    521  1.16  jruoho 		return AE_BAD_PARAMETER;
    522  1.16  jruoho 	}
    523   1.1  jruoho 
    524   1.1  jruoho 	if (ACPI_FAILURE(rv))
    525   1.1  jruoho 		return rv;
    526   1.1  jruoho 
    527   1.1  jruoho 	/*
    528  1.16  jruoho 	 * Turn the resource on or off.
    529   1.1  jruoho 	 */
    530  1.16  jruoho 	return AcpiEvaluateObject(res->res_handle, str, NULL, NULL);
    531   1.1  jruoho }
    532   1.1  jruoho 
    533   1.1  jruoho static ACPI_STATUS
    534   1.1  jruoho acpi_power_res_ref(struct acpi_power_res *res, ACPI_HANDLE hdl)
    535   1.1  jruoho {
    536   1.1  jruoho 	struct acpi_power_ref *ref, *tmp;
    537   1.1  jruoho 
    538   1.1  jruoho 	ref = kmem_zalloc(sizeof(*ref), KM_SLEEP);
    539   1.1  jruoho 
    540   1.1  jruoho 	if (ref == NULL)
    541   1.1  jruoho 		return AE_NO_MEMORY;
    542   1.1  jruoho 
    543   1.1  jruoho 	mutex_enter(&res->res_mutex);
    544   1.1  jruoho 
    545   1.1  jruoho 	SIMPLEQ_FOREACH(tmp, &res->ref_head, ref_list) {
    546   1.1  jruoho 
    547   1.1  jruoho 		if (tmp->ref_handle == hdl)
    548   1.1  jruoho 			goto out;
    549   1.1  jruoho 	}
    550   1.1  jruoho 
    551   1.1  jruoho 	ref->ref_handle = hdl;
    552   1.1  jruoho 	SIMPLEQ_INSERT_TAIL(&res->ref_head, ref, ref_list);
    553   1.1  jruoho 	mutex_exit(&res->res_mutex);
    554   1.1  jruoho 
    555   1.8  jruoho 	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "%s referenced "
    556  1.19  jruoho 		"by %s\n", res->res_name, acpi_xname(hdl)));
    557   1.1  jruoho 
    558   1.1  jruoho 	return AE_OK;
    559   1.1  jruoho 
    560   1.1  jruoho out:
    561   1.1  jruoho 	mutex_exit(&res->res_mutex);
    562   1.1  jruoho 	kmem_free(ref, sizeof(*ref));
    563   1.1  jruoho 
    564   1.8  jruoho 	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "%s already referenced "
    565   1.8  jruoho 		"by %s?\n", res->res_name, acpi_xname(hdl)));
    566   1.1  jruoho 
    567   1.1  jruoho 	return AE_OK;
    568   1.1  jruoho }
    569   1.1  jruoho 
    570   1.1  jruoho static ACPI_STATUS
    571   1.1  jruoho acpi_power_res_deref(struct acpi_power_res *res, ACPI_HANDLE hdl)
    572   1.1  jruoho {
    573   1.1  jruoho 	struct acpi_power_ref *ref;
    574   1.1  jruoho 
    575   1.1  jruoho 	mutex_enter(&res->res_mutex);
    576   1.1  jruoho 
    577   1.1  jruoho 	if (SIMPLEQ_EMPTY(&res->ref_head) != 0) {
    578   1.1  jruoho 		mutex_exit(&res->res_mutex);
    579   1.1  jruoho 		return AE_OK;
    580   1.1  jruoho 	}
    581   1.1  jruoho 
    582   1.1  jruoho 	SIMPLEQ_FOREACH(ref, &res->ref_head, ref_list) {
    583   1.1  jruoho 
    584   1.1  jruoho 		if (ref->ref_handle == hdl) {
    585   1.1  jruoho 			SIMPLEQ_REMOVE(&res->ref_head,
    586   1.1  jruoho 			    ref, acpi_power_ref, ref_list);
    587   1.1  jruoho 			mutex_exit(&res->res_mutex);
    588   1.1  jruoho 			kmem_free(ref, sizeof(*ref));
    589   1.1  jruoho 			mutex_enter(&res->res_mutex);
    590   1.1  jruoho 			break;
    591   1.1  jruoho 		}
    592   1.1  jruoho 	}
    593   1.1  jruoho 
    594   1.1  jruoho 	/*
    595   1.1  jruoho 	 * If the queue remains non-empty,
    596   1.1  jruoho 	 * something else is using the resource
    597   1.1  jruoho 	 * and hence it can not be turned off.
    598   1.1  jruoho 	 */
    599   1.1  jruoho 	if (SIMPLEQ_EMPTY(&res->ref_head) == 0) {
    600   1.1  jruoho 		mutex_exit(&res->res_mutex);
    601   1.1  jruoho 		return AE_ABORT_METHOD;
    602   1.1  jruoho 	}
    603   1.1  jruoho 
    604   1.1  jruoho 	mutex_exit(&res->res_mutex);
    605   1.1  jruoho 
    606   1.8  jruoho 	ACPI_DEBUG_PRINT((ACPI_DB_INFO, "%s dereferenced "
    607  1.19  jruoho 		"by %s\n", res->res_name, acpi_xname(hdl)));
    608   1.1  jruoho 
    609   1.1  jruoho 	return AE_OK;
    610   1.1  jruoho }
    611   1.1  jruoho 
    612   1.1  jruoho static ACPI_STATUS
    613   1.1  jruoho acpi_power_res_sta(ACPI_OBJECT *elm, void *arg)
    614   1.1  jruoho {
    615   1.1  jruoho 	ACPI_INTEGER val;
    616   1.1  jruoho 	ACPI_HANDLE hdl;
    617   1.1  jruoho 	ACPI_STATUS rv;
    618   1.1  jruoho 
    619   1.1  jruoho 	rv = acpi_eval_reference_handle(elm, &hdl);
    620   1.1  jruoho 
    621   1.1  jruoho 	if (ACPI_FAILURE(rv))
    622   1.1  jruoho 		goto fail;
    623   1.1  jruoho 
    624   1.1  jruoho 	rv = acpi_eval_integer(hdl, "_STA", &val);
    625   1.1  jruoho 
    626   1.1  jruoho 	if (ACPI_FAILURE(rv))
    627   1.1  jruoho 		goto fail;
    628   1.1  jruoho 
    629   1.1  jruoho 	KDASSERT((uint64_t)val < INT_MAX);
    630   1.1  jruoho 
    631   1.1  jruoho 	if ((int)val != ACPI_STA_POW_ON && (int)val != ACPI_STA_POW_OFF)
    632   1.1  jruoho 		return AE_BAD_VALUE;
    633   1.1  jruoho 
    634   1.1  jruoho 	if ((int)val != ACPI_STA_POW_ON)
    635   1.9  jruoho 		return AE_CTRL_FALSE;		/* XXX: Not an error. */
    636   1.1  jruoho 
    637   1.1  jruoho 	return AE_OK;
    638   1.1  jruoho 
    639   1.1  jruoho fail:
    640  1.10  jruoho 	if (rv == AE_CTRL_FALSE)
    641   1.1  jruoho 		rv = AE_ERROR;
    642   1.1  jruoho 
    643   1.8  jruoho 	ACPI_DEBUG_PRINT((ACPI_DB_DEBUG_OBJECT, "failed to evaluate _STA "
    644   1.8  jruoho 		"for %s: %s\n", acpi_xname(hdl), AcpiFormatException(rv)));
    645   1.1  jruoho 
    646   1.1  jruoho 	return rv;
    647   1.1  jruoho }
    648   1.1  jruoho 
    649   1.1  jruoho static ACPI_OBJECT *
    650   1.1  jruoho acpi_power_pkg_get(ACPI_HANDLE hdl, int state)
    651   1.1  jruoho {
    652   1.1  jruoho 	char path[5] = "_PR?";
    653   1.1  jruoho 	ACPI_OBJECT *obj;
    654   1.1  jruoho 	ACPI_BUFFER buf;
    655   1.1  jruoho 	ACPI_STATUS rv;
    656   1.1  jruoho 
    657   1.1  jruoho 	path[3] = '0' + state;
    658   1.1  jruoho 
    659   1.1  jruoho 	rv = acpi_eval_struct(hdl, path, &buf);
    660   1.1  jruoho 
    661   1.1  jruoho 	if (ACPI_FAILURE(rv))
    662   1.1  jruoho 		goto fail;
    663   1.1  jruoho 
    664   1.1  jruoho 	if (buf.Length == 0) {
    665   1.1  jruoho 		rv = AE_LIMIT;
    666   1.1  jruoho 		goto fail;
    667   1.1  jruoho 	}
    668   1.1  jruoho 
    669   1.1  jruoho 	obj = buf.Pointer;
    670   1.1  jruoho 
    671   1.1  jruoho 	if (obj->Type != ACPI_TYPE_PACKAGE) {
    672   1.1  jruoho 		rv = AE_TYPE;
    673   1.1  jruoho 		goto fail;
    674   1.1  jruoho 	}
    675   1.1  jruoho 
    676   1.1  jruoho 	if (obj->Package.Count == 0) {
    677   1.1  jruoho 		rv = AE_LIMIT;
    678   1.1  jruoho 		goto fail;
    679   1.1  jruoho 	}
    680   1.1  jruoho 
    681   1.1  jruoho 	return obj;
    682   1.1  jruoho 
    683   1.1  jruoho fail:
    684   1.1  jruoho 	if (buf.Pointer != NULL)
    685   1.1  jruoho 		ACPI_FREE(buf.Pointer);
    686   1.1  jruoho 
    687   1.8  jruoho 	ACPI_DEBUG_PRINT((ACPI_DB_DEBUG_OBJECT, "failed to evaluate %s for "
    688   1.8  jruoho 		"%s: %s\n", path, acpi_xname(hdl), AcpiFormatException(rv)));
    689   1.1  jruoho 
    690   1.1  jruoho 	return NULL;
    691   1.1  jruoho }
    692   1.1  jruoho 
    693   1.4  jruoho SYSCTL_SETUP(sysctl_acpi_power_setup, "sysctl hw.acpi.power subtree setup")
    694   1.4  jruoho {
    695  1.23  gsutre 	const struct sysctlnode *anode;
    696   1.4  jruoho 	int err;
    697   1.4  jruoho 
    698   1.4  jruoho 	err = sysctl_createv(NULL, 0, NULL, &anode,
    699   1.4  jruoho 	    CTLFLAG_PERMANENT, CTLTYPE_NODE, "hw",
    700   1.4  jruoho 	    NULL, NULL, 0, NULL, 0,
    701   1.4  jruoho 	    CTL_HW, CTL_EOL);
    702   1.4  jruoho 
    703   1.4  jruoho 	if (err != 0)
    704  1.23  gsutre 		return;
    705   1.4  jruoho 
    706   1.4  jruoho 	err = sysctl_createv(NULL, 0, &anode, &anode,
    707   1.4  jruoho 	    CTLFLAG_PERMANENT, CTLTYPE_NODE, "acpi",
    708   1.4  jruoho 	    NULL, NULL, 0, NULL, 0,
    709   1.4  jruoho 	    CTL_CREATE, CTL_EOL);
    710   1.4  jruoho 
    711   1.4  jruoho 	if (err != 0)
    712  1.23  gsutre 		return;
    713  1.23  gsutre 
    714  1.23  gsutre 	acpi_power_acpinode = anode->sysctl_num;
    715   1.4  jruoho 
    716   1.4  jruoho 	err = sysctl_createv(NULL, 0, &anode, &anode,
    717   1.4  jruoho 	    CTLFLAG_PERMANENT, CTLTYPE_NODE,
    718   1.4  jruoho 	    "power", SYSCTL_DESCR("ACPI device power states"),
    719   1.4  jruoho 	    NULL, 0, NULL, 0,
    720   1.4  jruoho 	    CTL_CREATE, CTL_EOL);
    721   1.4  jruoho 
    722   1.4  jruoho 	if (err != 0)
    723  1.23  gsutre 		return;
    724   1.4  jruoho 
    725  1.23  gsutre 	acpi_power_powernode = anode->sysctl_num;
    726   1.4  jruoho }
    727   1.4  jruoho 
    728   1.4  jruoho void
    729   1.4  jruoho acpi_power_add(struct acpi_devnode *ad)
    730   1.4  jruoho {
    731  1.24  jruoho 	const char *str = NULL;
    732  1.24  jruoho 	device_t dev;
    733   1.4  jruoho 	int err;
    734   1.4  jruoho 
    735   1.4  jruoho 	KASSERT(ad != NULL && ad->ad_root != NULL);
    736   1.4  jruoho 	KASSERT((ad->ad_flags & ACPI_DEVICE_POWER) != 0);
    737   1.4  jruoho 
    738  1.23  gsutre 	if (acpi_power_acpinode == CTL_EOL ||
    739  1.23  gsutre 	    acpi_power_powernode == CTL_EOL)
    740   1.4  jruoho 		return;
    741   1.4  jruoho 
    742  1.24  jruoho 	if (ad->ad_device != NULL)
    743  1.24  jruoho 		str = device_xname(ad->ad_device);
    744  1.24  jruoho 	else {
    745  1.24  jruoho 		dev = acpi_pcidev_find_dev(ad);
    746  1.24  jruoho 
    747  1.24  jruoho 		if (dev != NULL)
    748  1.24  jruoho 			str = device_xname(dev);
    749  1.24  jruoho 	}
    750  1.24  jruoho 
    751  1.24  jruoho 	if (str == NULL)
    752  1.24  jruoho 		return;
    753  1.24  jruoho 
    754  1.23  gsutre 	err = sysctl_createv(NULL, 0, NULL, NULL,
    755  1.24  jruoho 	    CTLFLAG_READONLY, CTLTYPE_STRING, str,
    756  1.24  jruoho 	    NULL, acpi_power_sysctl, 0, ad, 0, CTL_HW,
    757  1.24  jruoho 	    acpi_power_acpinode, acpi_power_powernode,
    758   1.4  jruoho 	    CTL_CREATE, CTL_EOL);
    759   1.4  jruoho 
    760   1.4  jruoho 	if (err != 0)
    761   1.4  jruoho 		aprint_error_dev(ad->ad_root, "sysctl_createv"
    762  1.25  jruoho 		    "(hw.acpi.power.%s) failed (err %d)\n", str, err);
    763   1.4  jruoho }
    764   1.4  jruoho 
    765   1.4  jruoho static int
    766   1.4  jruoho acpi_power_sysctl(SYSCTLFN_ARGS)
    767   1.4  jruoho {
    768   1.5  jruoho 	struct acpi_devnode *ad;
    769   1.4  jruoho 	struct sysctlnode node;
    770   1.4  jruoho 	int err, state;
    771   1.4  jruoho 	char t[3];
    772   1.4  jruoho 
    773   1.4  jruoho 	node = *rnode;
    774   1.5  jruoho 	ad = rnode->sysctl_data;
    775   1.5  jruoho 
    776  1.21  jruoho 	if (acpi_power_get(ad->ad_handle, &state) != true)
    777   1.5  jruoho 		state = 0;
    778   1.4  jruoho 
    779   1.4  jruoho 	(void)memset(t, '\0', sizeof(t));
    780   1.4  jruoho 	(void)snprintf(t, sizeof(t), "D%d", state);
    781   1.4  jruoho 
    782   1.4  jruoho 	node.sysctl_data = &t;
    783   1.4  jruoho 
    784   1.4  jruoho 	err = sysctl_lookup(SYSCTLFN_CALL(&node));
    785   1.4  jruoho 
    786   1.4  jruoho 	if (err || newp == NULL)
    787   1.4  jruoho 		return err;
    788   1.4  jruoho 
    789   1.4  jruoho 	return 0;
    790   1.4  jruoho }
    791   1.4  jruoho 
    792   1.1  jruoho /*
    793   1.1  jruoho  * XXX: Move this to acpi_util.c by refactoring
    794   1.1  jruoho  *	acpi_name() to optionally return a single name.
    795   1.1  jruoho  */
    796   1.1  jruoho static const char *
    797   1.1  jruoho acpi_xname(ACPI_HANDLE hdl)
    798   1.1  jruoho {
    799   1.1  jruoho 	static char str[5];
    800   1.1  jruoho 	ACPI_BUFFER buf;
    801   1.1  jruoho 	ACPI_STATUS rv;
    802   1.1  jruoho 
    803   1.1  jruoho 	buf.Pointer = str;
    804   1.1  jruoho 	buf.Length = sizeof(str);
    805   1.1  jruoho 
    806   1.1  jruoho 	rv = AcpiGetName(hdl, ACPI_SINGLE_NAME, &buf);
    807   1.1  jruoho 
    808   1.1  jruoho 	if (ACPI_FAILURE(rv))
    809   1.1  jruoho 		return "????";
    810   1.1  jruoho 
    811   1.1  jruoho 	return str;
    812   1.1  jruoho }
    813