Home | History | Annotate | Line # | Download | only in dev
      1  1.6  thorpej /*	$NetBSD: wzero3_keypad.c,v 1.6 2021/08/07 16:18:53 thorpej Exp $	*/
      2  1.1   nonaka 
      3  1.3   nonaka /*-
      4  1.3   nonaka  * Copyright (C) 2010 NONAKA Kimihiro <nonaka (at) netbsd.org>
      5  1.1   nonaka  * All rights reserved.
      6  1.1   nonaka  *
      7  1.1   nonaka  * Redistribution and use in source and binary forms, with or without
      8  1.1   nonaka  * modification, are permitted provided that the following conditions
      9  1.1   nonaka  * are met:
     10  1.1   nonaka  * 1. Redistributions of source code must retain the above copyright
     11  1.1   nonaka  *    notice, this list of conditions and the following disclaimer.
     12  1.1   nonaka  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1   nonaka  *    notice, this list of conditions and the following disclaimer in the
     14  1.1   nonaka  *    documentation and/or other materials provided with the distribution.
     15  1.1   nonaka  *
     16  1.3   nonaka  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     17  1.3   nonaka  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     18  1.3   nonaka  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     19  1.3   nonaka  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     20  1.3   nonaka  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     21  1.3   nonaka  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     22  1.3   nonaka  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     23  1.3   nonaka  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     24  1.3   nonaka  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     25  1.3   nonaka  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     26  1.1   nonaka  */
     27  1.1   nonaka 
     28  1.1   nonaka #include <sys/cdefs.h>
     29  1.6  thorpej __KERNEL_RCSID(0, "$NetBSD: wzero3_keypad.c,v 1.6 2021/08/07 16:18:53 thorpej Exp $");
     30  1.1   nonaka 
     31  1.1   nonaka #include "wzero3lcd.h"
     32  1.1   nonaka #include "opt_wsdisplay_compat.h"
     33  1.1   nonaka 
     34  1.1   nonaka #include <sys/param.h>
     35  1.1   nonaka #include <sys/systm.h>
     36  1.1   nonaka #include <sys/device.h>
     37  1.1   nonaka #include <sys/kernel.h>
     38  1.1   nonaka #include <sys/callout.h>
     39  1.2   dyoung #include <sys/bus.h>
     40  1.1   nonaka 
     41  1.1   nonaka #include <arm/xscale/pxa2x0cpu.h>
     42  1.1   nonaka #include <arm/xscale/pxa2x0var.h>
     43  1.1   nonaka #include <arm/xscale/pxa2x0_gpio.h>
     44  1.1   nonaka 
     45  1.1   nonaka #include <machine/bootinfo.h>
     46  1.1   nonaka #include <machine/config_hook.h>
     47  1.1   nonaka #include <machine/platid.h>
     48  1.1   nonaka #include <machine/platid_mask.h>
     49  1.1   nonaka 
     50  1.1   nonaka #include <dev/wscons/wsconsio.h>
     51  1.1   nonaka #include <dev/wscons/wskbdvar.h>
     52  1.1   nonaka #include <dev/wscons/wsksymvar.h>
     53  1.1   nonaka #include <dev/wscons/wsksymdef.h>
     54  1.1   nonaka 
     55  1.1   nonaka #ifdef WSDISPLAY_COMPAT_RAWKBD
     56  1.1   nonaka #include <dev/hpc/pckbd_encode.h>
     57  1.1   nonaka #endif
     58  1.1   nonaka 
     59  1.1   nonaka #include <arch/hpcarm/dev/wzero3_reg.h>
     60  1.1   nonaka #include <arch/hpcarm/dev/wzero3_sspvar.h>
     61  1.1   nonaka 
     62  1.1   nonaka enum {
     63  1.1   nonaka 	KD_0,
     64  1.1   nonaka 	KD_1,
     65  1.1   nonaka 	KD_2,
     66  1.1   nonaka 	KD_3,
     67  1.1   nonaka 	KD_4,
     68  1.1   nonaka 	KD_5,
     69  1.1   nonaka 	KD_6,
     70  1.1   nonaka 	KD_7,
     71  1.1   nonaka 	KD_8,
     72  1.1   nonaka 	KD_9,
     73  1.1   nonaka 	KD_ASTERISK,
     74  1.1   nonaka 	KD_NUMBER,
     75  1.1   nonaka 	KD_WINDOWS,
     76  1.1   nonaka 	KD_OK,
     77  1.1   nonaka 	KD_ONHOOK,
     78  1.1   nonaka 	KD_OFFHOOK,
     79  1.1   nonaka 	KD_CLEAR,
     80  1.1   nonaka 	KD_MOJI,
     81  1.1   nonaka 	KD_UP,
     82  1.1   nonaka 	KD_DOWN,
     83  1.1   nonaka 	KD_LEFT,
     84  1.1   nonaka 	KD_RIGHT,
     85  1.1   nonaka 	KD_CENTER_BUTTON,
     86  1.1   nonaka 	KD_LSOFT,
     87  1.1   nonaka 	KD_RSOFT,
     88  1.1   nonaka 	KD_NUM,
     89  1.1   nonaka 
     90  1.1   nonaka 	KD_INVALID = -1
     91  1.1   nonaka };
     92  1.1   nonaka 
     93  1.1   nonaka static int ws011sh_keyscan2keydown[32] = {
     94  1.1   nonaka 	KD_INVALID,
     95  1.1   nonaka 	KD_CLEAR,
     96  1.1   nonaka 	KD_INVALID,
     97  1.1   nonaka 	KD_OK,
     98  1.1   nonaka 	KD_INVALID,
     99  1.1   nonaka 	KD_LEFT,
    100  1.1   nonaka 	KD_INVALID,
    101  1.1   nonaka 	KD_ONHOOK,
    102  1.1   nonaka 	KD_INVALID,
    103  1.1   nonaka 	KD_UP,
    104  1.1   nonaka 	KD_DOWN,
    105  1.1   nonaka 	KD_MOJI,
    106  1.1   nonaka 	KD_INVALID,
    107  1.1   nonaka 	KD_WINDOWS,
    108  1.1   nonaka 	KD_INVALID,
    109  1.1   nonaka 	KD_RIGHT,
    110  1.1   nonaka 	KD_INVALID,
    111  1.1   nonaka 	KD_1,
    112  1.1   nonaka 	KD_4,
    113  1.1   nonaka 	KD_7,
    114  1.1   nonaka 	KD_ASTERISK,
    115  1.1   nonaka 	KD_2,
    116  1.1   nonaka 	KD_5,
    117  1.1   nonaka 	KD_8,
    118  1.1   nonaka 	KD_0,
    119  1.1   nonaka 	KD_CENTER_BUTTON,
    120  1.1   nonaka 	KD_INVALID,
    121  1.1   nonaka 	KD_3,
    122  1.1   nonaka 	KD_6,
    123  1.1   nonaka 	KD_9,
    124  1.1   nonaka 	KD_NUMBER,
    125  1.1   nonaka 	KD_INVALID,
    126  1.1   nonaka };
    127  1.1   nonaka 
    128  1.1   nonaka struct wzero3keypad_softc {
    129  1.1   nonaka 	device_t sc_dev;
    130  1.1   nonaka 
    131  1.1   nonaka 	void *sc_ih;
    132  1.1   nonaka 	int sc_intr_pin;
    133  1.1   nonaka 
    134  1.1   nonaka 	uint32_t sc_okeystat;
    135  1.1   nonaka 
    136  1.1   nonaka 	struct callout sc_poll_ch;
    137  1.1   nonaka 	int sc_poll_interval;
    138  1.1   nonaka 
    139  1.1   nonaka 	device_t sc_wskbddev;
    140  1.1   nonaka 
    141  1.1   nonaka #ifdef WSDISPLAY_COMPAT_RAWKBD
    142  1.1   nonaka 	int sc_rawkbd;
    143  1.1   nonaka #endif
    144  1.1   nonaka };
    145  1.1   nonaka 
    146  1.1   nonaka static int wzero3keypad_match(device_t, cfdata_t, void *);
    147  1.1   nonaka static void wzero3keypad_attach(device_t, device_t, void *);
    148  1.1   nonaka 
    149  1.1   nonaka CFATTACH_DECL_NEW(wzero3keypad, sizeof(struct wzero3keypad_softc),
    150  1.1   nonaka     wzero3keypad_match, wzero3keypad_attach, NULL, NULL);
    151  1.1   nonaka 
    152  1.1   nonaka static int wzero3keypad_wskbd_enable(void *, int);
    153  1.1   nonaka static void wzero3keypad_wskbd_set_leds(void *, int);
    154  1.1   nonaka static int wzero3keypad_wskbd_ioctl(void *, u_long, void *, int, struct lwp *);
    155  1.1   nonaka 
    156  1.1   nonaka static const int wzero3keypad_wskbd_keys[] = {
    157  1.1   nonaka 	82,	/* KD_0: 0 */
    158  1.1   nonaka 	79,	/* KD_1: 1 */
    159  1.1   nonaka 	80,	/* KD_2: 2 */
    160  1.1   nonaka 	81,	/* KD_3: 3 */
    161  1.1   nonaka 	75,	/* KD_4: 4 */
    162  1.1   nonaka 	76,	/* KD_5: 5 */
    163  1.1   nonaka 	77,	/* KD_6: 6 */
    164  1.1   nonaka 	71,	/* KD_7: 7 */
    165  1.1   nonaka 	72,	/* KD_8: 8 */
    166  1.1   nonaka 	73,	/* KD_9: 9 */
    167  1.1   nonaka 	64,	/* KD_ASTERISK: f6 */
    168  1.1   nonaka 	65,	/* KD_NUMBER: f7 */
    169  1.1   nonaka 	221,	/* KD_WINDOWS: Menu */
    170  1.1   nonaka 	61,	/* KD_OK: f3 */
    171  1.1   nonaka 	59,	/* KD_ONHOOK: f1 */
    172  1.1   nonaka 	60,	/* KD_OFFHOOK: f2 */
    173  1.1   nonaka 	62,	/* KD_CLEAR: f4 */
    174  1.1   nonaka 	63,	/* KD_MOJI: f5 */
    175  1.1   nonaka 	200,	/* KD_UP: Up */
    176  1.1   nonaka 	208,	/* KD_DOWN: Down */
    177  1.1   nonaka 	203,	/* KD_LEFT: Left */
    178  1.1   nonaka 	205,	/* KD_RIGHT: Right */
    179  1.1   nonaka 	156,	/* KD_CENTER_BUTTON: KP_Enter */
    180  1.1   nonaka 	87,	/* KD_LSOFT: f11 */
    181  1.1   nonaka 	88,	/* KD_RSOFT: f12 */
    182  1.1   nonaka };
    183  1.1   nonaka 
    184  1.1   nonaka static const keysym_t wzero3keypad_wskbd_keydesc[] = {
    185  1.1   nonaka 	KS_KEYCODE(59),		KS_f1,
    186  1.1   nonaka 	KS_KEYCODE(60),		KS_f2,
    187  1.1   nonaka 	KS_KEYCODE(61),		KS_f3,
    188  1.1   nonaka 	KS_KEYCODE(62),		KS_f4,
    189  1.1   nonaka 	KS_KEYCODE(63),		KS_f5,
    190  1.1   nonaka 	KS_KEYCODE(64),		KS_f6,
    191  1.1   nonaka 	KS_KEYCODE(65),		KS_f7,
    192  1.1   nonaka 	KS_KEYCODE(71),		KS_7,
    193  1.1   nonaka 	KS_KEYCODE(72),		KS_8,
    194  1.1   nonaka 	KS_KEYCODE(73),		KS_9,
    195  1.1   nonaka 	KS_KEYCODE(75),		KS_4,
    196  1.1   nonaka 	KS_KEYCODE(76),		KS_5,
    197  1.1   nonaka 	KS_KEYCODE(77),		KS_6,
    198  1.1   nonaka 	KS_KEYCODE(79),		KS_1,
    199  1.1   nonaka 	KS_KEYCODE(80),		KS_2,
    200  1.1   nonaka 	KS_KEYCODE(81),		KS_3,
    201  1.1   nonaka 	KS_KEYCODE(82),		KS_0,
    202  1.1   nonaka 	KS_KEYCODE(87),		KS_f11,
    203  1.1   nonaka 	KS_KEYCODE(88),		KS_f12,
    204  1.1   nonaka 	KS_KEYCODE(156),	KS_KP_Enter,
    205  1.1   nonaka 	KS_KEYCODE(200),	KS_Up,
    206  1.1   nonaka 	KS_KEYCODE(203),	KS_Left,
    207  1.1   nonaka 	KS_KEYCODE(205),	KS_Right,
    208  1.1   nonaka 	KS_KEYCODE(208),	KS_Down,
    209  1.1   nonaka 	KS_KEYCODE(221),	KS_Menu,
    210  1.1   nonaka };
    211  1.1   nonaka 
    212  1.1   nonaka static const struct wscons_keydesc wzero3keypad_wskbd_keydesctab[] = {
    213  1.1   nonaka 	{ KB_JP, 0,
    214  1.1   nonaka 	  sizeof(wzero3keypad_wskbd_keydesc) / sizeof(keysym_t),
    215  1.1   nonaka 	  wzero3keypad_wskbd_keydesc
    216  1.1   nonaka 	},
    217  1.1   nonaka 
    218  1.1   nonaka 	{ 0, 0, 0, 0 }
    219  1.1   nonaka };
    220  1.1   nonaka 
    221  1.1   nonaka static const struct wskbd_mapdata wzero3keypad_wskbd_keymapdata = {
    222  1.1   nonaka 	wzero3keypad_wskbd_keydesctab, KB_JP
    223  1.1   nonaka };
    224  1.1   nonaka 
    225  1.1   nonaka static const struct wskbd_accessops wzero3keypad_wskbd_accessops = {
    226  1.1   nonaka 	wzero3keypad_wskbd_enable,
    227  1.1   nonaka 	wzero3keypad_wskbd_set_leds,
    228  1.1   nonaka 	wzero3keypad_wskbd_ioctl,
    229  1.1   nonaka };
    230  1.1   nonaka 
    231  1.1   nonaka static int wzero3keypad_intr(void *);
    232  1.1   nonaka static void wzero3keypad_poll(void *);
    233  1.1   nonaka static void wzero3keypad_poll1(struct wzero3keypad_softc *, int);
    234  1.1   nonaka 
    235  1.1   nonaka static void wzero3keypad_init(struct wzero3keypad_softc *);
    236  1.1   nonaka static uint32_t wzero3keypad_getkeydown(struct wzero3keypad_softc *, int);
    237  1.1   nonaka 
    238  1.1   nonaka static const struct wzero3keypad_model {
    239  1.1   nonaka 	platid_mask_t *platid;
    240  1.1   nonaka 	int intr_pin;
    241  1.1   nonaka } wzero3keypad_table[] = {
    242  1.1   nonaka #if 0
    243  1.1   nonaka 	/* WS007SH */
    244  1.1   nonaka 	{
    245  1.1   nonaka 		&platid_mask_MACH_SHARP_WZERO3_WS007SH,
    246  1.1   nonaka 		-1,	/* XXX */
    247  1.1   nonaka 	},
    248  1.1   nonaka #endif
    249  1.1   nonaka 	/* WS011SH */
    250  1.1   nonaka 	{
    251  1.1   nonaka 		&platid_mask_MACH_SHARP_WZERO3_WS011SH,
    252  1.1   nonaka 		GPIO_WS011SH_KEYPAD,
    253  1.1   nonaka 	},
    254  1.1   nonaka 
    255  1.1   nonaka 	{ NULL, -1, }
    256  1.1   nonaka };
    257  1.1   nonaka 
    258  1.1   nonaka static const struct wzero3keypad_model *
    259  1.1   nonaka wzero3keypad_lookup(void)
    260  1.1   nonaka {
    261  1.1   nonaka 	const struct wzero3keypad_model *model;
    262  1.1   nonaka 
    263  1.1   nonaka 	for (model = wzero3keypad_table; model->platid != NULL; model++) {
    264  1.1   nonaka 		if (platid_match(&platid, model->platid)) {
    265  1.1   nonaka 			return model;
    266  1.1   nonaka 		}
    267  1.1   nonaka 	}
    268  1.1   nonaka 	return NULL;
    269  1.1   nonaka }
    270  1.1   nonaka 
    271  1.1   nonaka static int
    272  1.4      chs wzero3keypad_match(device_t parent, cfdata_t cf, void *aux)
    273  1.1   nonaka {
    274  1.1   nonaka 
    275  1.1   nonaka 	if (strcmp(cf->cf_name, "wzero3keypad") != 0)
    276  1.1   nonaka 		return 0;
    277  1.1   nonaka 	if (wzero3keypad_lookup() == NULL)
    278  1.1   nonaka 		return 0;
    279  1.1   nonaka 	return 1;
    280  1.1   nonaka }
    281  1.1   nonaka 
    282  1.1   nonaka static void
    283  1.4      chs wzero3keypad_attach(device_t parent, device_t self, void *aux)
    284  1.1   nonaka {
    285  1.1   nonaka 	struct wzero3keypad_softc *sc = device_private(self);
    286  1.1   nonaka 	const struct wzero3keypad_model *model;
    287  1.1   nonaka 	struct wskbddev_attach_args wska;
    288  1.1   nonaka #if NWZERO3LCD > 0
    289  1.1   nonaka 	extern int screen_rotate;
    290  1.1   nonaka #endif
    291  1.1   nonaka 
    292  1.1   nonaka 	sc->sc_dev = self;
    293  1.1   nonaka 	sc->sc_okeystat = 0;
    294  1.1   nonaka #ifdef WSDISPLAY_COMPAT_RAWKBD
    295  1.1   nonaka 	sc->sc_rawkbd = 0;
    296  1.1   nonaka #endif
    297  1.1   nonaka 
    298  1.1   nonaka 	model = wzero3keypad_lookup();
    299  1.1   nonaka 	if (model == NULL) {
    300  1.1   nonaka 		aprint_error(": unknown model\n");
    301  1.1   nonaka 		return;
    302  1.1   nonaka 	}
    303  1.1   nonaka 
    304  1.1   nonaka 	aprint_normal(": keypad\n");
    305  1.1   nonaka 	aprint_naive("\n");
    306  1.1   nonaka 
    307  1.1   nonaka 	sc->sc_intr_pin = model->intr_pin;
    308  1.1   nonaka 
    309  1.1   nonaka 	callout_init(&sc->sc_poll_ch, 0);
    310  1.1   nonaka 	callout_setfunc(&sc->sc_poll_ch, wzero3keypad_poll, sc);
    311  1.1   nonaka 	sc->sc_poll_interval = hz / 32;
    312  1.1   nonaka 
    313  1.1   nonaka #if NWZERO3LCD > 0
    314  1.1   nonaka 	switch (screen_rotate) {
    315  1.1   nonaka 	default:
    316  1.1   nonaka 	case 0:
    317  1.1   nonaka 		break;
    318  1.1   nonaka 
    319  1.1   nonaka 	case 270:	/* counter clock-wise */
    320  1.1   nonaka 		ws011sh_keyscan2keydown[5] = KD_UP;
    321  1.1   nonaka 		ws011sh_keyscan2keydown[9] = KD_RIGHT;
    322  1.1   nonaka 		ws011sh_keyscan2keydown[10] = KD_LEFT;
    323  1.1   nonaka 		ws011sh_keyscan2keydown[15] = KD_DOWN;
    324  1.1   nonaka 		break;
    325  1.1   nonaka 	}
    326  1.1   nonaka #endif
    327  1.1   nonaka 
    328  1.1   nonaka 	/* attach wskbd */
    329  1.1   nonaka 	wska.console = 0;
    330  1.1   nonaka 	wska.keymap = &wzero3keypad_wskbd_keymapdata;
    331  1.1   nonaka 	wska.accessops = &wzero3keypad_wskbd_accessops;
    332  1.1   nonaka 	wska.accesscookie = sc;
    333  1.6  thorpej 	sc->sc_wskbddev = config_found(self, &wska, wskbddevprint, CFARGS_NONE);
    334  1.1   nonaka 
    335  1.1   nonaka 	/* setup keypad interrupt */
    336  1.1   nonaka 	pxa2x0_gpio_set_function(sc->sc_intr_pin, GPIO_IN);
    337  1.1   nonaka 	sc->sc_ih = pxa2x0_gpio_intr_establish(sc->sc_intr_pin,
    338  1.1   nonaka 	    IST_EDGE_RISING, IPL_TTY, wzero3keypad_intr, sc);
    339  1.1   nonaka 	if (sc->sc_ih == NULL) {
    340  1.1   nonaka 		aprint_error_dev(sc->sc_dev,
    341  1.1   nonaka 		    "couldn't establish keypad interrupt\n");
    342  1.1   nonaka 	}
    343  1.1   nonaka 
    344  1.1   nonaka 	/* init hardware */
    345  1.1   nonaka 	wzero3keypad_init(sc);
    346  1.1   nonaka }
    347  1.1   nonaka 
    348  1.1   nonaka static int
    349  1.1   nonaka wzero3keypad_wskbd_enable(void *arg, int onoff)
    350  1.1   nonaka {
    351  1.1   nonaka 
    352  1.1   nonaka 	return 0;
    353  1.1   nonaka }
    354  1.1   nonaka 
    355  1.1   nonaka static void
    356  1.1   nonaka wzero3keypad_wskbd_set_leds(void *arg, int leds)
    357  1.1   nonaka {
    358  1.1   nonaka 
    359  1.1   nonaka 	/* Nothing to do */
    360  1.1   nonaka }
    361  1.1   nonaka 
    362  1.1   nonaka static int
    363  1.1   nonaka wzero3keypad_wskbd_ioctl(void *arg, u_long cmd, void *data, int flags,
    364  1.1   nonaka     struct lwp *l)
    365  1.1   nonaka {
    366  1.1   nonaka #ifdef WSDISPLAY_COMPAT_RAWKBD
    367  1.1   nonaka 	struct wzero3keypad_softc *sc = (struct wzero3keypad_softc *)arg;
    368  1.1   nonaka #endif
    369  1.1   nonaka 
    370  1.1   nonaka 	switch (cmd) {
    371  1.1   nonaka 	case WSKBDIO_GTYPE:
    372  1.1   nonaka 		*(int *)data = WSKBD_TYPE_HPC_KBD;
    373  1.1   nonaka 		return 0;
    374  1.1   nonaka 	case WSKBDIO_SETLEDS:
    375  1.1   nonaka 		return 0;
    376  1.1   nonaka 	case WSKBDIO_GETLEDS:
    377  1.1   nonaka 		*(int *)data = 0;
    378  1.1   nonaka 		return 0;
    379  1.1   nonaka #ifdef WSDISPLAY_COMPAT_RAWKBD
    380  1.1   nonaka 	case WSKBDIO_SETMODE:
    381  1.1   nonaka 		sc->sc_rawkbd = (*(int *)data == WSKBD_RAW);
    382  1.1   nonaka 		return 0;
    383  1.1   nonaka #endif
    384  1.1   nonaka 	}
    385  1.1   nonaka 
    386  1.1   nonaka 	return EPASSTHROUGH;
    387  1.1   nonaka }
    388  1.1   nonaka 
    389  1.1   nonaka static int
    390  1.1   nonaka wzero3keypad_intr(void *arg)
    391  1.1   nonaka {
    392  1.1   nonaka 	struct wzero3keypad_softc *sc = (struct wzero3keypad_softc *)arg;
    393  1.1   nonaka 
    394  1.1   nonaka 	pxa2x0_gpio_clear_intr(sc->sc_intr_pin);
    395  1.1   nonaka 
    396  1.1   nonaka 	wzero3keypad_poll1(sc, 0);
    397  1.1   nonaka 
    398  1.1   nonaka 	callout_schedule(&sc->sc_poll_ch, sc->sc_poll_interval);
    399  1.1   nonaka 
    400  1.1   nonaka 	return 1;
    401  1.1   nonaka }
    402  1.1   nonaka 
    403  1.1   nonaka static void
    404  1.1   nonaka wzero3keypad_poll(void *v)
    405  1.1   nonaka {
    406  1.1   nonaka 	struct wzero3keypad_softc *sc = (struct wzero3keypad_softc *)v;
    407  1.1   nonaka 
    408  1.1   nonaka 	wzero3keypad_poll1(sc, 1);
    409  1.1   nonaka 
    410  1.1   nonaka 	callout_stop(&sc->sc_poll_ch);
    411  1.1   nonaka }
    412  1.1   nonaka 
    413  1.1   nonaka static void
    414  1.1   nonaka wzero3keypad_poll1(struct wzero3keypad_softc *sc, int doscan)
    415  1.1   nonaka {
    416  1.1   nonaka 	uint32_t keydown;
    417  1.1   nonaka 	uint32_t diff;
    418  1.1   nonaka 	int i;
    419  1.1   nonaka 	int s;
    420  1.1   nonaka 
    421  1.1   nonaka 	s = spltty();
    422  1.1   nonaka 
    423  1.1   nonaka 	keydown = wzero3keypad_getkeydown(sc, doscan);
    424  1.1   nonaka 	diff = keydown ^ sc->sc_okeystat;
    425  1.1   nonaka 	if (diff == 0)
    426  1.1   nonaka 		goto out;
    427  1.1   nonaka 
    428  1.1   nonaka 	for (i = 0; i < KD_NUM; i++) {
    429  1.1   nonaka 		if (diff & (1 << i)) {
    430  1.1   nonaka 			int state = keydown & (1 << i);
    431  1.1   nonaka 			int type = state ? WSCONS_EVENT_KEY_DOWN :
    432  1.1   nonaka 			    WSCONS_EVENT_KEY_UP;
    433  1.1   nonaka 			int key = wzero3keypad_wskbd_keys[i];
    434  1.1   nonaka #ifdef WSDISPLAY_COMPAT_RAWKBD
    435  1.1   nonaka 			if (sc->sc_rawkbd) {
    436  1.1   nonaka 				int n;
    437  1.1   nonaka 				u_char data[16];
    438  1.1   nonaka 
    439  1.1   nonaka 				n = pckbd_encode(type, key, data);
    440  1.1   nonaka 				wskbd_rawinput(sc->sc_wskbddev, data, n);
    441  1.1   nonaka 			} else
    442  1.1   nonaka #endif
    443  1.1   nonaka 				wskbd_input(sc->sc_wskbddev, type, key);
    444  1.1   nonaka 		}
    445  1.1   nonaka 	}
    446  1.1   nonaka 	sc->sc_okeystat = keydown;
    447  1.1   nonaka 
    448  1.1   nonaka out:
    449  1.1   nonaka 	splx(s);
    450  1.1   nonaka }
    451  1.1   nonaka 
    452  1.1   nonaka /*----------------------------------------------------------------------------
    453  1.1   nonaka  * AK4184 keypad controller for WS011SH
    454  1.1   nonaka  */
    455  1.1   nonaka /* ak4184 command register */
    456  1.1   nonaka #define	AKMCTRL_WR_SH	7
    457  1.1   nonaka #define	AKMCTRL_PAGE_SH	6
    458  1.1   nonaka #define	AKMCTRL_ADDR_SH	0
    459  1.1   nonaka #define	AKMCTRL_WRITE	(0<<AKMCTRL_WR_SH)
    460  1.1   nonaka #define	AKMCTRL_READ	(1<<AKMCTRL_WR_SH)
    461  1.1   nonaka #define	AKMCTRL_DATA	(0<<AKMCTRL_PAGE_SH)
    462  1.1   nonaka #define	AKMCTRL_CTRL	(1<<AKMCTRL_PAGE_SH)
    463  1.1   nonaka 
    464  1.1   nonaka static void
    465  1.1   nonaka wzero3keypad_init(struct wzero3keypad_softc *sc)
    466  1.1   nonaka {
    467  1.1   nonaka 	int s;
    468  1.1   nonaka 
    469  1.1   nonaka 	s = spltty();
    470  1.1   nonaka 
    471  1.1   nonaka #if 0
    472  1.1   nonaka 	/*
    473  1.1   nonaka 	 * - key interrupt enable
    474  1.1   nonaka 	 * - key touch scan
    475  1.1   nonaka 	 * - debounce time: 1ms
    476  1.1   nonaka 	 * - wait 100us for debounce time
    477  1.1   nonaka 	 */
    478  1.1   nonaka 	(void) wzero3ssp_ic_send(WZERO3_SSP_IC_AK4184_KEYPAD,
    479  1.1   nonaka 	    AKMCTRL_WRITE | AKMCTRL_CTRL | (0<<AKMCTRL_ADDR_SH), 0);
    480  1.1   nonaka #endif
    481  1.1   nonaka 
    482  1.1   nonaka 	/* unmask all keys & columns */
    483  1.1   nonaka 	(void) wzero3ssp_ic_send(WZERO3_SSP_IC_AK4184_KEYPAD,
    484  1.1   nonaka 	    AKMCTRL_WRITE | AKMCTRL_CTRL | (1<<AKMCTRL_ADDR_SH), 0);
    485  1.1   nonaka 	(void) wzero3ssp_ic_send(WZERO3_SSP_IC_AK4184_KEYPAD,
    486  1.1   nonaka 	    AKMCTRL_WRITE | AKMCTRL_CTRL | (2<<AKMCTRL_ADDR_SH), 0);
    487  1.1   nonaka 	(void) wzero3ssp_ic_send(WZERO3_SSP_IC_AK4184_KEYPAD,
    488  1.1   nonaka 	    AKMCTRL_WRITE | AKMCTRL_CTRL | (3<<AKMCTRL_ADDR_SH), 0);
    489  1.1   nonaka 
    490  1.1   nonaka 	/* Enable keypad interrupt (kpdata dummy read) */
    491  1.1   nonaka 	(void) wzero3ssp_ic_send(WZERO3_SSP_IC_AK4184_KEYPAD,
    492  1.1   nonaka 	    AKMCTRL_READ | AKMCTRL_DATA | (1<<AKMCTRL_ADDR_SH), 0);
    493  1.1   nonaka 
    494  1.1   nonaka 	splx(s);
    495  1.1   nonaka }
    496  1.1   nonaka 
    497  1.1   nonaka static uint32_t
    498  1.1   nonaka wzero3keypad_getkeydown(struct wzero3keypad_softc *sc, int doscan)
    499  1.1   nonaka {
    500  1.1   nonaka 	uint32_t keydown = 0;
    501  1.1   nonaka 	uint16_t status;
    502  1.1   nonaka 	uint16_t kpdata;
    503  1.1   nonaka 	int timo;
    504  1.1   nonaka 
    505  1.1   nonaka 	if (doscan) {
    506  1.1   nonaka 		/* host scan */
    507  1.1   nonaka 		(void) wzero3ssp_ic_send(WZERO3_SSP_IC_AK4184_KEYPAD,
    508  1.1   nonaka 		    AKMCTRL_WRITE | AKMCTRL_CTRL | (4<<AKMCTRL_ADDR_SH), 0);
    509  1.1   nonaka 		delay(100);
    510  1.1   nonaka 	}
    511  1.1   nonaka 
    512  1.1   nonaka 	timo = 1000;
    513  1.1   nonaka 	do {
    514  1.1   nonaka 		status = wzero3ssp_ic_send(WZERO3_SSP_IC_AK4184_KEYPAD,
    515  1.1   nonaka 		    AKMCTRL_READ | AKMCTRL_CTRL | (0<<AKMCTRL_ADDR_SH), 0);
    516  1.1   nonaka 	} while ((status & 0xc000) == 0 && timo-- > 0);
    517  1.1   nonaka 
    518  1.1   nonaka 	kpdata = wzero3ssp_ic_send(WZERO3_SSP_IC_AK4184_KEYPAD,
    519  1.1   nonaka 	    AKMCTRL_READ | AKMCTRL_DATA | (1<<AKMCTRL_ADDR_SH), 0);
    520  1.1   nonaka 	if ((status & 0xc000) == 0xc000) {
    521  1.1   nonaka 		if (!(kpdata & 0x8000)) {
    522  1.1   nonaka 			int i;
    523  1.1   nonaka 
    524  1.1   nonaka 			for (i = 0; i < 3; i++) {
    525  1.1   nonaka 				int key, bits;
    526  1.1   nonaka 
    527  1.1   nonaka 				key = kpdata & 0x1f;
    528  1.1   nonaka 				if (key == 0)
    529  1.1   nonaka 					break;
    530  1.1   nonaka 				bits = ws011sh_keyscan2keydown[key];
    531  1.1   nonaka 				if (bits != KD_INVALID)
    532  1.1   nonaka 					keydown |= 1 << bits;
    533  1.1   nonaka 				kpdata >>= 5;
    534  1.1   nonaka 			}
    535  1.1   nonaka 		}
    536  1.1   nonaka 	}
    537  1.1   nonaka 
    538  1.1   nonaka 	return keydown;
    539  1.1   nonaka }
    540