#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: acpi_wakedev.c,v 1.30 2024/12/09 23:41:36 jmcneill Exp $");
#include "pci.h"
#include <sys/param.h>
#include <sys/device.h>
#include <sys/kmem.h>
#include <sys/sysctl.h>
#include <dev/acpi/acpireg.h>
#include <dev/acpi/acpivar.h>
#include <dev/acpi/acpi_pci.h>
#include <dev/acpi/acpi_power.h>
#include <dev/acpi/acpi_wakedev.h>
#define _COMPONENT ACPI_BUS_COMPONENT
ACPI_MODULE_NAME ("acpi_wakedev")
static const char * const acpi_wakedev_default[] = {
"PNP0C0C",
"PNP0C0E",
"PNP0C0D",
"PNP03??",
NULL,
};
static int32_t acpi_wakedev_acpinode = CTL_EOL;
static int32_t acpi_wakedev_wakenode = CTL_EOL;
static void acpi_wakedev_power_add(struct acpi_devnode *, ACPI_OBJECT *);
static void acpi_wakedev_power_set(struct acpi_devnode *, bool);
static void acpi_wakedev_method(struct acpi_devnode *, int);
void
acpi_wakedev_init(struct acpi_devnode *ad)
{
ACPI_OBJECT *elm, *obj;
ACPI_INTEGER val;
ACPI_HANDLE hdl;
ACPI_BUFFER buf;
ACPI_STATUS rv;
KASSERT(ad != NULL && ad->ad_wakedev == NULL);
KASSERT(ad->ad_devinfo->Type == ACPI_TYPE_DEVICE);
rv = acpi_eval_struct(ad->ad_handle, "_PRW", &buf);
if (ACPI_FAILURE(rv))
goto out;
obj = buf.Pointer;
if (obj->Type != ACPI_TYPE_PACKAGE) {
rv = AE_TYPE;
goto out;
}
if (obj->Package.Count < 2 || obj->Package.Count > UINT32_MAX) {
rv = AE_LIMIT;
goto out;
}
elm = &obj->Package.Elements[0];
switch (elm->Type) {
case ACPI_TYPE_INTEGER:
val = elm->Integer.Value;
hdl = NULL;
break;
case ACPI_TYPE_PACKAGE:
if (elm->Package.Count < 2) {
rv = AE_LIMIT;
goto out;
}
rv = AE_TYPE;
if (elm->Package.Elements[0].Type != ACPI_TYPE_LOCAL_REFERENCE)
goto out;
if (elm->Package.Elements[1].Type != ACPI_TYPE_INTEGER)
goto out;
hdl = elm->Package.Elements[0].Reference.Handle;
val = elm->Package.Elements[1].Integer.Value;
break;
default:
rv = AE_TYPE;
goto out;
}
ad->ad_wakedev = kmem_zalloc(sizeof(*ad->ad_wakedev), KM_SLEEP);
ad->ad_wakedev->aw_handle = hdl;
ad->ad_wakedev->aw_number = val;
elm = &obj->Package.Elements[1];
if (elm->Type == ACPI_TYPE_INTEGER)
ad->ad_wakedev->aw_state = elm->Integer.Value;
acpi_wakedev_power_add(ad, obj);
if (!AcpiGbl_ReducedHardware) {
rv = AcpiSetupGpeForWake(ad->ad_handle, hdl, val);
} else {
rv = AE_OK;
}
out:
if (buf.Pointer != NULL)
ACPI_FREE(buf.Pointer);
if (ACPI_FAILURE(rv) && rv != AE_NOT_FOUND)
aprint_error_dev(ad->ad_root, "failed to evaluate _PRW "
"for %s: %s\n", ad->ad_name, AcpiFormatException(rv));
}
static void
acpi_wakedev_power_add(struct acpi_devnode *ad, ACPI_OBJECT *obj)
{
struct acpi_wakedev *aw = ad->ad_wakedev;
uint32_t i, j, n;
ACPI_OBJECT *elm;
ACPI_HANDLE hdl;
ACPI_STATUS rv;
for (i = 0; i < __arraycount(aw->aw_power); i++)
aw->aw_power[i] = NULL;
n = obj->Package.Count;
if (n < 3 || n - 2 > __arraycount(aw->aw_power))
return;
for (i = 2, j = 0; i < n; i++, j++) {
elm = &obj->Package.Elements[i];
rv = acpi_eval_reference_handle(elm, &hdl);
if (ACPI_FAILURE(rv))
continue;
ad->ad_wakedev->aw_power[j] = hdl;
}
}
static void
acpi_wakedev_power_set(struct acpi_devnode *ad, bool enable)
{
struct acpi_wakedev *aw = ad->ad_wakedev;
uint8_t i;
for (i = 0; i < __arraycount(aw->aw_power); i++) {
if (aw->aw_power[i] == NULL)
continue;
(void)acpi_power_res(aw->aw_power[i], ad->ad_handle, enable);
}
}
void
acpi_wakedev_add(struct acpi_devnode *ad)
{
struct acpi_wakedev *aw;
const char *str = NULL;
int err;
KASSERT(ad != NULL && ad->ad_wakedev != NULL);
KASSERT((ad->ad_flags & ACPI_DEVICE_WAKEUP) != 0);
aw = ad->ad_wakedev;
aw->aw_enable = false;
if (acpi_match_hid(ad->ad_devinfo, acpi_wakedev_default))
aw->aw_enable = true;
if (acpi_wakedev_acpinode == CTL_EOL ||
acpi_wakedev_wakenode == CTL_EOL)
return;
if (ad->ad_device != NULL)
str = device_xname(ad->ad_device);
#if NPCI > 0
else {
device_t dev = acpi_pcidev_find_dev(ad);
if (dev != NULL)
str = device_xname(dev);
}
#endif
if (str == NULL)
return;
err = sysctl_createv(NULL, 0, NULL, NULL,
CTLFLAG_READWRITE, CTLTYPE_BOOL, str,
NULL, NULL, 0, &aw->aw_enable, 0, CTL_HW,
acpi_wakedev_acpinode, acpi_wakedev_wakenode,
CTL_CREATE, CTL_EOL);
if (err != 0)
aprint_error_dev(ad->ad_root, "sysctl_createv"
"(hw.acpi.wake.%s) failed (err %d)\n", str, err);
}
SYSCTL_SETUP(sysctl_acpi_wakedev_setup, "sysctl hw.acpi.wake subtree setup")
{
const struct sysctlnode *rnode;
int err;
err = sysctl_createv(NULL, 0, NULL, &rnode,
CTLFLAG_PERMANENT, CTLTYPE_NODE, "acpi",
NULL, NULL, 0, NULL, 0,
CTL_HW, CTL_CREATE, CTL_EOL);
if (err != 0)
return;
acpi_wakedev_acpinode = rnode->sysctl_num;
err = sysctl_createv(NULL, 0, &rnode, &rnode,
CTLFLAG_PERMANENT, CTLTYPE_NODE,
"wake", SYSCTL_DESCR("ACPI device wake-up"),
NULL, 0, NULL, 0,
CTL_CREATE, CTL_EOL);
if (err != 0)
return;
acpi_wakedev_wakenode = rnode->sysctl_num;
}
void
acpi_wakedev_commit(struct acpi_softc *sc, int state)
{
struct acpi_devnode *ad;
ACPI_INTEGER val;
ACPI_HANDLE hdl;
SIMPLEQ_FOREACH(ad, &sc->sc_head, ad_list) {
if (ad->ad_wakedev == NULL)
continue;
if (state > ad->ad_wakedev->aw_state)
continue;
hdl = ad->ad_wakedev->aw_handle;
val = ad->ad_wakedev->aw_number;
if (state == ACPI_STATE_S0) {
if (!AcpiGbl_ReducedHardware) {
AcpiSetGpeWakeMask(hdl, val, ACPI_GPE_DISABLE);
}
continue;
}
if (!AcpiGbl_ReducedHardware) {
AcpiSetGpeWakeMask(hdl, val, ACPI_GPE_ENABLE);
}
acpi_wakedev_power_set(ad, true);
acpi_wakedev_method(ad, state);
}
}
static void
acpi_wakedev_method(struct acpi_devnode *ad, int state)
{
const bool enable = ad->ad_wakedev->aw_enable;
ACPI_OBJECT_LIST arg;
ACPI_OBJECT obj[3];
ACPI_STATUS rv;
arg.Count = 3;
arg.Pointer = obj;
obj[0].Integer.Value = enable;
obj[1].Integer.Value = state;
obj[2].Integer.Value = ACPI_STATE_D0;
obj[0].Type = obj[1].Type = obj[2].Type = ACPI_TYPE_INTEGER;
rv = AcpiEvaluateObject(ad->ad_handle, "_DSW", &arg, NULL);
if (ACPI_SUCCESS(rv))
return;
if (rv != AE_NOT_FOUND)
goto fail;
rv = acpi_eval_set_integer(ad->ad_handle, "_PSW", enable);
if (ACPI_FAILURE(rv) && rv != AE_NOT_FOUND)
goto fail;
return;
fail:
aprint_error_dev(ad->ad_root, "failed to evaluate wake "
"control method: %s\n", AcpiFormatException(rv));
}