sys/dev/acpi/acpi_wakedev.c

   1 /* $NetBSD: acpi_wakedev.c,v 1.1 2009/08/04 14:20:40 jmcneill Exp $ */
   2
   3 /*-
   4  * Copyright (c) 2009 Jared D. McNeill <jmcneill@invisible.ca>
   5  * All rights reserved.
   6  *
   7  * Redistribution and use in source and binary forms, with or without
   8  * modification, are permitted provided that the following conditions
   9  * are met:
  10  * 1. Redistributions of source code must retain the above copyright
  11  *    notice, this list of conditions and the following disclaimer.
  12  * 2. Redistributions in binary form must reproduce the above copyright
  13  *    notice, this list of conditions and the following disclaimer in the
  14  *    documentation and/or other materials provided with the distribution.
  15  *
  16  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
  17  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
  18  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
  19  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
  20  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  21  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  22  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  23  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  24  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  25  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  26  * POSSIBILITY OF SUCH DAMAGE.
  27  */
  28
  29 #include <sys/cdefs.h>
  30 __KERNEL_RCSID(0, "$NetBSD: acpi_wakedev.c,v 1.1 2009/08/04 14:20:40 jmcneill Exp $");
  31
  32 #include <sys/types.h>
  33 #include <sys/param.h>
  34 #include <sys/kernel.h>
  35 #include <sys/kmem.h>
  36 #include <sys/device.h>
  37 #include <sys/queue.h>
  38 #include <sys/sysctl.h>
  39
  40 #include <dev/acpi/acpivar.h>
  41 #include <dev/acpi/acpireg.h>
  42 #include <dev/acpi/acpi_wakedev.h>
  43
  44 struct acpi_wakedev;
  45
  46 static TAILQ_HEAD(, acpi_wakedev) acpi_wakedevlist =
  47     TAILQ_HEAD_INITIALIZER(acpi_wakedevlist);
  48 static int acpi_wakedev_node = -1;
  49
  50 struct acpi_wakedev {
  51         struct acpi_devnode     *aw_node;
  52         int                     aw_enabled;
  53         struct sysctllog        *aw_sysctllog;
  54         TAILQ_ENTRY(acpi_wakedev) aw_list;
  55 };
  56
  57 static const char * const acpi_wakedev_default[] = {
  58         "PNP0C0C",      /* power button */
  59         "PNP0C0E",      /* sleep button */
  60         "PNP0C0D",      /* lid switch */
  61         "PNP03??",      /* PC KBD port */
  62         NULL,
  63 };
  64
  65 SYSCTL_SETUP(sysctl_acpi_wakedev_setup, "sysctl hw.wake subtree setup")
  66 {
  67         const struct sysctlnode *rnode;
  68         int err;
  69
  70         err = sysctl_createv(NULL, 0, NULL, NULL,
  71             CTLFLAG_PERMANENT,
  72             CTLTYPE_NODE, "hw", NULL,
  73             NULL, 0, NULL, 0, CTL_HW, CTL_EOL);
  74         if (err)
  75                 return;
  76         err = sysctl_createv(NULL, 0, NULL, &rnode,
  77             CTLFLAG_PERMANENT,
  78             CTLTYPE_NODE, "wake", NULL,
  79             NULL, 0, NULL, 0,
  80             CTL_HW, CTL_CREATE, CTL_EOL);
  81         if (err)
  82                 return;
  83         acpi_wakedev_node = rnode->sysctl_num;
  84 }
  85
  86 static void
  87 acpi_wakedev_sysctl_add(struct acpi_wakedev *aw)
  88 {
  89         int err;
  90
  91         if (acpi_wakedev_node == -1)
  92                 return;
  93
  94         err = sysctl_createv(&aw->aw_sysctllog, 0, NULL, NULL,
  95             CTLFLAG_READWRITE, CTLTYPE_INT, aw->aw_node->ad_name,
  96             NULL, NULL, 0, &aw->aw_enabled, 0,
  97             CTL_HW, acpi_wakedev_node, CTL_CREATE, CTL_EOL);
  98         if (err)
  99                 printf("acpi_wakedev_sysctl_add: "
 100                     "sysctl_createv(hw.wake.%s) failed. (%d)\n",
 101                     aw->aw_node->ad_name, err);
 102 }
 103
 104 static bool
 105 acpi_wakedev_add(struct acpi_softc *sc, struct acpi_devnode *ad)
 106 {
 107         struct acpi_wakedev *aw;
 108         ACPI_HANDLE hdl;
 109
 110         if (ACPI_FAILURE(AcpiGetHandle(ad->ad_handle, "_PRW", &hdl)))
 111                 return false;
 112
 113         aw = kmem_alloc(sizeof(*aw), KM_SLEEP);
 114         if (aw == NULL) {
 115                 aprint_error("acpi_wakedev_add: kmem_alloc failed\n");
 116                 return false;
 117         }
 118         aw->aw_node = ad;
 119         aw->aw_sysctllog = NULL;
 120         if (acpi_match_hid(ad->ad_devinfo, acpi_wakedev_default))
 121                 aw->aw_enabled = 1;
 122         else
 123                 aw->aw_enabled = 0;
 124
 125         TAILQ_INSERT_TAIL(&acpi_wakedevlist, aw, aw_list);
 126
 127         acpi_wakedev_sysctl_add(aw);
 128
 129         return true;
 130 }
 131
 132 static void
 133 acpi_wakedev_print(struct acpi_wakedev *aw)
 134 {
 135         aprint_debug(" %s", aw->aw_node->ad_name);
 136 }
 137
 138 int
 139 acpi_wakedev_scan(struct acpi_softc *sc)
 140 {
 141         struct acpi_scope *as;
 142         struct acpi_devnode *ad;
 143         struct acpi_wakedev *aw;
 144         ACPI_DEVICE_INFO *di;
 145         int count = 0;
 146
 147 #define ACPI_STA_DEV_VALID      \
 148         (ACPI_STA_DEV_PRESENT|ACPI_STA_DEV_ENABLED|ACPI_STA_DEV_OK)
 149
 150         TAILQ_FOREACH(as, &sc->sc_scopes, as_list)
 151                 TAILQ_FOREACH(ad, &as->as_devnodes, ad_list) {
 152                         di = ad->ad_devinfo;
 153                         if (di->Type != ACPI_TYPE_DEVICE)
 154                                 continue;
 155                         if ((di->Valid & ACPI_VALID_STA) != 0 &&
 156                             (di->CurrentStatus & ACPI_STA_DEV_VALID) !=
 157                              ACPI_STA_DEV_VALID)
 158                                 continue;
 159                         if (acpi_wakedev_add(sc, ad) == true)
 160                                 ++count;
 161                 }
 162
 163 #undef ACPI_STA_DEV_VALID
 164
 165         if (count == 0)
 166                 return 0;
 167
 168         aprint_debug_dev(sc->sc_dev, "wakeup devices:");
 169         TAILQ_FOREACH(aw, &acpi_wakedevlist, aw_list)
 170                 acpi_wakedev_print(aw);
 171         aprint_debug("\n");
 172
 173         return count;
 174 }
 175
 176 void
 177 acpi_wakedev_commit(struct acpi_softc *sc)
 178 {
 179         struct acpi_wakedev *aw;
 180
 181         TAILQ_FOREACH(aw, &acpi_wakedevlist, aw_list) {
 182                 if (aw->aw_enabled) {
 183                         aprint_debug_dev(sc->sc_dev, "set wake GPE (%s)\n",
 184                             aw->aw_node->ad_name);
 185                         acpi_set_wake_gpe(aw->aw_node->ad_handle);
 186                 } else
 187                         acpi_clear_wake_gpe(aw->aw_node->ad_handle);
 188         }
 189 }