From 9f74c66d915634164cbd2f0923dda5c124061afe Mon Sep 17 00:00:00 2001 From: Paul Irofti Date: Wed, 3 Jun 2009 07:13:49 +0000 Subject: Import acpi power resource driver. This is needed for suspend/resume logic. Okay jordan@ and marco@. --- sys/arch/amd64/conf/GENERIC | 3 +- sys/arch/i386/conf/GENERIC | 3 +- sys/dev/acpi/acpi.c | 5 +- sys/dev/acpi/acpipwrres.c | 210 ++++++++++++++++++++++++++++++++++++++++++++ sys/dev/acpi/files.acpi | 7 +- 5 files changed, 224 insertions(+), 4 deletions(-) create mode 100644 sys/dev/acpi/acpipwrres.c (limited to 'sys') diff --git a/sys/arch/amd64/conf/GENERIC b/sys/arch/amd64/conf/GENERIC index 6de9641a778..25a3c1bac64 100644 --- a/sys/arch/amd64/conf/GENERIC +++ b/sys/arch/amd64/conf/GENERIC @@ -1,4 +1,4 @@ -# $OpenBSD: GENERIC,v 1.266 2009/06/03 00:36:59 pirofti Exp $ +# $OpenBSD: GENERIC,v 1.267 2009/06/03 07:13:48 pirofti Exp $ # # For further information on compiling OpenBSD kernels, see the config(8) # man page. @@ -53,6 +53,7 @@ acpimadt0 at acpi? acpithinkpad* at acpi? acpivideo* at acpi? acpivout* at acpivideo? +acpipwrres* at acpi? mpbios0 at bios0 diff --git a/sys/arch/i386/conf/GENERIC b/sys/arch/i386/conf/GENERIC index 7b864efac1e..58c27ebc64b 100644 --- a/sys/arch/i386/conf/GENERIC +++ b/sys/arch/i386/conf/GENERIC @@ -1,4 +1,4 @@ -# $OpenBSD: GENERIC,v 1.661 2009/06/03 00:36:59 pirofti Exp $ +# $OpenBSD: GENERIC,v 1.662 2009/06/03 07:13:48 pirofti Exp $ # # For further information on compiling OpenBSD kernels, see the config(8) # man page. @@ -65,6 +65,7 @@ acpiasus* at acpi? acpithinkpad* at acpi? acpivideo* at acpi? acpivout* at acpivideo? +acpipwrres* at acpi? option PCIVERBOSE option EISAVERBOSE diff --git a/sys/dev/acpi/acpi.c b/sys/dev/acpi/acpi.c index d67f471f3ef..86eb1722072 100644 --- a/sys/dev/acpi/acpi.c +++ b/sys/dev/acpi/acpi.c @@ -1,4 +1,4 @@ -/* $OpenBSD: acpi.c,v 1.139 2009/06/03 00:36:59 pirofti Exp $ */ +/* $OpenBSD: acpi.c,v 1.140 2009/06/03 07:13:48 pirofti Exp $ */ /* * Copyright (c) 2005 Thorsten Lockert * Copyright (c) 2005 Jordan Hargrave @@ -1479,6 +1479,9 @@ acpi_add_device(struct aml_node *node, void *arg) case AML_OBJTYPE_THERMZONE: aaa.aaa_name = "acpitz"; break; + case AML_OBJTYPE_POWERRSRC: + aaa.aaa_name = "acpipwrres"; + break; default: return 0; } diff --git a/sys/dev/acpi/acpipwrres.c b/sys/dev/acpi/acpipwrres.c new file mode 100644 index 00000000000..5f71cb9f20d --- /dev/null +++ b/sys/dev/acpi/acpipwrres.c @@ -0,0 +1,210 @@ +/* $OpenBSD: acpipwrres.c,v 1.1 2009/06/03 07:13:48 pirofti Exp $ */ +/* + * Copyright (c) 2009 Paul Irofti + * + * Permission to use, copy, modify, and distribute this software for any + * purpose with or without fee is hereby granted, provided that the above + * copyright notice and this permission notice appear in all copies. + * + * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES + * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF + * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR + * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES + * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN + * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF + * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. + */ +#include +#include +#include +#include +#include +#include + +#include + +#include +#include +#include +#include +#include + +int acpipwrres_match(struct device *, void *, void *); +void acpipwrres_attach(struct device *, struct device *, void *); +int acpipwrres_notify(struct aml_node *, int, void *); + +#define NOTIFY_PWRRES_OFF 0 +#define NOTIFY_PWRRES_ON 1 + +#ifdef ACPIPWRRES_DEBUG +#define DPRINTF(x) printf x +#else +#define DPRINTF(x) +#endif + +struct acpipwrres_softc { + struct device sc_dev; + + bus_space_tag_t sc_iot; + bus_space_handle_t sc_ioh; + + struct acpi_softc *sc_acpi; + struct aml_node *sc_devnode; + + TAILQ_HEAD(acpipwrres_cons_h, acpipwrres_consumer) sc_cons; + + int sc_level; + int sc_order; + int sc_ncons; + int sc_state; +#define ACPIPWRRES_OFF 0 +#define ACPIPWRRES_ON 1 +#define ACPIPWRRES_UNK -1 +}; + +struct acpipwrres_consumer { + struct aml_node *cs_node; + TAILQ_ENTRY(acpipwrres_consumer) cs_link; +}; + +struct cfattach acpipwrres_ca = { + sizeof(struct acpipwrres_softc), acpipwrres_match, acpipwrres_attach +}; + +struct cfdriver acpipwrres_cd = { + NULL, "acpipwrres", DV_DULL +}; + +int acpipwrres_foundcons(struct aml_node *, void *); + +int +acpipwrres_match(struct device *parent, void *match, void *aux) +{ + struct acpi_attach_args *aaa = aux; + struct cfdata *cf = match; + + if (aaa->aaa_name == NULL || strcmp(aaa->aaa_name, + cf->cf_driver->cd_name) != 0 || aaa->aaa_table != NULL) + return (0); + + return (1); +} + +void +acpipwrres_attach(struct device *parent, struct device *self, void *aux) +{ + struct acpipwrres_softc *sc = (struct acpipwrres_softc *)self; + struct acpi_attach_args *aaa = aux; + struct aml_value res; + + extern struct aml_node aml_root; + + sc->sc_acpi = (struct acpi_softc *)parent; + sc->sc_devnode = aaa->aaa_node; + memset(&res, 0, sizeof res); + + printf(": %s\n", sc->sc_devnode->name); + + aml_register_notify(sc->sc_devnode, aaa->aaa_dev, + acpipwrres_notify, sc, ACPIDEV_NOPOLL); + + if (!aml_evalname(sc->sc_acpi, sc->sc_devnode, "_STA", 0, NULL, &res)) { + sc->sc_state = (int)aml_val2int(&res); + if (sc->sc_state != ACPIPWRRES_ON && + sc->sc_state != ACPIPWRRES_OFF) + sc->sc_state = ACPIPWRRES_UNK; + } else + sc->sc_state = ACPIPWRRES_UNK; + DPRINTF(("%s: state = %d\n", DEVNAME(sc), sc->sc_state)); + if (aml_evalnode(sc->sc_acpi, aaa->aaa_node, 0, NULL, &res) == 0) { + sc->sc_level = res.v_powerrsrc.pwr_level; + sc->sc_order = res.v_powerrsrc.pwr_order; + DPRINTF(("%s: level = %d, order %d\n", DEVNAME(sc), + sc->sc_level, sc->sc_order)); + aml_freevalue(&res); + } + + /* Get the list of consumers */ + TAILQ_INIT(&sc->sc_cons); + aml_find_node(aml_root.child, "_PRW", acpipwrres_foundcons, sc); + aml_find_node(aml_root.child, "_PR0", acpipwrres_foundcons, sc); + aml_find_node(aml_root.child, "_PR1", acpipwrres_foundcons, sc); + aml_find_node(aml_root.child, "_PR2", acpipwrres_foundcons, sc); +} + +int +acpipwrres_notify(struct aml_node *node, int notify, void *arg) +{ + int fmatch = 0; + struct acpipwrres_consumer *cons; + struct acpipwrres_softc *sc = arg; + struct aml_value res; + + memset(&res, 0, sizeof res); + + TAILQ_FOREACH(cons, &sc->sc_cons, cs_link) + if (cons->cs_node == node) { + fmatch = 1; + break; + } + if (!fmatch) + return (0); + + switch (notify) { + case NOTIFY_PWRRES_ON: + DPRINTF(("pwr: on devs %d\n", sc->sc_ncons)); + if (sc->sc_ncons++ == 0) + aml_evalname(sc->sc_acpi, sc->sc_devnode, "_ON", 0, NULL, + &res); + aml_freevalue(&res); + break; + case NOTIFY_PWRRES_OFF: + DPRINTF(("pwr: off devs %d\n", sc->sc_ncons)); + if (--sc->sc_ncons == 0) + aml_evalname(sc->sc_acpi, sc->sc_devnode, "_OFF", 0, NULL, + &res); + aml_freevalue(&res); + break; + default: + printf("%s: unknown event 0x%02x\n", DEVNAME(sc), notify); + break; + } + + return (0); +} + +int +acpipwrres_foundcons(struct aml_node *node, void *arg) +{ + int i = 0; + struct acpipwrres_consumer *cons; + struct aml_node *pnode; + struct acpipwrres_softc *sc = (struct acpipwrres_softc *)arg; + struct aml_value res; + + extern struct aml_node aml_root; + + memset(&res, 0, sizeof res); + + if (aml_evalnode(sc->sc_acpi, node, 0, NULL, &res) == -1) { + DPRINTF(("pwr: consumer not found\n")); + return (-1); + } else { + DPRINTF(("%s: node name %s\n", DEVNAME(sc), aml_nodename(node))); + if (!strcmp(node->name, "_PRW")) + i = 2; /* _PRW first two values are ints */ + for (; i < res.length; i++) { + pnode = aml_searchname(&aml_root, + res.v_package[i]->v_string); + if (pnode == sc->sc_devnode) { + DPRINTF(("%s: consumer match\n", DEVNAME(sc))); + cons = malloc(sizeof *pnode, M_DEVBUF, + M_WAITOK | M_ZERO); + cons->cs_node = pnode; + TAILQ_INSERT_HEAD(&sc->sc_cons, cons, cs_link); + } + } + } + + return (0); +} diff --git a/sys/dev/acpi/files.acpi b/sys/dev/acpi/files.acpi index f3d4daf926d..be89febd85f 100644 --- a/sys/dev/acpi/files.acpi +++ b/sys/dev/acpi/files.acpi @@ -1,4 +1,4 @@ -# $OpenBSD: files.acpi,v 1.21 2009/06/03 00:36:59 pirofti Exp $ +# $OpenBSD: files.acpi,v 1.22 2009/06/03 07:13:48 pirofti Exp $ # # Config file and device description for machine-independent ACPI code. # Included by ports that need it. @@ -86,3 +86,8 @@ file dev/acpi/acpivideo.c acpivideo device acpivout attach acpivout at acpivideo file dev/acpi/acpivout.c acpivout + +# ACPI pwrres +device acpipwrres +attach acpipwrres at acpi +file dev/acpi/acpipwrres.c acpipwrres -- cgit v1.2.3