gpiokeys.c revision 1.5.2.2
1 1.5.2.2 jdolecek /* $NetBSD: gpiokeys.c,v 1.5.2.2 2017/12/03 11:37:01 jdolecek Exp $ */ 2 1.5.2.2 jdolecek 3 1.5.2.2 jdolecek /*- 4 1.5.2.2 jdolecek * Copyright (c) 2015 Jared D. McNeill <jmcneill (at) invisible.ca> 5 1.5.2.2 jdolecek * All rights reserved. 6 1.5.2.2 jdolecek * 7 1.5.2.2 jdolecek * Redistribution and use in source and binary forms, with or without 8 1.5.2.2 jdolecek * modification, are permitted provided that the following conditions 9 1.5.2.2 jdolecek * are met: 10 1.5.2.2 jdolecek * 1. Redistributions of source code must retain the above copyright 11 1.5.2.2 jdolecek * notice, this list of conditions and the following disclaimer. 12 1.5.2.2 jdolecek * 2. Redistributions in binary form must reproduce the above copyright 13 1.5.2.2 jdolecek * notice, this list of conditions and the following disclaimer in the 14 1.5.2.2 jdolecek * documentation and/or other materials provided with the distribution. 15 1.5.2.2 jdolecek * 16 1.5.2.2 jdolecek * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 17 1.5.2.2 jdolecek * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 18 1.5.2.2 jdolecek * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 19 1.5.2.2 jdolecek * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 20 1.5.2.2 jdolecek * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 21 1.5.2.2 jdolecek * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 22 1.5.2.2 jdolecek * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 23 1.5.2.2 jdolecek * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 24 1.5.2.2 jdolecek * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25 1.5.2.2 jdolecek * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26 1.5.2.2 jdolecek * SUCH DAMAGE. 27 1.5.2.2 jdolecek */ 28 1.5.2.2 jdolecek 29 1.5.2.2 jdolecek #include <sys/cdefs.h> 30 1.5.2.2 jdolecek __KERNEL_RCSID(0, "$NetBSD: gpiokeys.c,v 1.5.2.2 2017/12/03 11:37:01 jdolecek Exp $"); 31 1.5.2.2 jdolecek 32 1.5.2.2 jdolecek #include <sys/param.h> 33 1.5.2.2 jdolecek #include <sys/kernel.h> 34 1.5.2.2 jdolecek #include <sys/systm.h> 35 1.5.2.2 jdolecek #include <sys/device.h> 36 1.5.2.2 jdolecek #include <sys/kmem.h> 37 1.5.2.2 jdolecek #include <sys/bus.h> 38 1.5.2.2 jdolecek #include <sys/gpio.h> 39 1.5.2.2 jdolecek 40 1.5.2.2 jdolecek #include <dev/sysmon/sysmonvar.h> 41 1.5.2.2 jdolecek #include <dev/sysmon/sysmon_taskq.h> 42 1.5.2.2 jdolecek 43 1.5.2.2 jdolecek #include <dev/wscons/wsconsio.h> 44 1.5.2.2 jdolecek #include <dev/wscons/wskbdvar.h> 45 1.5.2.2 jdolecek #include <dev/wscons/wsksymdef.h> 46 1.5.2.2 jdolecek #include <dev/wscons/wsksymvar.h> 47 1.5.2.2 jdolecek #include <dev/wscons/linux_keymap.h> 48 1.5.2.2 jdolecek 49 1.5.2.2 jdolecek #include <dev/fdt/fdtvar.h> 50 1.5.2.2 jdolecek 51 1.5.2.2 jdolecek #define GPIOKEYS_POLL_INTERVAL mstohz(200) 52 1.5.2.2 jdolecek 53 1.5.2.2 jdolecek #define KEY_POWER 116 54 1.5.2.2 jdolecek #define KEY_SLEEP 142 55 1.5.2.2 jdolecek 56 1.5.2.2 jdolecek static int gpiokeys_match(device_t, cfdata_t, void *); 57 1.5.2.2 jdolecek static void gpiokeys_attach(device_t, device_t, void *); 58 1.5.2.2 jdolecek 59 1.5.2.2 jdolecek static void gpiokeys_tick(void *); 60 1.5.2.2 jdolecek static void gpiokeys_task(void *); 61 1.5.2.2 jdolecek 62 1.5.2.2 jdolecek extern const struct wscons_keydesc ukbd_keydesctab[]; 63 1.5.2.2 jdolecek static const struct wskbd_mapdata gpiokeys_keymapdata = { 64 1.5.2.2 jdolecek ukbd_keydesctab, 65 1.5.2.2 jdolecek KB_US, 66 1.5.2.2 jdolecek }; 67 1.5.2.2 jdolecek 68 1.5.2.2 jdolecek struct gpiokeys_softc; 69 1.5.2.2 jdolecek 70 1.5.2.2 jdolecek struct gpiokeys_key { 71 1.5.2.2 jdolecek struct gpiokeys_softc *key_sc; 72 1.5.2.2 jdolecek int key_phandle; 73 1.5.2.2 jdolecek char *key_label; 74 1.5.2.2 jdolecek struct fdtbus_gpio_pin *key_pin; 75 1.5.2.2 jdolecek u_int key_debounce; 76 1.5.2.2 jdolecek u_int key_code; 77 1.5.2.2 jdolecek struct sysmon_pswitch key_pswitch; 78 1.5.2.2 jdolecek uint8_t key_usbcode; 79 1.5.2.2 jdolecek u_int key_state; 80 1.5.2.2 jdolecek 81 1.5.2.2 jdolecek struct gpiokeys_key *key_next; 82 1.5.2.2 jdolecek }; 83 1.5.2.2 jdolecek 84 1.5.2.2 jdolecek struct gpiokeys_softc { 85 1.5.2.2 jdolecek device_t sc_dev; 86 1.5.2.2 jdolecek int sc_phandle; 87 1.5.2.2 jdolecek 88 1.5.2.2 jdolecek struct fdtbus_gpio_pin *sc_pin; 89 1.5.2.2 jdolecek bool sc_always_on; 90 1.5.2.2 jdolecek bool sc_enable_val; 91 1.5.2.2 jdolecek 92 1.5.2.2 jdolecek struct gpiokeys_key *sc_keys; 93 1.5.2.2 jdolecek callout_t sc_tick; 94 1.5.2.2 jdolecek 95 1.5.2.2 jdolecek device_t sc_wskbddev; 96 1.5.2.2 jdolecek int sc_enabled; 97 1.5.2.2 jdolecek }; 98 1.5.2.2 jdolecek 99 1.5.2.2 jdolecek CFATTACH_DECL_NEW(gpiokeys, sizeof(struct gpiokeys_softc), 100 1.5.2.2 jdolecek gpiokeys_match, gpiokeys_attach, NULL, NULL); 101 1.5.2.2 jdolecek 102 1.5.2.2 jdolecek static int 103 1.5.2.2 jdolecek gpiokeys_enable(void *v, int on) 104 1.5.2.2 jdolecek { 105 1.5.2.2 jdolecek struct gpiokeys_softc * const sc = v; 106 1.5.2.2 jdolecek 107 1.5.2.2 jdolecek sc->sc_enabled = on; 108 1.5.2.2 jdolecek 109 1.5.2.2 jdolecek return 0; 110 1.5.2.2 jdolecek } 111 1.5.2.2 jdolecek 112 1.5.2.2 jdolecek static void 113 1.5.2.2 jdolecek gpiokeys_set_leds(void *v, int leds) 114 1.5.2.2 jdolecek { 115 1.5.2.2 jdolecek } 116 1.5.2.2 jdolecek 117 1.5.2.2 jdolecek static int 118 1.5.2.2 jdolecek gpiokeys_ioctl(void *v, u_long cmd, void *data, int flag, lwp_t *l) 119 1.5.2.2 jdolecek { 120 1.5.2.2 jdolecek switch (cmd) { 121 1.5.2.2 jdolecek case WSKBDIO_GTYPE: 122 1.5.2.2 jdolecek *(int *)data = WSKBD_TYPE_USB; 123 1.5.2.2 jdolecek return 0; 124 1.5.2.2 jdolecek } 125 1.5.2.2 jdolecek 126 1.5.2.2 jdolecek return EPASSTHROUGH; 127 1.5.2.2 jdolecek } 128 1.5.2.2 jdolecek 129 1.5.2.2 jdolecek static const struct wskbd_accessops gpiokeys_accessops = { 130 1.5.2.2 jdolecek .enable = gpiokeys_enable, 131 1.5.2.2 jdolecek .set_leds = gpiokeys_set_leds, 132 1.5.2.2 jdolecek .ioctl = gpiokeys_ioctl 133 1.5.2.2 jdolecek }; 134 1.5.2.2 jdolecek 135 1.5.2.2 jdolecek static int 136 1.5.2.2 jdolecek gpiokeys_match(device_t parent, cfdata_t cf, void *aux) 137 1.5.2.2 jdolecek { 138 1.5.2.2 jdolecek const char * const compatible[] = { "gpio-keys", NULL }; 139 1.5.2.2 jdolecek const struct fdt_attach_args *faa = aux; 140 1.5.2.2 jdolecek 141 1.5.2.2 jdolecek return of_match_compatible(faa->faa_phandle, compatible); 142 1.5.2.2 jdolecek } 143 1.5.2.2 jdolecek 144 1.5.2.2 jdolecek static void 145 1.5.2.2 jdolecek gpiokeys_attach(device_t parent, device_t self, void *aux) 146 1.5.2.2 jdolecek { 147 1.5.2.2 jdolecek struct gpiokeys_softc * const sc = device_private(self); 148 1.5.2.2 jdolecek const struct fdt_attach_args *faa = aux; 149 1.5.2.2 jdolecek const int phandle = faa->faa_phandle; 150 1.5.2.2 jdolecek struct gpiokeys_key *key; 151 1.5.2.2 jdolecek u_int debounce, code; 152 1.5.2.2 jdolecek int use_wskbddev = 0; 153 1.5.2.2 jdolecek int child, len; 154 1.5.2.2 jdolecek 155 1.5.2.2 jdolecek sc->sc_dev = self; 156 1.5.2.2 jdolecek sc->sc_phandle = phandle; 157 1.5.2.2 jdolecek 158 1.5.2.2 jdolecek aprint_naive("\n"); 159 1.5.2.2 jdolecek aprint_normal(":"); 160 1.5.2.2 jdolecek 161 1.5.2.2 jdolecek for (child = OF_child(phandle); child; child = OF_peer(child)) { 162 1.5.2.2 jdolecek if (of_getprop_uint32(child, "linux,code", &code)) 163 1.5.2.2 jdolecek continue; 164 1.5.2.2 jdolecek if (of_getprop_uint32(child, "debounce-interval", &debounce)) 165 1.5.2.2 jdolecek debounce = 5; /* default */ 166 1.5.2.2 jdolecek len = OF_getproplen(child, "label"); 167 1.5.2.2 jdolecek if (len <= 0) { 168 1.5.2.2 jdolecek continue; 169 1.5.2.2 jdolecek } 170 1.5.2.2 jdolecek key = kmem_zalloc(sizeof(*key), KM_SLEEP); 171 1.5.2.2 jdolecek key->key_sc = sc; 172 1.5.2.2 jdolecek key->key_phandle = child; 173 1.5.2.2 jdolecek key->key_code = code; 174 1.5.2.2 jdolecek key->key_label = kmem_zalloc(len, KM_SLEEP); 175 1.5.2.2 jdolecek if (OF_getprop(child, "label", key->key_label, len) != len) { 176 1.5.2.2 jdolecek kmem_free(key->key_label, len); 177 1.5.2.2 jdolecek kmem_free(key, sizeof(*key)); 178 1.5.2.2 jdolecek continue; 179 1.5.2.2 jdolecek } 180 1.5.2.2 jdolecek key->key_debounce = debounce; 181 1.5.2.2 jdolecek key->key_pin = fdtbus_gpio_acquire(child, "gpios", 182 1.5.2.2 jdolecek GPIO_PIN_INPUT); 183 1.5.2.2 jdolecek if (key->key_pin) 184 1.5.2.2 jdolecek key->key_state = fdtbus_gpio_read(key->key_pin); 185 1.5.2.2 jdolecek 186 1.5.2.2 jdolecek switch (code) { 187 1.5.2.2 jdolecek case KEY_POWER: 188 1.5.2.2 jdolecek key->key_pswitch.smpsw_name = key->key_label; 189 1.5.2.2 jdolecek key->key_pswitch.smpsw_type = PSWITCH_TYPE_POWER; 190 1.5.2.2 jdolecek break; 191 1.5.2.2 jdolecek case KEY_SLEEP: 192 1.5.2.2 jdolecek key->key_pswitch.smpsw_name = key->key_label; 193 1.5.2.2 jdolecek key->key_pswitch.smpsw_type = PSWITCH_TYPE_SLEEP; 194 1.5.2.2 jdolecek break; 195 1.5.2.2 jdolecek default: 196 1.5.2.2 jdolecek key->key_usbcode = linux_key_to_usb(code); 197 1.5.2.2 jdolecek if (key->key_usbcode != 0) { 198 1.5.2.2 jdolecek use_wskbddev++; 199 1.5.2.2 jdolecek } else { 200 1.5.2.2 jdolecek key->key_pswitch.smpsw_name = key->key_label; 201 1.5.2.2 jdolecek key->key_pswitch.smpsw_type = PSWITCH_TYPE_HOTKEY; 202 1.5.2.2 jdolecek } 203 1.5.2.2 jdolecek break; 204 1.5.2.2 jdolecek } 205 1.5.2.2 jdolecek 206 1.5.2.2 jdolecek if (key->key_pswitch.smpsw_name != NULL && 207 1.5.2.2 jdolecek sysmon_pswitch_register(&key->key_pswitch) != 0) { 208 1.5.2.2 jdolecek aprint_error(" %s:ERROR", key->key_label); 209 1.5.2.2 jdolecek kmem_free(key->key_label, len); 210 1.5.2.2 jdolecek kmem_free(key, sizeof(*key)); 211 1.5.2.2 jdolecek continue; 212 1.5.2.2 jdolecek } 213 1.5.2.2 jdolecek 214 1.5.2.2 jdolecek if (sc->sc_keys) { 215 1.5.2.2 jdolecek aprint_normal(", %s", key->key_label); 216 1.5.2.2 jdolecek } else { 217 1.5.2.2 jdolecek aprint_normal(" %s", key->key_label); 218 1.5.2.2 jdolecek } 219 1.5.2.2 jdolecek 220 1.5.2.2 jdolecek key->key_next = sc->sc_keys; 221 1.5.2.2 jdolecek sc->sc_keys = key; 222 1.5.2.2 jdolecek } 223 1.5.2.2 jdolecek 224 1.5.2.2 jdolecek if (sc->sc_keys == NULL) { 225 1.5.2.2 jdolecek aprint_normal(" no keys configured\n"); 226 1.5.2.2 jdolecek return; 227 1.5.2.2 jdolecek } 228 1.5.2.2 jdolecek 229 1.5.2.2 jdolecek aprint_normal("\n"); 230 1.5.2.2 jdolecek 231 1.5.2.2 jdolecek if (use_wskbddev > 0) { 232 1.5.2.2 jdolecek struct wskbddev_attach_args a; 233 1.5.2.2 jdolecek memset(&a, 0, sizeof(a)); 234 1.5.2.2 jdolecek a.console = false; 235 1.5.2.2 jdolecek a.keymap = &gpiokeys_keymapdata; 236 1.5.2.2 jdolecek a.accessops = &gpiokeys_accessops; 237 1.5.2.2 jdolecek a.accesscookie = sc; 238 1.5.2.2 jdolecek sc->sc_wskbddev = config_found_ia(self, "wskbddev", &a, 239 1.5.2.2 jdolecek wskbddevprint); 240 1.5.2.2 jdolecek } 241 1.5.2.2 jdolecek 242 1.5.2.2 jdolecek callout_init(&sc->sc_tick, CALLOUT_MPSAFE); 243 1.5.2.2 jdolecek callout_setfunc(&sc->sc_tick, gpiokeys_tick, sc); 244 1.5.2.2 jdolecek 245 1.5.2.2 jdolecek gpiokeys_tick(sc); 246 1.5.2.2 jdolecek } 247 1.5.2.2 jdolecek 248 1.5.2.2 jdolecek static void 249 1.5.2.2 jdolecek gpiokeys_tick(void *priv) 250 1.5.2.2 jdolecek { 251 1.5.2.2 jdolecek struct gpiokeys_softc * const sc = priv; 252 1.5.2.2 jdolecek struct gpiokeys_key *key; 253 1.5.2.2 jdolecek 254 1.5.2.2 jdolecek for (key = sc->sc_keys; key; key = key->key_next) { 255 1.5.2.2 jdolecek if (key->key_pin == NULL) { 256 1.5.2.2 jdolecek continue; 257 1.5.2.2 jdolecek } 258 1.5.2.2 jdolecek const int new_state = fdtbus_gpio_read(key->key_pin); 259 1.5.2.2 jdolecek if (new_state != key->key_state) { 260 1.5.2.2 jdolecek key->key_state = new_state; 261 1.5.2.2 jdolecek sysmon_task_queue_sched(0, gpiokeys_task, key); 262 1.5.2.2 jdolecek } 263 1.5.2.2 jdolecek } 264 1.5.2.2 jdolecek callout_schedule(&sc->sc_tick, GPIOKEYS_POLL_INTERVAL); 265 1.5.2.2 jdolecek } 266 1.5.2.2 jdolecek 267 1.5.2.2 jdolecek static void 268 1.5.2.2 jdolecek gpiokeys_task(void *priv) 269 1.5.2.2 jdolecek { 270 1.5.2.2 jdolecek struct gpiokeys_key *key = priv; 271 1.5.2.2 jdolecek struct gpiokeys_softc *sc = key->key_sc; 272 1.5.2.2 jdolecek 273 1.5.2.2 jdolecek if (key->key_pswitch.smpsw_name) { 274 1.5.2.2 jdolecek sysmon_pswitch_event(&key->key_pswitch, 275 1.5.2.2 jdolecek key->key_state ? PSWITCH_EVENT_PRESSED : PSWITCH_EVENT_RELEASED); 276 1.5.2.2 jdolecek } else if (sc->sc_enabled && sc->sc_wskbddev != NULL && key->key_usbcode != 0) { 277 1.5.2.2 jdolecek wskbd_input(sc->sc_wskbddev, 278 1.5.2.2 jdolecek key->key_state ? WSCONS_EVENT_KEY_DOWN : WSCONS_EVENT_KEY_UP, 279 1.5.2.2 jdolecek key->key_usbcode); 280 1.5.2.2 jdolecek } 281 1.5.2.2 jdolecek } 282
Indexes created Fri Oct 03 02:09:57 GMT 2025