Move acpi_softc into acpi.h to be shared from additional files.

Add PowerResource manipulation code; acpi_powerres.c.  (more files to
be created something like acpi_battery, acpi_thermal.c...)

3 files changed, 433 insertions, 12 deletions

diff --git a/sys/dev/acpi/acpi.c b/sys/dev/acpi/acpi.c
index ef32a66..24b75a8 100644
--- a/sys/dev/acpi/acpi.c
+++ b/sys/dev/acpi/acpi.c
@@ -45,6 +45,8 @@
 
 #include <sys/acpi.h>
 
+#include <dev/acpi/acpi.h>		/* for softc */
+
 #include <dev/acpi/aml/aml_amlmem.h>
 #include <dev/acpi/aml/aml_common.h>
 #include <dev/acpi/aml/aml_env.h>
@@ -85,18 +87,6 @@ static vm_offset_t	 acpi_pmap_vtp(vm_offset_t va);
 static struct	ACPIaddr acpi_addr;
 struct		ACPIrsdp *acpi_rsdp;
 
-/* softc */
-typedef struct acpi_softc {
-	struct	ACPIsdt *rsdt;
-	struct	ACPIsdt *facp;
-	struct	FACPbody *facp_body;
-	struct	ACPIsdt *dsdt;
-	struct	FACS *facs;
-	int	system_state_initialized;
-	int	broken_wakeuplogic;
-	struct	acpi_system_state_package system_state_package;
-} acpi_softc_t;
-
 /* Character device stuff */
 
 static d_open_t		acpiopen;
@@ -892,6 +882,9 @@ acpi_set_sleeping_state(acpi_softc_t *sc, u_int8_t state)
 	/* Prepare to sleep */
 	acpi_execute_pts(sc, state);
 
+	/* PowerResource manipulation */
+	acpi_powerres_set_sleeping_state(sc, state);
+
 	if (!sc->system_state_initialized) {
 		return;
 	}
