Module Name: src
Committed By: jmcneill
Date: Mon Dec 14 20:58:45 UTC 2015
Modified Files:
src/sys/dev/fdt: files.fdt
Added Files:
src/sys/dev/fdt: gpiokeys.c
Log Message:
Add driver for device tree "gpio-keys" device. Each GPIO key is mapped to
a sysmon pswitch; code KEY_POWER is a power button, KEY_SLEEP is a sleep
button, and everything else is treated as a hotkey button.
To generate a diff of this commit:
cvs rdiff -u -r1.1 -r1.2 src/sys/dev/fdt/files.fdt
cvs rdiff -u -r0 -r1.1 src/sys/dev/fdt/gpiokeys.c
Please note that diffs are not public domain; they are subject to the
copyright notices on the relevant files.
Modified files:
Index: src/sys/dev/fdt/files.fdt
diff -u src/sys/dev/fdt/files.fdt:1.1 src/sys/dev/fdt/files.fdt:1.2
--- src/sys/dev/fdt/files.fdt:1.1 Sun Dec 13 17:30:40 2015
+++ src/sys/dev/fdt/files.fdt Mon Dec 14 20:58:45 2015
@@ -1,4 +1,4 @@
-# $NetBSD: files.fdt,v 1.1 2015/12/13 17:30:40 jmcneill Exp $
+# $NetBSD: files.fdt,v 1.2 2015/12/14 20:58:45 jmcneill Exp $
include "external/bsd/libfdt/conf/files.libfdt"
@@ -18,5 +18,9 @@ device fregulator
attach fregulator at fdt
file dev/fdt/fixedregulator.c fregulator
+device gpiokeys
+attach gpiokeys at fdt
+file dev/fdt/gpiokeys.c gpiokeys
+
file dev/fdt/fdt_openfirm.c fdtbus
file dev/fdt/fdt_subr.c fdtbus
Added files:
Index: src/sys/dev/fdt/gpiokeys.c
diff -u /dev/null src/sys/dev/fdt/gpiokeys.c:1.1
--- /dev/null Mon Dec 14 20:58:45 2015
+++ src/sys/dev/fdt/gpiokeys.c Mon Dec 14 20:58:45 2015
@@ -0,0 +1,207 @@
+/* $NetBSD: gpiokeys.c,v 1.1 2015/12/14 20:58:45 jmcneill Exp $ */
+
+/*-
+ * Copyright (c) 2015 Jared D. McNeill <[email protected]>
+ * 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 ``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 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.
+ */
+
+#include <sys/cdefs.h>
+__KERNEL_RCSID(0, "$NetBSD: gpiokeys.c,v 1.1 2015/12/14 20:58:45 jmcneill Exp $");
+
+#include <sys/param.h>
+#include <sys/kernel.h>
+#include <sys/systm.h>
+#include <sys/device.h>
+#include <sys/kmem.h>
+#include <sys/bus.h>
+#include <sys/gpio.h>
+
+#include <dev/sysmon/sysmonvar.h>
+#include <dev/sysmon/sysmon_taskq.h>
+
+#include <dev/fdt/fdtvar.h>
+
+#define GPIOKEYS_POLL_INTERVAL mstohz(200)
+
+#define KEY_POWER 116
+#define KEY_SLEEP 142
+
+static int gpiokeys_match(device_t, cfdata_t, void *);
+static void gpiokeys_attach(device_t, device_t, void *);
+
+static void gpiokeys_tick(void *);
+static void gpiokeys_task(void *);
+
+struct gpiokeys_softc;
+
+struct gpiokeys_key {
+ int key_phandle;
+ char *key_label;
+ struct fdtbus_gpio_pin *key_pin;
+ u_int key_debounce;
+ u_int key_code;
+ struct sysmon_pswitch key_pswitch;
+ u_int key_state;
+
+ struct gpiokeys_key *key_next;
+};
+
+struct gpiokeys_softc {
+ device_t sc_dev;
+ int sc_phandle;
+
+ struct fdtbus_gpio_pin *sc_pin;
+ bool sc_always_on;
+ bool sc_enable_val;
+
+ struct gpiokeys_key *sc_keys;
+ callout_t sc_tick;
+};
+
+CFATTACH_DECL_NEW(gpiokeys, sizeof(struct gpiokeys_softc),
+ gpiokeys_match, gpiokeys_attach, NULL, NULL);
+
+static int
+gpiokeys_match(device_t parent, cfdata_t cf, void *aux)
+{
+ const char * const compatible[] = { "gpio-keys", NULL };
+ const struct fdt_attach_args *faa = aux;
+
+ return of_match_compatible(faa->faa_phandle, compatible);
+}
+
+static void
+gpiokeys_attach(device_t parent, device_t self, void *aux)
+{
+ struct gpiokeys_softc * const sc = device_private(self);
+ const struct fdt_attach_args *faa = aux;
+ const int phandle = faa->faa_phandle;
+ struct gpiokeys_key *key;
+ int child, len;
+ u_int debounce, code;
+
+ sc->sc_dev = self;
+ sc->sc_phandle = phandle;
+
+ aprint_naive("\n");
+ aprint_normal(":");
+
+ for (child = OF_child(phandle); child; child = OF_peer(child)) {
+ len = OF_getprop(child, "linux,code", &code, sizeof(code));
+ if (len != sizeof(code)) {
+ continue;
+ }
+ code = be32toh(code);
+ len = OF_getproplen(child, "label");
+ if (len <= 0) {
+ continue;
+ }
+ key = kmem_zalloc(sizeof(*key), KM_SLEEP);
+ key->key_phandle = child;
+ key->key_code = code;
+ key->key_label = kmem_zalloc(len, KM_SLEEP);
+ if (OF_getprop(child, "label", key->key_label, len) != len) {
+ kmem_free(key->key_label, len);
+ kmem_free(key, sizeof(*key));
+ continue;
+ }
+ if (OF_getprop(child, "debounce-interval", &debounce,
+ sizeof(debounce)) == sizeof(debounce)) {
+ key->key_debounce = be32toh(debounce);
+ } else {
+ key->key_debounce = 5; /* default */
+ }
+ key->key_pin = fdtbus_gpio_acquire(child, "gpios",
+ GPIO_PIN_INPUT);
+
+ key->key_pswitch.smpsw_name = key->key_label;
+ switch (code) {
+ case KEY_POWER:
+ key->key_pswitch.smpsw_type = PSWITCH_TYPE_POWER;
+ break;
+ case KEY_SLEEP:
+ key->key_pswitch.smpsw_type = PSWITCH_TYPE_SLEEP;
+ break;
+ default:
+ key->key_pswitch.smpsw_type = PSWITCH_TYPE_HOTKEY;
+ break;
+ }
+
+ if (sysmon_pswitch_register(&key->key_pswitch) != 0) {
+ aprint_error(" %s:ERROR", key->key_label);
+ kmem_free(key->key_label, len);
+ kmem_free(key, sizeof(*key));
+ continue;
+ }
+
+ if (sc->sc_keys) {
+ aprint_normal(", %s", key->key_label);
+ } else {
+ aprint_normal(" %s", key->key_label);
+ }
+
+ key->key_next = sc->sc_keys;
+ sc->sc_keys = key;
+ }
+
+ if (sc->sc_keys == NULL) {
+ aprint_normal(" no keys configured\n");
+ return;
+ }
+
+ aprint_normal("\n");
+
+ callout_init(&sc->sc_tick, CALLOUT_MPSAFE);
+ callout_setfunc(&sc->sc_tick, gpiokeys_tick, sc);
+
+ gpiokeys_tick(sc);
+}
+
+static void
+gpiokeys_tick(void *priv)
+{
+ struct gpiokeys_softc * const sc = priv;
+ struct gpiokeys_key *key;
+
+ for (key = sc->sc_keys; key; key = key->key_next) {
+ if (key->key_pin == NULL) {
+ continue;
+ }
+ const int new_state = fdtbus_gpio_read(key->key_pin);
+ if (new_state != key->key_state) {
+ key->key_state = new_state;
+ sysmon_task_queue_sched(0, gpiokeys_task, key);
+ }
+ }
+ callout_schedule(&sc->sc_tick, GPIOKEYS_POLL_INTERVAL);
+}
+
+static void
+gpiokeys_task(void *priv)
+{
+ struct gpiokeys_key *key = priv;
+
+ sysmon_pswitch_event(&key->key_pswitch,
+ key->key_state ? PSWITCH_EVENT_PRESSED : PSWITCH_EVENT_RELEASED);
+}
