Home | History | Annotate | Line # | Download | only in adb
adb_kbd.c revision 1.4.2.2
      1  1.4.2.2  yamt /*	$NetBSD: adb_kbd.c,v 1.4.2.2 2007/02/26 09:09:58 yamt Exp $	*/
      2  1.4.2.2  yamt 
      3  1.4.2.2  yamt /*
      4  1.4.2.2  yamt  * Copyright (C) 1998	Colin Wood
      5  1.4.2.2  yamt  * Copyright (C) 2006, 2007 Michael Lorenz
      6  1.4.2.2  yamt  * All rights reserved.
      7  1.4.2.2  yamt  *
      8  1.4.2.2  yamt  * Redistribution and use in source and binary forms, with or without
      9  1.4.2.2  yamt  * modification, are permitted provided that the following conditions
     10  1.4.2.2  yamt  * are met:
     11  1.4.2.2  yamt  * 1. Redistributions of source code must retain the above copyright
     12  1.4.2.2  yamt  *    notice, this list of conditions and the following disclaimer.
     13  1.4.2.2  yamt  * 2. Redistributions in binary form must reproduce the above copyright
     14  1.4.2.2  yamt  *    notice, this list of conditions and the following disclaimer in the
     15  1.4.2.2  yamt  *    documentation and/or other materials provided with the distribution.
     16  1.4.2.2  yamt  * 3. All advertising materials mentioning features or use of this software
     17  1.4.2.2  yamt  *    must display the following acknowledgement:
     18  1.4.2.2  yamt  *	This product includes software developed by Colin Wood.
     19  1.4.2.2  yamt  * 4. The name of the author may not be used to endorse or promote products
     20  1.4.2.2  yamt  *    derived from this software without specific prior written permission.
     21  1.4.2.2  yamt  *
     22  1.4.2.2  yamt  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     23  1.4.2.2  yamt  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     24  1.4.2.2  yamt  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     25  1.4.2.2  yamt  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     26  1.4.2.2  yamt  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     27  1.4.2.2  yamt  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     28  1.4.2.2  yamt  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     29  1.4.2.2  yamt  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     30  1.4.2.2  yamt  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
     31  1.4.2.2  yamt  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     32  1.4.2.2  yamt  */
     33  1.4.2.2  yamt 
     34  1.4.2.2  yamt #include <sys/cdefs.h>
     35  1.4.2.2  yamt __KERNEL_RCSID(0, "$NetBSD: adb_kbd.c,v 1.4.2.2 2007/02/26 09:09:58 yamt Exp $");
     36  1.4.2.2  yamt 
     37  1.4.2.2  yamt #include <sys/param.h>
     38  1.4.2.2  yamt #include <sys/device.h>
     39  1.4.2.2  yamt #include <sys/fcntl.h>
     40  1.4.2.2  yamt #include <sys/poll.h>
     41  1.4.2.2  yamt #include <sys/select.h>
     42  1.4.2.2  yamt #include <sys/proc.h>
     43  1.4.2.2  yamt #include <sys/systm.h>
     44  1.4.2.2  yamt #include <sys/kernel.h>
     45  1.4.2.2  yamt #include <sys/sysctl.h>
     46  1.4.2.2  yamt 
     47  1.4.2.2  yamt #include <dev/wscons/wsconsio.h>
     48  1.4.2.2  yamt #include <dev/wscons/wskbdvar.h>
     49  1.4.2.2  yamt #include <dev/wscons/wsksymdef.h>
     50  1.4.2.2  yamt #include <dev/wscons/wsksymvar.h>
     51  1.4.2.2  yamt #include <dev/wscons/wsmousevar.h>
     52  1.4.2.2  yamt 
     53  1.4.2.2  yamt #include <dev/sysmon/sysmonvar.h>
     54  1.4.2.2  yamt #include <dev/sysmon/sysmon_taskq.h>
     55  1.4.2.2  yamt 
     56  1.4.2.2  yamt #include <machine/autoconf.h>
     57  1.4.2.2  yamt #include <machine/keyboard.h>
     58  1.4.2.2  yamt #include <machine/adbsys.h>
     59  1.4.2.2  yamt 
     60  1.4.2.2  yamt #include <dev/adb/adbvar.h>
     61  1.4.2.2  yamt #include <dev/adb/adb_keymap.h>
     62  1.4.2.2  yamt 
     63  1.4.2.2  yamt #include "adbdebug.h"
     64  1.4.2.2  yamt 
     65  1.4.2.2  yamt struct adbkbd_softc {
     66  1.4.2.2  yamt 	struct device sc_dev;
     67  1.4.2.2  yamt 	struct adb_device *sc_adbdev;
     68  1.4.2.2  yamt 	struct adb_bus_accessops *sc_ops;
     69  1.4.2.2  yamt 	struct device *sc_wskbddev;
     70  1.4.2.2  yamt 	struct device *sc_wsmousedev;
     71  1.4.2.2  yamt 	struct sysmon_pswitch sc_sm_pbutton;
     72  1.4.2.2  yamt 	int sc_leds;
     73  1.4.2.2  yamt 	int sc_have_led_control;
     74  1.4.2.2  yamt 	int sc_msg_len;
     75  1.4.2.2  yamt 	int sc_event;
     76  1.4.2.2  yamt 	int sc_poll;
     77  1.4.2.2  yamt 	int sc_polled_chars;
     78  1.4.2.2  yamt 	int sc_trans[3];
     79  1.4.2.2  yamt 	int sc_capslock;
     80  1.4.2.2  yamt #ifdef WSDISPLAY_COMPAT_RAWKBD
     81  1.4.2.2  yamt 	int sc_rawkbd;
     82  1.4.2.2  yamt #endif
     83  1.4.2.2  yamt 	uint8_t sc_buffer[16];
     84  1.4.2.2  yamt 	uint8_t sc_pollbuf[16];
     85  1.4.2.2  yamt 	uint8_t sc_us;
     86  1.4.2.2  yamt };
     87  1.4.2.2  yamt 
     88  1.4.2.2  yamt /*
     89  1.4.2.2  yamt  * Function declarations.
     90  1.4.2.2  yamt  */
     91  1.4.2.2  yamt static int	adbkbd_match(struct device *, struct cfdata *, void *);
     92  1.4.2.2  yamt static void	adbkbd_attach(struct device *, struct device *, void *);
     93  1.4.2.2  yamt 
     94  1.4.2.2  yamt static void	adbkbd_initleds(struct adbkbd_softc *);
     95  1.4.2.2  yamt static void	adbkbd_keys(struct adbkbd_softc *, uint8_t, uint8_t);
     96  1.4.2.2  yamt static inline void adbkbd_key(struct adbkbd_softc *, uint8_t);
     97  1.4.2.2  yamt static int	adbkbd_wait(struct adbkbd_softc *, int);
     98  1.4.2.2  yamt 
     99  1.4.2.2  yamt /* Driver definition. */
    100  1.4.2.2  yamt CFATTACH_DECL(adbkbd, sizeof(struct adbkbd_softc),
    101  1.4.2.2  yamt     adbkbd_match, adbkbd_attach, NULL, NULL);
    102  1.4.2.2  yamt 
    103  1.4.2.2  yamt extern struct cfdriver akbd_cd;
    104  1.4.2.2  yamt 
    105  1.4.2.2  yamt static int adbkbd_enable(void *, int);
    106  1.4.2.2  yamt static int adbkbd_ioctl(void *, u_long, caddr_t, int, struct lwp *);
    107  1.4.2.2  yamt static void adbkbd_set_leds(void *, int);
    108  1.4.2.2  yamt static void adbkbd_handler(void *, int, uint8_t *);
    109  1.4.2.2  yamt 
    110  1.4.2.2  yamt struct wskbd_accessops adbkbd_accessops = {
    111  1.4.2.2  yamt 	adbkbd_enable,
    112  1.4.2.2  yamt 	adbkbd_set_leds,
    113  1.4.2.2  yamt 	adbkbd_ioctl,
    114  1.4.2.2  yamt };
    115  1.4.2.2  yamt 
    116  1.4.2.2  yamt static void adbkbd_cngetc(void *, u_int *, int *);
    117  1.4.2.2  yamt static void adbkbd_cnpollc(void *, int);
    118  1.4.2.2  yamt 
    119  1.4.2.2  yamt struct wskbd_consops adbkbd_consops = {
    120  1.4.2.2  yamt 	adbkbd_cngetc,
    121  1.4.2.2  yamt 	adbkbd_cnpollc,
    122  1.4.2.2  yamt };
    123  1.4.2.2  yamt 
    124  1.4.2.2  yamt struct wskbd_mapdata adbkbd_keymapdata = {
    125  1.4.2.2  yamt 	akbd_keydesctab,
    126  1.4.2.2  yamt #ifdef AKBD_LAYOUT
    127  1.4.2.2  yamt 	AKBD_LAYOUT,
    128  1.4.2.2  yamt #else
    129  1.4.2.2  yamt 	KB_US,
    130  1.4.2.2  yamt #endif
    131  1.4.2.2  yamt };
    132  1.4.2.2  yamt 
    133  1.4.2.2  yamt static int adbkms_enable(void *);
    134  1.4.2.2  yamt static int adbkms_ioctl(void *, u_long, caddr_t, int, struct lwp *);
    135  1.4.2.2  yamt static void adbkms_disable(void *);
    136  1.4.2.2  yamt 
    137  1.4.2.2  yamt const struct wsmouse_accessops adbkms_accessops = {
    138  1.4.2.2  yamt 	adbkms_enable,
    139  1.4.2.2  yamt 	adbkms_ioctl,
    140  1.4.2.2  yamt 	adbkms_disable,
    141  1.4.2.2  yamt };
    142  1.4.2.2  yamt 
    143  1.4.2.2  yamt static int  adbkbd_sysctl_button(SYSCTLFN_ARGS);
    144  1.4.2.2  yamt static void adbkbd_setup_sysctl(struct adbkbd_softc *);
    145  1.4.2.2  yamt 
    146  1.4.2.2  yamt #ifdef ADBKBD_DEBUG
    147  1.4.2.2  yamt #define DPRINTF printf
    148  1.4.2.2  yamt #else
    149  1.4.2.2  yamt #define DPRINTF while (0) printf
    150  1.4.2.2  yamt #endif
    151  1.4.2.2  yamt 
    152  1.4.2.2  yamt static int adbkbd_is_console = 0;
    153  1.4.2.2  yamt static int adbkbd_console_attached = 0;
    154  1.4.2.2  yamt 
    155  1.4.2.2  yamt static int
    156  1.4.2.2  yamt adbkbd_match(parent, cf, aux)
    157  1.4.2.2  yamt 	struct device *parent;
    158  1.4.2.2  yamt 	struct cfdata *cf;
    159  1.4.2.2  yamt 	void   *aux;
    160  1.4.2.2  yamt {
    161  1.4.2.2  yamt 	struct adb_attach_args *aaa = aux;
    162  1.4.2.2  yamt 
    163  1.4.2.2  yamt 	if (aaa->dev->original_addr == ADBADDR_KBD)
    164  1.4.2.2  yamt 		return 1;
    165  1.4.2.2  yamt 	else
    166  1.4.2.2  yamt 		return 0;
    167  1.4.2.2  yamt }
    168  1.4.2.2  yamt 
    169  1.4.2.2  yamt static void
    170  1.4.2.2  yamt adbkbd_attach(struct device *parent, struct device *self, void *aux)
    171  1.4.2.2  yamt {
    172  1.4.2.2  yamt 	struct adbkbd_softc *sc = (struct adbkbd_softc *)self;
    173  1.4.2.2  yamt 	struct adb_attach_args *aaa = aux;
    174  1.4.2.2  yamt 	short cmd;
    175  1.4.2.2  yamt 	struct wskbddev_attach_args a;
    176  1.4.2.2  yamt 	struct wsmousedev_attach_args am;
    177  1.4.2.2  yamt 
    178  1.4.2.2  yamt 	sc->sc_ops = aaa->ops;
    179  1.4.2.2  yamt 	sc->sc_adbdev = aaa->dev;
    180  1.4.2.2  yamt 	sc->sc_adbdev->cookie = sc;
    181  1.4.2.2  yamt 	sc->sc_adbdev->handler = adbkbd_handler;
    182  1.4.2.2  yamt 	sc->sc_us = ADBTALK(sc->sc_adbdev->current_addr, 0);
    183  1.4.2.2  yamt 
    184  1.4.2.2  yamt 	sc->sc_leds = 0;	/* initially off */
    185  1.4.2.2  yamt 	sc->sc_have_led_control = 0;
    186  1.4.2.2  yamt 	sc->sc_msg_len = 0;
    187  1.4.2.2  yamt 	sc->sc_poll = 0;
    188  1.4.2.2  yamt 	sc->sc_capslock = 0;
    189  1.4.2.2  yamt 	sc->sc_trans[1] = 103;	/* F11 */
    190  1.4.2.2  yamt 	sc->sc_trans[2] = 111;	/* F12 */
    191  1.4.2.2  yamt 
    192  1.4.2.2  yamt 	printf(" addr %d ", sc->sc_adbdev->current_addr);
    193  1.4.2.2  yamt 
    194  1.4.2.2  yamt 	switch (sc->sc_adbdev->handler_id) {
    195  1.4.2.2  yamt 	case ADB_STDKBD:
    196  1.4.2.2  yamt 		printf("standard keyboard\n");
    197  1.4.2.2  yamt 		break;
    198  1.4.2.2  yamt 	case ADB_ISOKBD:
    199  1.4.2.2  yamt 		printf("standard keyboard (ISO layout)\n");
    200  1.4.2.2  yamt 		break;
    201  1.4.2.2  yamt 	case ADB_EXTKBD:
    202  1.4.2.2  yamt 		cmd = ADBTALK(sc->sc_adbdev->current_addr, 1);
    203  1.4.2.2  yamt 		sc->sc_msg_len = 0;
    204  1.4.2.2  yamt 		sc->sc_ops->send(sc->sc_ops->cookie, sc->sc_poll, cmd, 0, NULL);
    205  1.4.2.2  yamt 		adbkbd_wait(sc, 10);
    206  1.4.2.2  yamt 
    207  1.4.2.2  yamt 		/* Ignore Logitech MouseMan/Trackman pseudo keyboard */
    208  1.4.2.2  yamt 		/* XXX needs testing */
    209  1.4.2.2  yamt 		if (sc->sc_buffer[2] == 0x9a && sc->sc_buffer[3] == 0x20) {
    210  1.4.2.2  yamt 			printf("Mouseman (non-EMP) pseudo keyboard\n");
    211  1.4.2.2  yamt 			return;
    212  1.4.2.2  yamt 		} else if (sc->sc_buffer[2] == 0x9a &&
    213  1.4.2.2  yamt 		    sc->sc_buffer[3] == 0x21) {
    214  1.4.2.2  yamt 			printf("Trackman (non-EMP) pseudo keyboard\n");
    215  1.4.2.2  yamt 			return;
    216  1.4.2.2  yamt 		} else {
    217  1.4.2.2  yamt 			printf("extended keyboard\n");
    218  1.4.2.2  yamt 			adbkbd_initleds(sc);
    219  1.4.2.2  yamt 		}
    220  1.4.2.2  yamt 		break;
    221  1.4.2.2  yamt 	case ADB_EXTISOKBD:
    222  1.4.2.2  yamt 		printf("extended keyboard (ISO layout)\n");
    223  1.4.2.2  yamt 		adbkbd_initleds(sc);
    224  1.4.2.2  yamt 		break;
    225  1.4.2.2  yamt 	case ADB_KBDII:
    226  1.4.2.2  yamt 		printf("keyboard II\n");
    227  1.4.2.2  yamt 		break;
    228  1.4.2.2  yamt 	case ADB_ISOKBDII:
    229  1.4.2.2  yamt 		printf("keyboard II (ISO layout)\n");
    230  1.4.2.2  yamt 		break;
    231  1.4.2.2  yamt 	case ADB_PBKBD:
    232  1.4.2.2  yamt 		printf("PowerBook keyboard\n");
    233  1.4.2.2  yamt 		break;
    234  1.4.2.2  yamt 	case ADB_PBISOKBD:
    235  1.4.2.2  yamt 		printf("PowerBook keyboard (ISO layout)\n");
    236  1.4.2.2  yamt 		break;
    237  1.4.2.2  yamt 	case ADB_ADJKPD:
    238  1.4.2.2  yamt 		printf("adjustable keypad\n");
    239  1.4.2.2  yamt 		break;
    240  1.4.2.2  yamt 	case ADB_ADJKBD:
    241  1.4.2.2  yamt 		printf("adjustable keyboard\n");
    242  1.4.2.2  yamt 		break;
    243  1.4.2.2  yamt 	case ADB_ADJISOKBD:
    244  1.4.2.2  yamt 		printf("adjustable keyboard (ISO layout)\n");
    245  1.4.2.2  yamt 		break;
    246  1.4.2.2  yamt 	case ADB_ADJJAPKBD:
    247  1.4.2.2  yamt 		printf("adjustable keyboard (Japanese layout)\n");
    248  1.4.2.2  yamt 		break;
    249  1.4.2.2  yamt 	case ADB_PBEXTISOKBD:
    250  1.4.2.2  yamt 		printf("PowerBook extended keyboard (ISO layout)\n");
    251  1.4.2.2  yamt 		break;
    252  1.4.2.2  yamt 	case ADB_PBEXTJAPKBD:
    253  1.4.2.2  yamt 		printf("PowerBook extended keyboard (Japanese layout)\n");
    254  1.4.2.2  yamt 		break;
    255  1.4.2.2  yamt 	case ADB_JPKBDII:
    256  1.4.2.2  yamt 		printf("keyboard II (Japanese layout)\n");
    257  1.4.2.2  yamt 		break;
    258  1.4.2.2  yamt 	case ADB_PBEXTKBD:
    259  1.4.2.2  yamt 		printf("PowerBook extended keyboard\n");
    260  1.4.2.2  yamt 		break;
    261  1.4.2.2  yamt 	case ADB_DESIGNKBD:
    262  1.4.2.2  yamt 		printf("extended keyboard\n");
    263  1.4.2.2  yamt 		adbkbd_initleds(sc);
    264  1.4.2.2  yamt 		break;
    265  1.4.2.2  yamt 	case ADB_PBJPKBD:
    266  1.4.2.2  yamt 		printf("PowerBook keyboard (Japanese layout)\n");
    267  1.4.2.2  yamt 		break;
    268  1.4.2.2  yamt 	case ADB_PBG3KBD:
    269  1.4.2.2  yamt 		printf("PowerBook G3 keyboard\n");
    270  1.4.2.2  yamt 		break;
    271  1.4.2.2  yamt 	case ADB_PBG3JPKBD:
    272  1.4.2.2  yamt 		printf("PowerBook G3 keyboard (Japanese layout)\n");
    273  1.4.2.2  yamt 		break;
    274  1.4.2.2  yamt 	case ADB_IBOOKKBD:
    275  1.4.2.2  yamt 		printf("iBook keyboard\n");
    276  1.4.2.2  yamt 		break;
    277  1.4.2.2  yamt 	default:
    278  1.4.2.2  yamt 		printf("mapped device (%d)\n", sc->sc_adbdev->handler_id);
    279  1.4.2.2  yamt 		break;
    280  1.4.2.2  yamt 	}
    281  1.4.2.2  yamt 
    282  1.4.2.2  yamt 	if (adbkbd_is_console && (adbkbd_console_attached == 0)) {
    283  1.4.2.2  yamt 		wskbd_cnattach(&adbkbd_consops, sc, &adbkbd_keymapdata);
    284  1.4.2.2  yamt 		adbkbd_console_attached = 1;
    285  1.4.2.2  yamt 		a.console = 1;
    286  1.4.2.2  yamt 	} else {
    287  1.4.2.2  yamt 		a.console = 0;
    288  1.4.2.2  yamt 	}
    289  1.4.2.2  yamt 	a.keymap = &adbkbd_keymapdata;
    290  1.4.2.2  yamt 	a.accessops = &adbkbd_accessops;
    291  1.4.2.2  yamt 	a.accesscookie = sc;
    292  1.4.2.2  yamt 
    293  1.4.2.2  yamt 	sc->sc_wskbddev = config_found_ia(self, "wskbddev", &a, wskbddevprint);
    294  1.4.2.2  yamt 
    295  1.4.2.2  yamt 	/* attach the mouse device */
    296  1.4.2.2  yamt 	am.accessops = &adbkms_accessops;
    297  1.4.2.2  yamt 	am.accesscookie = sc;
    298  1.4.2.2  yamt 	sc->sc_wsmousedev = config_found_ia(self, "wsmousedev", &am, wsmousedevprint);
    299  1.4.2.2  yamt 
    300  1.4.2.2  yamt 	if (sc->sc_wsmousedev != NULL)
    301  1.4.2.2  yamt 		adbkbd_setup_sysctl(sc);
    302  1.4.2.2  yamt 
    303  1.4.2.2  yamt 	/* finally register the power button */
    304  1.4.2.2  yamt 	sysmon_task_queue_init();
    305  1.4.2.2  yamt 	memset(&sc->sc_sm_pbutton, 0, sizeof(struct sysmon_pswitch));
    306  1.4.2.2  yamt 	sc->sc_sm_pbutton.smpsw_name = sc->sc_dev.dv_xname;
    307  1.4.2.2  yamt 	sc->sc_sm_pbutton.smpsw_type = PSWITCH_TYPE_POWER;
    308  1.4.2.2  yamt 	if (sysmon_pswitch_register(&sc->sc_sm_pbutton) != 0)
    309  1.4.2.2  yamt 		printf("%s: unable to register power button with sysmon\n",
    310  1.4.2.2  yamt 		    sc->sc_dev.dv_xname);
    311  1.4.2.2  yamt }
    312  1.4.2.2  yamt 
    313  1.4.2.2  yamt static void
    314  1.4.2.2  yamt adbkbd_handler(void *cookie, int len, uint8_t *data)
    315  1.4.2.2  yamt {
    316  1.4.2.2  yamt 	struct adbkbd_softc *sc = cookie;
    317  1.4.2.2  yamt 
    318  1.4.2.2  yamt #ifdef ADBKBD_DEBUG
    319  1.4.2.2  yamt 	int i;
    320  1.4.2.2  yamt 	printf("%s: %02x - ", sc->sc_dev.dv_xname, sc->sc_us);
    321  1.4.2.2  yamt 	for (i = 0; i < len; i++) {
    322  1.4.2.2  yamt 		printf(" %02x", data[i]);
    323  1.4.2.2  yamt 	}
    324  1.4.2.2  yamt 	printf("\n");
    325  1.4.2.2  yamt #endif
    326  1.4.2.2  yamt 	if (len >= 2) {
    327  1.4.2.2  yamt 		if (data[1] == sc->sc_us) {
    328  1.4.2.2  yamt 			adbkbd_keys(sc, data[2], data[3]);
    329  1.4.2.2  yamt 			return;
    330  1.4.2.2  yamt 		} else {
    331  1.4.2.2  yamt 			memcpy(sc->sc_buffer, data, len);
    332  1.4.2.2  yamt 		}
    333  1.4.2.2  yamt 		sc->sc_msg_len = len;
    334  1.4.2.2  yamt 		wakeup(&sc->sc_event);
    335  1.4.2.2  yamt 	} else {
    336  1.4.2.2  yamt 		DPRINTF("bogus message\n");
    337  1.4.2.2  yamt 	}
    338  1.4.2.2  yamt }
    339  1.4.2.2  yamt 
    340  1.4.2.2  yamt static int
    341  1.4.2.2  yamt adbkbd_wait(struct adbkbd_softc *sc, int timeout)
    342  1.4.2.2  yamt {
    343  1.4.2.2  yamt 	int cnt = 0;
    344  1.4.2.2  yamt 
    345  1.4.2.2  yamt 	if (sc->sc_poll) {
    346  1.4.2.2  yamt 		while (sc->sc_msg_len == 0) {
    347  1.4.2.2  yamt 			sc->sc_ops->poll(sc->sc_ops->cookie);
    348  1.4.2.2  yamt 		}
    349  1.4.2.2  yamt 	} else {
    350  1.4.2.2  yamt 		while ((sc->sc_msg_len == 0) && (cnt < timeout)) {
    351  1.4.2.2  yamt 			tsleep(&sc->sc_event, 0, "adbkbdio", hz);
    352  1.4.2.2  yamt 			cnt++;
    353  1.4.2.2  yamt 		}
    354  1.4.2.2  yamt 	}
    355  1.4.2.2  yamt 	return (sc->sc_msg_len > 0);
    356  1.4.2.2  yamt }
    357  1.4.2.2  yamt 
    358  1.4.2.2  yamt static void
    359  1.4.2.2  yamt adbkbd_keys(struct adbkbd_softc *sc, uint8_t k1, uint8_t k2)
    360  1.4.2.2  yamt {
    361  1.4.2.2  yamt 
    362  1.4.2.2  yamt 	/* keyboard event processing */
    363  1.4.2.2  yamt 
    364  1.4.2.2  yamt 	DPRINTF("[%02x %02x]", k1, k2);
    365  1.4.2.2  yamt 
    366  1.4.2.2  yamt 	if (((k1 == k2) && (k1 == 0x7f)) || (k1 == 0x7e)) {
    367  1.4.2.2  yamt 
    368  1.4.2.2  yamt 		/* power button, report to sysmon */
    369  1.4.2.2  yamt 		sysmon_pswitch_event(&sc->sc_sm_pbutton,
    370  1.4.2.2  yamt 		    ADBK_PRESS(k1) ? PSWITCH_EVENT_PRESSED :
    371  1.4.2.2  yamt 		    PSWITCH_EVENT_RELEASED);
    372  1.4.2.2  yamt 	} else {
    373  1.4.2.2  yamt 
    374  1.4.2.2  yamt 		adbkbd_key(sc, k1);
    375  1.4.2.2  yamt 		if (k2 != 0xff)
    376  1.4.2.2  yamt 			adbkbd_key(sc, k2);
    377  1.4.2.2  yamt 	}
    378  1.4.2.2  yamt }
    379  1.4.2.2  yamt 
    380  1.4.2.2  yamt static inline void
    381  1.4.2.2  yamt adbkbd_key(struct adbkbd_softc *sc, uint8_t k)
    382  1.4.2.2  yamt {
    383  1.4.2.2  yamt 
    384  1.4.2.2  yamt 	if (sc->sc_poll) {
    385  1.4.2.2  yamt 		if (sc->sc_polled_chars >= 16) {
    386  1.4.2.2  yamt 			printf("%s: polling buffer is full\n",
    387  1.4.2.2  yamt 			    sc->sc_dev.dv_xname);
    388  1.4.2.2  yamt 		}
    389  1.4.2.2  yamt 		sc->sc_pollbuf[sc->sc_polled_chars] = k;
    390  1.4.2.2  yamt 		sc->sc_polled_chars++;
    391  1.4.2.2  yamt 		return;
    392  1.4.2.2  yamt 	}
    393  1.4.2.2  yamt 
    394  1.4.2.2  yamt 	/* translate some keys to mouse events */
    395  1.4.2.2  yamt 	if (sc->sc_wsmousedev != NULL) {
    396  1.4.2.2  yamt 		if (ADBK_KEYVAL(k) == sc->sc_trans[1]) {
    397  1.4.2.2  yamt 			wsmouse_input(sc->sc_wsmousedev, ADBK_PRESS(k) ? 2 : 0,
    398  1.4.2.2  yamt 			      0, 0, 0, 0,
    399  1.4.2.2  yamt 			      WSMOUSE_INPUT_DELTA);
    400  1.4.2.2  yamt 			return;
    401  1.4.2.2  yamt 		}
    402  1.4.2.2  yamt 		if (ADBK_KEYVAL(k) == sc->sc_trans[2]) {
    403  1.4.2.2  yamt 			wsmouse_input(sc->sc_wsmousedev, ADBK_PRESS(k) ? 4 : 0,
    404  1.4.2.2  yamt 			      0, 0, 0, 0,
    405  1.4.2.2  yamt 			      WSMOUSE_INPUT_DELTA);
    406  1.4.2.2  yamt 			return;
    407  1.4.2.2  yamt 		}
    408  1.4.2.2  yamt 	}
    409  1.4.2.2  yamt #ifdef WSDISPLAY_COMPAT_RAWKBD
    410  1.4.2.2  yamt 	if (sc->sc_rawkbd) {
    411  1.4.2.2  yamt 		char cbuf[2];
    412  1.4.2.2  yamt 		int s;
    413  1.4.2.2  yamt 		int j = 0;
    414  1.4.2.2  yamt 		int c = keyboard[ADBK_KEYVAL(k)][3]
    415  1.4.2.2  yamt 
    416  1.4.2.2  yamt 		if (k & 0x80)
    417  1.4.2.2  yamt 			cbuf[j++] = 0xe0;
    418  1.4.2.2  yamt 
    419  1.4.2.2  yamt 		cbuf[j++] = (c & 0x7f) | (ADBK_PRESS(k)? 0 : 0x80);
    420  1.4.2.2  yamt 
    421  1.4.2.2  yamt 		s = spltty();
    422  1.4.2.2  yamt 		wskbd_rawinput(sc->sc_wskbddev, cbuf, j);
    423  1.4.2.2  yamt 		splx(s);
    424  1.4.2.2  yamt 	} else {
    425  1.4.2.2  yamt #endif
    426  1.4.2.2  yamt 
    427  1.4.2.2  yamt 	if (ADBK_KEYVAL(k) == 0x39) {
    428  1.4.2.2  yamt 		/* caps lock - send up and down */
    429  1.4.2.2  yamt 		if (ADBK_PRESS(k) != sc->sc_capslock) {
    430  1.4.2.2  yamt 			sc->sc_capslock = ADBK_PRESS(k);
    431  1.4.2.2  yamt 			wskbd_input(sc->sc_wskbddev,
    432  1.4.2.2  yamt 			    WSCONS_EVENT_KEY_DOWN, 0x39);
    433  1.4.2.2  yamt 			wskbd_input(sc->sc_wskbddev,
    434  1.4.2.2  yamt 			    WSCONS_EVENT_KEY_UP, 0x39);
    435  1.4.2.2  yamt 		}
    436  1.4.2.2  yamt 	} else {
    437  1.4.2.2  yamt 		/* normal event */
    438  1.4.2.2  yamt 		int type;
    439  1.4.2.2  yamt 
    440  1.4.2.2  yamt 		type = ADBK_PRESS(k) ?
    441  1.4.2.2  yamt 		    WSCONS_EVENT_KEY_DOWN : WSCONS_EVENT_KEY_UP;
    442  1.4.2.2  yamt 		wskbd_input(sc->sc_wskbddev, type, ADBK_KEYVAL(k));
    443  1.4.2.2  yamt 	}
    444  1.4.2.2  yamt #ifdef WSDISPLAY_COMPAT_RAWKBD
    445  1.4.2.2  yamt 	}
    446  1.4.2.2  yamt #endif
    447  1.4.2.2  yamt }
    448  1.4.2.2  yamt 
    449  1.4.2.2  yamt /*
    450  1.4.2.2  yamt  * Set the keyboard LED's.
    451  1.4.2.2  yamt  *
    452  1.4.2.2  yamt  * Automatically translates from ioctl/softc format to the
    453  1.4.2.2  yamt  * actual keyboard register format
    454  1.4.2.2  yamt  */
    455  1.4.2.2  yamt static void
    456  1.4.2.2  yamt adbkbd_set_leds(void *cookie, int leds)
    457  1.4.2.2  yamt {
    458  1.4.2.2  yamt 	struct adbkbd_softc *sc = cookie;
    459  1.4.2.2  yamt 	int aleds;
    460  1.4.2.2  yamt 	short cmd;
    461  1.4.2.2  yamt 	uint8_t buffer[2];
    462  1.4.2.2  yamt 
    463  1.4.2.2  yamt 	DPRINTF("adbkbd_set_leds: %02x\n", leds);
    464  1.4.2.2  yamt 	if ((leds & 0x07) == (sc->sc_leds & 0x07))
    465  1.4.2.2  yamt 		return;
    466  1.4.2.2  yamt 
    467  1.4.2.2  yamt  	if (sc->sc_have_led_control) {
    468  1.4.2.2  yamt 
    469  1.4.2.2  yamt 		aleds = (~leds & 0x04) | 3;
    470  1.4.2.2  yamt 		if (leds & 1)
    471  1.4.2.2  yamt 			aleds &= ~2;
    472  1.4.2.2  yamt 		if (leds & 2)
    473  1.4.2.2  yamt 			aleds &= ~1;
    474  1.4.2.2  yamt 
    475  1.4.2.2  yamt 		buffer[0] = 0xff;
    476  1.4.2.2  yamt 		buffer[1] = aleds | 0xf8;
    477  1.4.2.2  yamt 
    478  1.4.2.2  yamt 		cmd = ADBLISTEN(sc->sc_adbdev->current_addr, 2);
    479  1.4.2.2  yamt 		sc->sc_ops->send(sc->sc_ops->cookie, sc->sc_poll, cmd, 2, buffer);
    480  1.4.2.2  yamt 	}
    481  1.4.2.2  yamt 
    482  1.4.2.2  yamt 	sc->sc_leds = leds & 7;
    483  1.4.2.2  yamt }
    484  1.4.2.2  yamt 
    485  1.4.2.2  yamt static void
    486  1.4.2.2  yamt adbkbd_initleds(struct adbkbd_softc *sc)
    487  1.4.2.2  yamt {
    488  1.4.2.2  yamt 	short cmd;
    489  1.4.2.2  yamt 
    490  1.4.2.2  yamt 	/* talk R2 */
    491  1.4.2.2  yamt 	cmd = ADBTALK(sc->sc_adbdev->current_addr, 2);
    492  1.4.2.2  yamt 	sc->sc_msg_len = 0;
    493  1.4.2.2  yamt 	sc->sc_ops->send(sc->sc_ops->cookie, sc->sc_poll, cmd, 0, NULL);
    494  1.4.2.2  yamt 	if (!adbkbd_wait(sc, 10)) {
    495  1.4.2.2  yamt 		printf("unable to read LED state\n");
    496  1.4.2.2  yamt 		return;
    497  1.4.2.2  yamt 	}
    498  1.4.2.2  yamt 	sc->sc_have_led_control = 1;
    499  1.4.2.2  yamt 	DPRINTF("have LED control\n");
    500  1.4.2.2  yamt 	return;
    501  1.4.2.2  yamt }
    502  1.4.2.2  yamt 
    503  1.4.2.2  yamt static int
    504  1.4.2.2  yamt adbkbd_enable(void *v, int on)
    505  1.4.2.2  yamt {
    506  1.4.2.2  yamt 	return 0;
    507  1.4.2.2  yamt }
    508  1.4.2.2  yamt 
    509  1.4.2.2  yamt static int
    510  1.4.2.2  yamt adbkbd_ioctl(void *v, u_long cmd, caddr_t data, int flag, struct lwp *l)
    511  1.4.2.2  yamt {
    512  1.4.2.2  yamt 	struct adbkbd_softc *sc = (struct adbkbd_softc *) v;
    513  1.4.2.2  yamt 
    514  1.4.2.2  yamt 	switch (cmd) {
    515  1.4.2.2  yamt 
    516  1.4.2.2  yamt 	case WSKBDIO_GTYPE:
    517  1.4.2.2  yamt 		*(int *)data = WSKBD_TYPE_ADB;
    518  1.4.2.2  yamt 		return 0;
    519  1.4.2.2  yamt 	case WSKBDIO_SETLEDS:
    520  1.4.2.2  yamt 		adbkbd_set_leds(sc, *(int *)data);
    521  1.4.2.2  yamt 		return 0;
    522  1.4.2.2  yamt 	case WSKBDIO_GETLEDS:
    523  1.4.2.2  yamt 		*(int *)data = sc->sc_leds;
    524  1.4.2.2  yamt 		return 0;
    525  1.4.2.2  yamt #ifdef WSDISPLAY_COMPAT_RAWKBD
    526  1.4.2.2  yamt 	case WSKBDIO_SETMODE:
    527  1.4.2.2  yamt 		sc->sc_rawkbd = *(int *)data == WSKBD_RAW;
    528  1.4.2.2  yamt 		return 0;
    529  1.4.2.2  yamt #endif
    530  1.4.2.2  yamt 	}
    531  1.4.2.2  yamt 
    532  1.4.2.2  yamt 	return EPASSTHROUGH;
    533  1.4.2.2  yamt }
    534  1.4.2.2  yamt 
    535  1.4.2.2  yamt int
    536  1.4.2.2  yamt adbkbd_cnattach()
    537  1.4.2.2  yamt {
    538  1.4.2.2  yamt 
    539  1.4.2.2  yamt 	adbkbd_is_console = 1;
    540  1.4.2.2  yamt 	return 0;
    541  1.4.2.2  yamt }
    542  1.4.2.2  yamt 
    543  1.4.2.2  yamt static void
    544  1.4.2.2  yamt adbkbd_cngetc(void *v, u_int *type, int *data)
    545  1.4.2.2  yamt {
    546  1.4.2.2  yamt 	struct adbkbd_softc *sc = v;
    547  1.4.2.2  yamt 	int key, press, val;
    548  1.4.2.2  yamt 	int s;
    549  1.4.2.2  yamt 
    550  1.4.2.2  yamt 	s = splhigh();
    551  1.4.2.2  yamt 
    552  1.4.2.2  yamt 	KASSERT(sc->sc_poll);
    553  1.4.2.2  yamt 
    554  1.4.2.2  yamt 	DPRINTF("polling...");
    555  1.4.2.2  yamt 	while (sc->sc_polled_chars == 0) {
    556  1.4.2.2  yamt 		sc->sc_ops->poll(sc->sc_ops->cookie);
    557  1.4.2.2  yamt 	}
    558  1.4.2.2  yamt 	DPRINTF(" got one\n");
    559  1.4.2.2  yamt 	splx(s);
    560  1.4.2.2  yamt 
    561  1.4.2.2  yamt 	key = sc->sc_pollbuf[0];
    562  1.4.2.2  yamt 	sc->sc_polled_chars--;
    563  1.4.2.2  yamt 	memmove(sc->sc_pollbuf, sc->sc_pollbuf + 1,
    564  1.4.2.2  yamt 		sc->sc_polled_chars);
    565  1.4.2.2  yamt 
    566  1.4.2.2  yamt 	press = ADBK_PRESS(key);
    567  1.4.2.2  yamt 	val = ADBK_KEYVAL(key);
    568  1.4.2.2  yamt 
    569  1.4.2.2  yamt 	*data = val;
    570  1.4.2.2  yamt 	*type = press ? WSCONS_EVENT_KEY_DOWN : WSCONS_EVENT_KEY_UP;
    571  1.4.2.2  yamt }
    572  1.4.2.2  yamt 
    573  1.4.2.2  yamt static void
    574  1.4.2.2  yamt adbkbd_cnpollc(void *v, int on)
    575  1.4.2.2  yamt {
    576  1.4.2.2  yamt 	struct adbkbd_softc *sc = v;
    577  1.4.2.2  yamt 
    578  1.4.2.2  yamt 	sc->sc_poll = on;
    579  1.4.2.2  yamt 	if (!on) {
    580  1.4.2.2  yamt 		int i;
    581  1.4.2.2  yamt 
    582  1.4.2.2  yamt 		/* feed the poll buffer's content to wskbd */
    583  1.4.2.2  yamt 		for (i = 0; i < sc->sc_polled_chars; i++) {
    584  1.4.2.2  yamt 			adbkbd_key(sc, sc->sc_pollbuf[i]);
    585  1.4.2.2  yamt 		}
    586  1.4.2.2  yamt 		sc->sc_polled_chars = 0;
    587  1.4.2.2  yamt 	}
    588  1.4.2.2  yamt }
    589  1.4.2.2  yamt 
    590  1.4.2.2  yamt /* stuff for the pseudo mouse */
    591  1.4.2.2  yamt static int
    592  1.4.2.2  yamt adbkms_enable(void *v)
    593  1.4.2.2  yamt {
    594  1.4.2.2  yamt 	return 0;
    595  1.4.2.2  yamt }
    596  1.4.2.2  yamt 
    597  1.4.2.2  yamt static int
    598  1.4.2.2  yamt adbkms_ioctl(void *v, u_long cmd, caddr_t data, int flag, struct lwp *l)
    599  1.4.2.2  yamt {
    600  1.4.2.2  yamt 
    601  1.4.2.2  yamt 	switch (cmd) {
    602  1.4.2.2  yamt 	case WSMOUSEIO_GTYPE:
    603  1.4.2.2  yamt 		*(u_int *)data = WSMOUSE_TYPE_PSEUDO;
    604  1.4.2.2  yamt 		break;
    605  1.4.2.2  yamt 
    606  1.4.2.2  yamt 	default:
    607  1.4.2.2  yamt 		return (EPASSTHROUGH);
    608  1.4.2.2  yamt 	}
    609  1.4.2.2  yamt 	return (0);
    610  1.4.2.2  yamt }
    611  1.4.2.2  yamt 
    612  1.4.2.2  yamt static void
    613  1.4.2.2  yamt adbkms_disable(void *v)
    614  1.4.2.2  yamt {
    615  1.4.2.2  yamt }
    616  1.4.2.2  yamt 
    617  1.4.2.2  yamt static void
    618  1.4.2.2  yamt adbkbd_setup_sysctl(struct adbkbd_softc *sc)
    619  1.4.2.2  yamt {
    620  1.4.2.2  yamt 	struct sysctlnode *node, *me;
    621  1.4.2.2  yamt 	int ret;
    622  1.4.2.2  yamt 
    623  1.4.2.2  yamt 	DPRINTF("%s: sysctl setup\n", sc->sc_dev.dv_xname);
    624  1.4.2.2  yamt 	ret = sysctl_createv(NULL, 0, NULL, (const struct sysctlnode **)&me,
    625  1.4.2.2  yamt 	       CTLFLAG_READWRITE,
    626  1.4.2.2  yamt 	       CTLTYPE_NODE, sc->sc_dev.dv_xname, NULL,
    627  1.4.2.2  yamt 	       NULL, 0, NULL, 0,
    628  1.4.2.2  yamt 	       CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    629  1.4.2.2  yamt 
    630  1.4.2.2  yamt 	ret = sysctl_createv(NULL, 0, NULL,
    631  1.4.2.2  yamt 	    (const struct sysctlnode **)&node,
    632  1.4.2.2  yamt 	    CTLFLAG_READWRITE | CTLFLAG_OWNDESC | CTLFLAG_IMMEDIATE,
    633  1.4.2.2  yamt 	    CTLTYPE_INT, "middle", "middle mouse button", adbkbd_sysctl_button,
    634  1.4.2.2  yamt 		    1, NULL, 0, CTL_MACHDEP, me->sysctl_num, CTL_CREATE, CTL_EOL);
    635  1.4.2.2  yamt 	node->sysctl_data = sc;
    636  1.4.2.2  yamt 
    637  1.4.2.2  yamt 	ret = sysctl_createv(NULL, 0, NULL,
    638  1.4.2.2  yamt 	    (const struct sysctlnode **)&node,
    639  1.4.2.2  yamt 	    CTLFLAG_READWRITE | CTLFLAG_OWNDESC | CTLFLAG_IMMEDIATE,
    640  1.4.2.2  yamt 	    CTLTYPE_INT, "right", "right mouse button", adbkbd_sysctl_button,
    641  1.4.2.2  yamt 		    2, NULL, 0, CTL_MACHDEP, me->sysctl_num, CTL_CREATE, CTL_EOL);
    642  1.4.2.2  yamt 	node->sysctl_data = sc;
    643  1.4.2.2  yamt }
    644  1.4.2.2  yamt 
    645  1.4.2.2  yamt static int
    646  1.4.2.2  yamt adbkbd_sysctl_button(SYSCTLFN_ARGS)
    647  1.4.2.2  yamt {
    648  1.4.2.2  yamt 	struct sysctlnode node = *rnode;
    649  1.4.2.2  yamt 	struct adbkbd_softc *sc=(struct adbkbd_softc *)node.sysctl_data;
    650  1.4.2.2  yamt 	const int *np = newp;
    651  1.4.2.2  yamt 	int btn = node.sysctl_idata, reg;
    652  1.4.2.2  yamt 
    653  1.4.2.2  yamt 	DPRINTF("adbkbd_sysctl_button %d\n", btn);
    654  1.4.2.2  yamt 	node.sysctl_idata = sc->sc_trans[btn];
    655  1.4.2.2  yamt 	reg = sc->sc_trans[btn];
    656  1.4.2.2  yamt 	if (np) {
    657  1.4.2.2  yamt 		/* we're asked to write */
    658  1.4.2.2  yamt 		node.sysctl_data = &reg;
    659  1.4.2.2  yamt 		if (sysctl_lookup(SYSCTLFN_CALL(&node)) == 0) {
    660  1.4.2.2  yamt 
    661  1.4.2.2  yamt 			sc->sc_trans[btn] = node.sysctl_idata;
    662  1.4.2.2  yamt 			return 0;
    663  1.4.2.2  yamt 		}
    664  1.4.2.2  yamt 		return EINVAL;
    665  1.4.2.2  yamt 	} else {
    666  1.4.2.2  yamt 		node.sysctl_size = 4;
    667  1.4.2.2  yamt 		return (sysctl_lookup(SYSCTLFN_CALL(&node)));
    668  1.4.2.2  yamt 	}
    669  1.4.2.2  yamt }
    670  1.4.2.2  yamt 
    671  1.4.2.2  yamt SYSCTL_SETUP(sysctl_adbkbdtrans_setup, "adbkbd translator setup")
    672  1.4.2.2  yamt {
    673  1.4.2.2  yamt 
    674  1.4.2.2  yamt 	sysctl_createv(NULL, 0, NULL, NULL,
    675  1.4.2.2  yamt 		       CTLFLAG_PERMANENT,
    676  1.4.2.2  yamt 		       CTLTYPE_NODE, "machdep", NULL,
    677  1.4.2.2  yamt 		       NULL, 0, NULL, 0,
    678  1.4.2.2  yamt 		       CTL_MACHDEP, CTL_EOL);
    679  1.4.2.2  yamt }
    680