diff --git a/sys/dev/acpi/acpi.h b/sys/dev/acpi/acpi.h
new file mode 100644
index 0000000..6da9b99
--- /dev/null
+++ b/sys/dev/acpi/acpi.h
@@ -0,0 +1,69 @@
+/*-
+ * Copyright (c) 1999 Takanori Watanabe <takawata@shidahara1.planet.sci.kobe-u.ac.jp>
+ * Copyright (c) 1999, 2000 Mitsuru IWASAKI <iwasaki@FreeBSD.org>
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ *
+ *	$FreeBSD$
+ */
+
+#ifndef _DEV_ACPI_ACPI_H_
+#define _DEV_ACPI_ACPI_H_
+
+/* PowerResource control */
+struct acpi_powerres_device {
+	LIST_ENTRY(acpi_powerres_device) links;
+	struct	aml_name *name;
+	u_int8_t	state;		/* D0 to D3 */
+	u_int8_t	next_state;	/* initialized with D0 */
+};
+
+struct acpi_powerres_device_ref {
+	LIST_ENTRY(acpi_powerres_device_ref) links;
+	struct	acpi_powerres_device *device;
+};
+
+struct acpi_powerres_info {
+	LIST_ENTRY(acpi_powerres_info) links;
+	struct	aml_name *name;
+	u_int8_t	state;		/* OFF or ON */
+	LIST_HEAD(, acpi_powerres_device_ref) reflist[3]; /* for _PR[0-2] */
+};
+
+/* softc */
+typedef struct acpi_softc {
+	struct	ACPIsdt *rsdt;
+	struct	ACPIsdt *facp;
+	struct	FACPbody *facp_body;
+	struct	ACPIsdt *dsdt;
+	struct	FACS *facs;
+	int	system_state_initialized;
+	int	broken_wakeuplogic;
+	struct	acpi_system_state_package system_state_package;
+	LIST_HEAD(, acpi_powerres_info) acpi_powerres_inflist;
+	LIST_HEAD(, acpi_powerres_device) acpi_powerres_devlist;
+} acpi_softc_t;
+
+void acpi_powerres_set_sleeping_state(acpi_softc_t *sc, u_int8_t state);
+
+#endif	/* _DEV_ACPI_ACPI_H_ */
diff --git a/sys/dev/acpi/acpi_powerres.c b/sys/dev/acpi/acpi_powerres.c
new file mode 100644
index 0000000..c1b589e
--- /dev/null
+++ b/sys/dev/acpi/acpi_powerres.c
@@ -0,0 +1,359 @@
+/*-
+ * Copyright (c) 2000 Mitsuru IWASAKI <iwasaki@FreeBSD.org>
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ *
+ *	$FreeBSD$
+ */
+
+#include "opt_acpi.h"
+
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/malloc.h>
+
+#include <sys/acpi.h>
+
+#include <dev/acpi/acpi.h>
+
+#include <dev/acpi/aml/aml_amlmem.h>
+#include <dev/acpi/aml/aml_common.h>
+#include <dev/acpi/aml/aml_env.h>
+#include <dev/acpi/aml/aml_evalobj.h>
+#include <dev/acpi/aml/aml_name.h>
+#include <dev/acpi/aml/aml_parse.h>
+#include <dev/acpi/aml/aml_memman.h>
+
+static void acpi_powerres_init(acpi_softc_t *sc);
+static int  acpi_powerres_register(struct aml_name *name, va_list ap);
+static int  acpi_powerres_add_device(struct aml_name *name, va_list ap);
+
+static void
+acpi_powerres_init(acpi_softc_t *sc)
+{
+	struct	acpi_powerres_info *powerres;
+	struct	acpi_powerres_device_ref *device_ref;
+	struct	acpi_powerres_device *device;
+	int	i;
+
+	while ((powerres = LIST_FIRST(&sc->acpi_powerres_inflist))) {
+#ifdef ACPI_DEBUG
+		printf("acpi_powerres_init:");
+		aml_print_curname(powerres->name);
+		printf("[%d]\n", powerres->state);
+#endif
+		for (i = 0; i < 3; i++) {
+#ifdef ACPI_DEBUG
+			printf("\t_PR%d:", i);
+#endif
+			while ((device_ref = LIST_FIRST(&powerres->reflist[i]))) {
+#ifdef ACPI_DEBUG
+				device = device_ref->device;
+				aml_print_curname(device->name);
+				printf("[%d] ", device->state);
+#endif
+				LIST_REMOVE(device_ref, links);
+				FREE(device_ref, M_TEMP);
+			}
+#ifdef ACPI_DEBUG
+			printf("\n");
+#endif
+			LIST_INIT(&powerres->reflist[i]);
+		}
+		LIST_REMOVE(powerres, links);
+		FREE(powerres, M_TEMP);
+	}
+	LIST_INIT(&sc->acpi_powerres_inflist);
+
+	while ((device = LIST_FIRST(&sc->acpi_powerres_devlist))) {
+		LIST_REMOVE(device, links);
+		FREE(device, M_TEMP);
+	}
+	LIST_INIT(&sc->acpi_powerres_devlist);
+}
+
+static int
+acpi_powerres_register(struct aml_name *name, va_list ap)
+{
+	int	i;
+	acpi_softc_t *sc;
+	struct	acpi_powerres_info *powerres;
+	struct	aml_name *method;
+	union	aml_object *ret;
+	struct	aml_environ env;
+
+	sc = va_arg(ap, acpi_softc_t *);
+
+	if (name->property == NULL ||
+	    name->property->type != aml_t_powerres) {
+		return (0);
+	}
+
+	MALLOC(powerres, struct acpi_powerres_info *,
+	    sizeof(*powerres), M_TEMP, M_NOWAIT);
+	if (powerres == NULL) {
+		return (1);
+	}
+
+	powerres->name = name;
+
+	/* get the current ON or OFF status for the power resource */
+	method = aml_find_from_namespace(name, "_STA");
+	if (method != NULL) {
+		bzero(&env, sizeof(env));
+		aml_local_stack_push(aml_local_stack_create());
+		ret = aml_eval_name(&env, method);
+		aml_local_stack_delete(aml_local_stack_pop());
+		powerres->state = ret->num.number;	/* OFF or ON */
+	}
+
+	/* XXX must be sorted by resource order of PowerResource */
+	LIST_INSERT_HEAD(&sc->acpi_powerres_inflist, powerres, links);
+
+	for (i = 0; i < 3; i++) {
+		LIST_INIT(&powerres->reflist[i]);
+	}
+
+	return (0);
+}
+
+static int
+acpi_powerres_add_device(struct aml_name *name, va_list ap)
+{
+	int	i;
+	int	prnum;
+	int	dev_found;
+	acpi_softc_t *sc;
+	struct	acpi_powerres_device *device;
+	struct	acpi_powerres_device_ref *device_ref;
+	struct	acpi_powerres_info *powerres;
+	struct	aml_name *powerres_name;
+	struct	aml_name *method;
+	union	aml_object *ret;
+	struct	aml_environ env;
+
+	sc = va_arg(ap, acpi_softc_t *);
+
+	/* should be _PR[0-2] */
+	prnum =  name->name[3] - '0';
+	if (!(prnum >= 0 && prnum <= 2)) {
+		return (0);
+	}
+
+	if (name->property == NULL ||
+	    name->property->type != aml_t_package) {
+		return (0);
+	}
+
+	if (name->property->package.elements == 0) {
+		return (0);
+	}
+
+	/* make the list of devices */
+	dev_found = 0;
+	LIST_FOREACH(device, &sc->acpi_powerres_devlist, links) {
+		if (device->name == name) {
+			dev_found = 1;
+			break;
+		}
+	}
+	if (!dev_found) {
+		MALLOC(device, struct acpi_powerres_device *,
+		   sizeof(*device), M_TEMP, M_NOWAIT);
+		if (device == NULL) {
+			return (1);
+		}
+
+		/* this is a _PR[0-2] object, we need get a parent of this. */
+		device->name = name->parent;
+		device->state = 0;	/* assume D0 */
+
+		/* get the current device state */
+		method = aml_find_from_namespace(device->name, "_PSC");
+		if (method != NULL) {
+			bzero(&env, sizeof(env));
+			aml_local_stack_push(aml_local_stack_create());
+			ret = aml_eval_name(&env, method);
+			aml_local_stack_delete(aml_local_stack_pop());
+			device->state = ret->num.number;	/* D0 - D3 */
+		}
+		LIST_INSERT_HEAD(&sc->acpi_powerres_devlist, device, links);
+	}
+
+	/* find PowerResource which the device reference to */
+	MALLOC(device_ref, struct acpi_powerres_device_ref *,
+	   sizeof(*device_ref), M_TEMP, M_NOWAIT);
+	if (device_ref == NULL) {
+		return (1);
+	}
+	device_ref->device = device;
+	env.curname = device->name;
+	for (i = 0; i < name->property->package.elements; i++) {
+		if (name->property->package.objects[i]->type != aml_t_namestr) {
+			printf("acpi_powerres_add_device: not name string\n");
+			continue;
+		}
+		powerres_name = aml_search_name(&env,
+		    name->property->package.objects[i]->nstr.dp);
+		if (powerres_name == NULL) {
+			printf("acpi_powerres_add_device: not found\n");
+			continue;
+		}
+
+		LIST_FOREACH(powerres, &sc->acpi_powerres_inflist, links) {
+			if (powerres->name == powerres_name) {
+				LIST_INSERT_HEAD(&powerres->reflist[prnum],
+				    device_ref, links);
+				break;
+			}
+		}
+	}
+
+	return (0);
+}
+
+void
+acpi_powerres_set_sleeping_state(acpi_softc_t *sc, u_int8_t state)
+{
+	int	i;
+	struct	acpi_powerres_info *powerres;
+	struct	acpi_powerres_device *device;
+	struct	acpi_powerres_device_ref *device_ref;
+	struct	aml_name *method;
+	union	aml_object *ret;
+	struct	aml_environ env;
+
+	if (!(state >= 1 && state <= 4)) {
+		return;
+	}
+
+	acpi_powerres_init(sc);
+	aml_apply_foreach_found_objects(aml_get_rootname(), ".",
+	    acpi_powerres_register, sc);
+	aml_apply_foreach_found_objects(aml_get_rootname(), "_PR",
+	    acpi_powerres_add_device, sc);
+
+	/*
+	 * initialize with D0, then change to D3 later based on
+	 * PowerResource state change.
+	 */
+	LIST_FOREACH(device, &sc->acpi_powerres_devlist, links) {
+		device->next_state = 0;
+	}
+
+	/*
+	 * 7.5.2 System \_Sx state
+	 * Power Resources are in a state compatible with the system Sx
+	 * state.  All power Resources that supply a System Level reference
+	 * of Sn (where n < x) are in the OFF state.
+	 */
+	LIST_FOREACH(powerres, &sc->acpi_powerres_inflist, links) {
+		if (powerres->name->property->pres.level < state) {
+			/* if ON state then put it in the OFF state */
+			if (powerres->state == 1) {
+				method = aml_find_from_namespace(powerres->name,
+				    "_OFF");
+				if (method == NULL) {
+					continue;	/* just in case */
+				}
+
+				bzero(&env, sizeof(env));
+				aml_local_stack_push(aml_local_stack_create());
+				aml_eval_name(&env, method);
+				aml_local_stack_delete(aml_local_stack_pop());
+				powerres->state = 0;
+			}
+			/*
+			 * Device states are compatible with the current
+			 * Power Resource states.
+			 */
+			for (i = 0; i < 3; i++) {
+				LIST_FOREACH(device_ref, &powerres->reflist[i], links) {
+					/* D3 state */
+					device_ref->device->next_state = 3;
+				}
+			}
+		} else {
+			/* if OFF state then put it in the ON state */
+			if (powerres->state == 0) {
+				method = aml_find_from_namespace(powerres->name,
+				    "_ON");
+				if (method == NULL) {
+					continue;	/* just in case */
+				}
+
+				bzero(&env, sizeof(env));
+				aml_local_stack_push(aml_local_stack_create());
+				aml_eval_name(&env, method);
+				aml_local_stack_delete(aml_local_stack_pop());
+				powerres->state = 1;
+			}
+		}
+	}
+
+	/*
+	 * Devices states are compatible with the current Power Resource
+	 * states. only devices which solely reference Power Resources which
+	 * are in the ON state for a given device state can be in that device
+	 * state. In all other cases, the device is in the D3 (off) state.
+	 * Note:
+	 * Or is at least assumed to be in the D3 state by its device driver.
+	 * For example, if the device doesn't explicitly describe how it can
+	 * stay in some state non-off state while the system is in a sleeping
+	 * state, the operating software must assume that the device can lose
+	 * its power and state.
+	 */
+
+	LIST_FOREACH(device, &sc->acpi_powerres_devlist, links) {
+		if (device->next_state == 3 && device->state != 3) {
+			method = aml_find_from_namespace(device->name, "_PS3");
+			if (method != NULL) {
+				bzero(&env, sizeof(env));
+				aml_local_stack_push(aml_local_stack_create());
+				aml_eval_name(&env, method);
+				aml_local_stack_delete(aml_local_stack_pop());
+			}
+		}
+		if (device->next_state == 0 && device->state != 0) {
+			method = aml_find_from_namespace(device->name, "_PS0");
+			if (method != NULL) {
+				bzero(&env, sizeof(env));
+				aml_local_stack_push(aml_local_stack_create());
+				aml_eval_name(&env, method);
+				aml_local_stack_delete(aml_local_stack_pop());
+			}
+		}
+		/* get the current device state */
+		method = aml_find_from_namespace(device->name, "_PSC");
+		if (method != NULL) {
+			bzero(&env, sizeof(env));
+			aml_local_stack_push(aml_local_stack_create());
+			ret = aml_eval_name(&env, method);
+			aml_local_stack_delete(aml_local_stack_pop());
+			device->state = ret->num.number;	/* D0 - D3 */
+		}
+	}
+#if 1
+	acpi_powerres_init(sc);
+#endif
+}