/* $NetBSD: gpiokeys.c,v 1.8 2018/05/10 13:05:18 jmcneill Exp $ */ /*- * Copyright (c) 2015 Jared D. McNeill * 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 __KERNEL_RCSID(0, "$NetBSD: gpiokeys.c,v 1.8 2018/05/10 13:05:18 jmcneill Exp $"); #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #define GPIOKEYS_POLL_INTERVAL mstohz(200) /* Event types */ #define EV_KEY 1 #define EV_SW 5 /* Key and button events */ #define KEY_POWER 116 #define KEY_SLEEP 142 /* Switch events */ #define SW_LID 0 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 *); extern const struct wscons_keydesc hidkbd_keydesctab[]; static const struct wskbd_mapdata gpiokeys_keymapdata = { hidkbd_keydesctab, KB_US, }; struct gpiokeys_softc; struct gpiokeys_key { struct gpiokeys_softc *key_sc; 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; uint8_t key_usbcode; 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; device_t sc_wskbddev; int sc_enabled; }; CFATTACH_DECL_NEW(gpiokeys, sizeof(struct gpiokeys_softc), gpiokeys_match, gpiokeys_attach, NULL, NULL); static int gpiokeys_enable(void *v, int on) { struct gpiokeys_softc * const sc = v; sc->sc_enabled = on; return 0; } static void gpiokeys_set_leds(void *v, int leds) { } static int gpiokeys_ioctl(void *v, u_long cmd, void *data, int flag, lwp_t *l) { switch (cmd) { case WSKBDIO_GTYPE: *(int *)data = WSKBD_TYPE_USB; return 0; } return EPASSTHROUGH; } static const struct wskbd_accessops gpiokeys_accessops = { .enable = gpiokeys_enable, .set_leds = gpiokeys_set_leds, .ioctl = gpiokeys_ioctl }; 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; u_int debounce, input_type, code; int use_wskbddev = 0; int child, len; sc->sc_dev = self; sc->sc_phandle = phandle; aprint_naive("\n"); aprint_normal(":"); for (child = OF_child(phandle); child; child = OF_peer(child)) { if (of_getprop_uint32(child, "linux,input-type", &input_type)) input_type = EV_KEY; /* default */ if (of_getprop_uint32(child, "linux,code", &code)) continue; if (of_getprop_uint32(child, "debounce-interval", &debounce)) debounce = 5; /* default */ len = OF_getproplen(child, "label"); if (len <= 0) { continue; } key = kmem_zalloc(sizeof(*key), KM_SLEEP); key->key_sc = sc; 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; } key->key_debounce = debounce; key->key_pin = fdtbus_gpio_acquire(child, "gpios", GPIO_PIN_INPUT); if (key->key_pin) key->key_state = fdtbus_gpio_read(key->key_pin); switch (input_type) { case EV_KEY: switch (code) { case KEY_POWER: key->key_pswitch.smpsw_name = key->key_label; key->key_pswitch.smpsw_type = PSWITCH_TYPE_POWER; break; case KEY_SLEEP: key->key_pswitch.smpsw_name = key->key_label; key->key_pswitch.smpsw_type = PSWITCH_TYPE_SLEEP; break; default: key->key_usbcode = linux_key_to_usb(code); if (key->key_usbcode != 0) { use_wskbddev++; } else { key->key_pswitch.smpsw_name = key->key_label; key->key_pswitch.smpsw_type = PSWITCH_TYPE_HOTKEY; } break; } break; case EV_SW: key->key_pswitch.smpsw_name = key->key_label; switch (code) { case SW_LID: key->key_state = -1; /* Send notification on attach */ key->key_pswitch.smpsw_type = PSWITCH_TYPE_LID; break; default: key->key_pswitch.smpsw_type = PSWITCH_TYPE_HOTKEY; break; } break; } if (key->key_pswitch.smpsw_name != NULL && 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"); if (use_wskbddev > 0) { struct wskbddev_attach_args a; memset(&a, 0, sizeof(a)); a.console = false; a.keymap = &gpiokeys_keymapdata; a.accessops = &gpiokeys_accessops; a.accesscookie = sc; sc->sc_wskbddev = config_found_ia(self, "wskbddev", &a, wskbddevprint); } 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; struct gpiokeys_softc *sc = key->key_sc; if (key->key_pswitch.smpsw_name) { sysmon_pswitch_event(&key->key_pswitch, key->key_state ? PSWITCH_EVENT_PRESSED : PSWITCH_EVENT_RELEASED); } else if (sc->sc_enabled && sc->sc_wskbddev != NULL && key->key_usbcode != 0) { wskbd_input(sc->sc_wskbddev, key->key_state ? WSCONS_EVENT_KEY_DOWN : WSCONS_EVENT_KEY_UP, key->key_usbcode); } }