Home | History | Annotate | Line # | Download | only in sun
kbd.c revision 1.9
      1  1.9      mrg /*	$NetBSD: kbd.c,v 1.9 1996/10/09 00:50:55 mrg Exp $	*/
      2  1.1      gwr 
      3  1.1      gwr /*
      4  1.1      gwr  * Copyright (c) 1992, 1993
      5  1.1      gwr  *	The Regents of the University of California.  All rights reserved.
      6  1.1      gwr  *
      7  1.1      gwr  * This software was developed by the Computer Systems Engineering group
      8  1.1      gwr  * at Lawrence Berkeley Laboratory under DARPA contract BG 91-66 and
      9  1.1      gwr  * contributed to Berkeley.
     10  1.1      gwr  *
     11  1.1      gwr  * All advertising materials mentioning features or use of this software
     12  1.1      gwr  * must display the following acknowledgement:
     13  1.1      gwr  *	This product includes software developed by the University of
     14  1.1      gwr  *	California, Lawrence Berkeley Laboratory.
     15  1.1      gwr  *
     16  1.1      gwr  * Redistribution and use in source and binary forms, with or without
     17  1.1      gwr  * modification, are permitted provided that the following conditions
     18  1.1      gwr  * are met:
     19  1.1      gwr  * 1. Redistributions of source code must retain the above copyright
     20  1.1      gwr  *    notice, this list of conditions and the following disclaimer.
     21  1.1      gwr  * 2. Redistributions in binary form must reproduce the above copyright
     22  1.1      gwr  *    notice, this list of conditions and the following disclaimer in the
     23  1.1      gwr  *    documentation and/or other materials provided with the distribution.
     24  1.1      gwr  * 3. All advertising materials mentioning features or use of this software
     25  1.1      gwr  *    must display the following acknowledgement:
     26  1.1      gwr  *	This product includes software developed by the University of
     27  1.1      gwr  *	California, Berkeley and its contributors.
     28  1.1      gwr  * 4. Neither the name of the University nor the names of its contributors
     29  1.1      gwr  *    may be used to endorse or promote products derived from this software
     30  1.1      gwr  *    without specific prior written permission.
     31  1.1      gwr  *
     32  1.1      gwr  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     33  1.1      gwr  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     34  1.1      gwr  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     35  1.1      gwr  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     36  1.1      gwr  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     37  1.1      gwr  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     38  1.1      gwr  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     39  1.1      gwr  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     40  1.1      gwr  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     41  1.1      gwr  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     42  1.1      gwr  * SUCH DAMAGE.
     43  1.1      gwr  *
     44  1.1      gwr  *	@(#)kbd.c	8.2 (Berkeley) 10/30/93
     45  1.1      gwr  */
     46  1.1      gwr 
     47  1.1      gwr /*
     48  1.1      gwr  * Keyboard driver (/dev/kbd -- note that we do not have minor numbers
     49  1.1      gwr  * [yet?]).  Translates incoming bytes to ASCII or to `firm_events' and
     50  1.1      gwr  * passes them up to the appropriate reader.
     51  1.1      gwr  */
     52  1.1      gwr 
     53  1.1      gwr /*
     54  1.1      gwr  * Zilog Z8530 Dual UART driver (keyboard interface)
     55  1.1      gwr  *
     56  1.1      gwr  * This is the "slave" driver that will be attached to
     57  1.1      gwr  * the "zsc" driver for a Sun keyboard.
     58  1.1      gwr  */
     59  1.1      gwr 
     60  1.1      gwr #include <sys/param.h>
     61  1.1      gwr #include <sys/systm.h>
     62  1.1      gwr #include <sys/proc.h>
     63  1.1      gwr #include <sys/device.h>
     64  1.1      gwr #include <sys/conf.h>
     65  1.1      gwr #include <sys/file.h>
     66  1.1      gwr #include <sys/ioctl.h>
     67  1.1      gwr #include <sys/time.h>
     68  1.1      gwr #include <sys/kernel.h>
     69  1.1      gwr #include <sys/syslog.h>
     70  1.9      mrg #include <sys/select.h>
     71  1.9      mrg #include <sys/poll.h>
     72  1.1      gwr 
     73  1.1      gwr #include <dev/ic/z8530reg.h>
     74  1.1      gwr #include <machine/z8530var.h>
     75  1.1      gwr #include <machine/vuid_event.h>
     76  1.1      gwr #include <machine/kbd.h>
     77  1.1      gwr #include <machine/kbio.h>
     78  1.1      gwr 
     79  1.1      gwr #include "event_var.h"
     80  1.1      gwr #include "kbd_xlate.h"
     81  1.1      gwr 
     82  1.1      gwr /*
     83  1.1      gwr  * Ideas:
     84  1.1      gwr  * /dev/kbd is not a tty (plain device)
     85  1.1      gwr  */
     86  1.1      gwr 
     87  1.1      gwr /*
     88  1.1      gwr  * How many input characters we can buffer.
     89  1.1      gwr  * The port-specific var.h may override this.
     90  1.1      gwr  * Note: must be a power of two!
     91  1.1      gwr  */
     92  1.1      gwr #define	KBD_RX_RING_SIZE	256
     93  1.1      gwr #define KBD_RX_RING_MASK (KBD_RX_RING_SIZE-1)
     94  1.1      gwr /*
     95  1.1      gwr  * Output buffer.  Only need a few chars.
     96  1.1      gwr  */
     97  1.1      gwr #define	KBD_TX_RING_SIZE	16
     98  1.1      gwr #define KBD_TX_RING_MASK (KBD_TX_RING_SIZE-1)
     99  1.1      gwr /*
    100  1.1      gwr  * Keyboard serial line speed is fixed at 1200 bps.
    101  1.1      gwr  */
    102  1.1      gwr #define KBD_BPS 1200
    103  1.1      gwr #define KBD_RESET_TIMO 1000 /* mS. */
    104  1.1      gwr 
    105  1.1      gwr /*
    106  1.1      gwr  * XXX - Historical comment - no longer quite right...
    107  1.1      gwr  * Keyboard driver state.  The ascii and kbd links go up and down and
    108  1.1      gwr  * we just sit in the middle doing translation.  Note that it is possible
    109  1.1      gwr  * to get just one of the two links, in which case /dev/kbd is unavailable.
    110  1.1      gwr  * The downlink supplies us with `internal' open and close routines which
    111  1.1      gwr  * will enable dataflow across the downlink.  We promise to call open when
    112  1.1      gwr  * we are willing to take keystrokes, and to call close when we are not.
    113  1.1      gwr  * If /dev/kbd is not the console tty input source, we do this whenever
    114  1.1      gwr  * /dev/kbd is in use; otherwise we just leave it open forever.
    115  1.1      gwr  */
    116  1.1      gwr struct kbd_softc {
    117  1.1      gwr 	struct	device k_dev;		/* required first: base device */
    118  1.1      gwr 	struct	zs_chanstate *k_cs;
    119  1.1      gwr 
    120  1.1      gwr 	/* Flags to communicate with kbd_softint() */
    121  1.1      gwr 	volatile int k_intr_flags;
    122  1.1      gwr #define	INTR_RX_OVERRUN 1
    123  1.1      gwr #define INTR_TX_EMPTY   2
    124  1.1      gwr #define INTR_ST_CHECK   4
    125  1.1      gwr 
    126  1.1      gwr 	/* Transmit state */
    127  1.1      gwr 	volatile int k_txflags;
    128  1.1      gwr #define	K_TXBUSY 1
    129  1.1      gwr #define K_TXWANT 2
    130  1.1      gwr 
    131  1.1      gwr 	/*
    132  1.1      gwr 	 * State of upper interface.
    133  1.1      gwr 	 */
    134  1.1      gwr 	int	k_isopen;		/* set if open has been done */
    135  1.1      gwr 	int	k_evmode;		/* set if we should produce events */
    136  1.1      gwr 	struct	evvar k_events;		/* event queue state */
    137  1.1      gwr 
    138  1.1      gwr 	/*
    139  1.1      gwr 	 * ACSI translation state
    140  1.1      gwr 	 */
    141  1.1      gwr 	int k_repeat_start; 	/* initial delay */
    142  1.1      gwr 	int k_repeat_step;  	/* inter-char delay */
    143  1.1      gwr 	int	k_repeatsym;		/* repeating symbol */
    144  1.1      gwr 	int	k_repeating;		/* we've called timeout() */
    145  1.1      gwr 	struct	kbd_state k_state;	/* ASCII translation state */
    146  1.1      gwr 
    147  1.1      gwr 	/*
    148  1.1      gwr 	 * Magic sequence stuff (L1-A)
    149  1.1      gwr 	 */
    150  1.1      gwr 	char k_isconsole;
    151  1.1      gwr 	char k_magic1_down;
    152  1.1      gwr 	u_char k_magic1;	/* L1 */
    153  1.1      gwr 	u_char k_magic2;	/* A */
    154  1.1      gwr 
    155  1.1      gwr 	/*
    156  1.1      gwr 	 * The transmit ring buffer.
    157  1.1      gwr 	 */
    158  1.1      gwr 	volatile u_int	k_tbget;	/* transmit buffer `get' index */
    159  1.1      gwr 	volatile u_int	k_tbput;	/* transmit buffer `put' index */
    160  1.1      gwr 	u_char	k_tbuf[KBD_TX_RING_SIZE]; /* data */
    161  1.1      gwr 
    162  1.1      gwr 	/*
    163  1.1      gwr 	 * The receive ring buffer.
    164  1.1      gwr 	 */
    165  1.1      gwr 	u_int	k_rbget;	/* ring buffer `get' index */
    166  1.1      gwr 	volatile u_int	k_rbput;	/* ring buffer `put' index */
    167  1.1      gwr 	u_short	k_rbuf[KBD_RX_RING_SIZE]; /* rr1, data pairs */
    168  1.1      gwr 
    169  1.1      gwr };
    170  1.1      gwr 
    171  1.1      gwr /* Prototypes */
    172  1.4      gwr int 	kbd_docmd(struct kbd_softc *k, int cmd);
    173  1.1      gwr int 	kbd_iopen(int unit);
    174  1.4      gwr void	kbd_new_layout(struct kbd_softc *k);
    175  1.1      gwr void	kbd_output(struct kbd_softc *k, int c);
    176  1.4      gwr void	kbd_repeat(void *arg);
    177  1.4      gwr void	kbd_set_leds(struct kbd_softc *k, int leds);
    178  1.1      gwr void	kbd_start_tx(struct kbd_softc *k);
    179  1.4      gwr void	kbd_update_leds(struct kbd_softc *k);
    180  1.4      gwr void	kbd_was_reset(struct kbd_softc *k);
    181  1.1      gwr 
    182  1.1      gwr extern void kd_input(int ascii);
    183  1.1      gwr 
    184  1.1      gwr cdev_decl(kbd);	/* open, close, read, write, ioctl, stop, ... */
    185  1.1      gwr 
    186  1.1      gwr struct zsops zsops_kbd;
    187  1.1      gwr 
    188  1.1      gwr /****************************************************************
    189  1.1      gwr  * Definition of the driver for autoconfig.
    190  1.1      gwr  ****************************************************************/
    191  1.1      gwr 
    192  1.1      gwr static int	kbd_match(struct device *, void *, void *);
    193  1.1      gwr static void	kbd_attach(struct device *, struct device *, void *);
    194  1.1      gwr 
    195  1.6      gwr struct cfattach kbd_ca = {
    196  1.5  thorpej 	sizeof(struct kbd_softc), kbd_match, kbd_attach
    197  1.5  thorpej };
    198  1.5  thorpej 
    199  1.5  thorpej struct cfdriver kbd_cd = {
    200  1.5  thorpej 	NULL, "kbd", DV_DULL
    201  1.1      gwr };
    202  1.1      gwr 
    203  1.1      gwr 
    204  1.1      gwr /*
    205  1.1      gwr  * kbd_match: how is this zs channel configured?
    206  1.1      gwr  */
    207  1.1      gwr int
    208  1.1      gwr kbd_match(parent, match, aux)
    209  1.1      gwr 	struct device *parent;
    210  1.1      gwr 	void   *match, *aux;
    211  1.1      gwr {
    212  1.1      gwr 	struct cfdata *cf = match;
    213  1.1      gwr 	struct zsc_attach_args *args = aux;
    214  1.1      gwr 
    215  1.1      gwr 	/* Exact match required for keyboard. */
    216  1.1      gwr 	if (cf->cf_loc[0] == args->channel)
    217  1.1      gwr 		return 2;
    218  1.1      gwr 
    219  1.1      gwr 	return 0;
    220  1.1      gwr }
    221  1.1      gwr 
    222  1.1      gwr void
    223  1.1      gwr kbd_attach(parent, self, aux)
    224  1.1      gwr 	struct device *parent, *self;
    225  1.1      gwr 	void   *aux;
    226  1.1      gwr 
    227  1.1      gwr {
    228  1.1      gwr 	struct zsc_softc *zsc = (void *) parent;
    229  1.1      gwr 	struct kbd_softc *k = (void *) self;
    230  1.1      gwr 	struct zsc_attach_args *args = aux;
    231  1.1      gwr 	struct zs_chanstate *cs;
    232  1.1      gwr 	struct cfdata *cf;
    233  1.1      gwr 	int channel, kbd_unit;
    234  1.1      gwr 	int reset, s, tconst;
    235  1.1      gwr 
    236  1.1      gwr 	cf = k->k_dev.dv_cfdata;
    237  1.3      gwr 	kbd_unit = k->k_dev.dv_unit;
    238  1.1      gwr 	channel = args->channel;
    239  1.1      gwr 	cs = &zsc->zsc_cs[channel];
    240  1.1      gwr 	cs->cs_private = k;
    241  1.1      gwr 	cs->cs_ops = &zsops_kbd;
    242  1.1      gwr 	k->k_cs = cs;
    243  1.1      gwr 
    244  1.1      gwr 	if (args->hwflags & ZS_HWFLAG_CONSOLE) {
    245  1.1      gwr 		k->k_isconsole = 1;
    246  1.1      gwr 		printf(" (console)");
    247  1.1      gwr 	}
    248  1.1      gwr 	printf("\n");
    249  1.1      gwr 
    250  1.1      gwr 	/* Initialize the speed, etc. */
    251  1.8      gwr 	tconst = BPS_TO_TCONST(cs->cs_brg_clk, KBD_BPS);
    252  1.1      gwr 	s = splzs();
    253  1.1      gwr 	if (k->k_isconsole == 0) {
    254  1.1      gwr 		/* Not the console; may need reset. */
    255  1.1      gwr 		reset = (channel == 0) ?
    256  1.1      gwr 			ZSWR9_A_RESET : ZSWR9_B_RESET;
    257  1.2      gwr 		zs_write_reg(cs, 9, reset);
    258  1.1      gwr 	}
    259  1.1      gwr 	/* These are OK as set by zscc: WR3, WR4, WR5 */
    260  1.1      gwr 	cs->cs_preg[5] |= ZSWR5_DTR | ZSWR5_RTS;
    261  1.1      gwr 	cs->cs_preg[12] = tconst;
    262  1.1      gwr 	cs->cs_preg[13] = tconst >> 8;
    263  1.1      gwr 	zs_loadchannelregs(cs);
    264  1.1      gwr 	splx(s);
    265  1.1      gwr 
    266  1.1      gwr 	/* Do this before any calls to kbd_rint(). */
    267  1.1      gwr 	kbd_xlate_init(&k->k_state);
    268  1.1      gwr 
    269  1.1      gwr 	/* XXX - Do this in open? */
    270  1.1      gwr 	k->k_repeat_start = hz/2;
    271  1.1      gwr 	k->k_repeat_step = hz/20;
    272  1.1      gwr 
    273  1.1      gwr 	/* Magic sequence. */
    274  1.1      gwr 	k->k_magic1 = KBD_L1;
    275  1.1      gwr 	k->k_magic2 = KBD_A;
    276  1.1      gwr 
    277  1.1      gwr 	/* Now attach the (kd) pseudo-driver. */
    278  1.1      gwr 	kd_init(kbd_unit);
    279  1.1      gwr }
    280  1.1      gwr 
    281  1.1      gwr 
    282  1.1      gwr /****************************************************************
    283  1.1      gwr  *  Entry points for /dev/kbd
    284  1.1      gwr  *  (open,close,read,write,...)
    285  1.1      gwr  ****************************************************************/
    286  1.1      gwr 
    287  1.1      gwr /*
    288  1.1      gwr  * Open:
    289  1.1      gwr  * Check exclusion, open actual device (_iopen),
    290  1.1      gwr  * setup event channel, clear ASCII repeat stuff.
    291  1.1      gwr  */
    292  1.1      gwr int
    293  1.1      gwr kbdopen(dev, flags, mode, p)
    294  1.1      gwr 	dev_t dev;
    295  1.1      gwr 	int flags, mode;
    296  1.1      gwr 	struct proc *p;
    297  1.1      gwr {
    298  1.1      gwr 	struct kbd_softc *k;
    299  1.1      gwr 	int error, s, unit;
    300  1.1      gwr 
    301  1.1      gwr 	unit = minor(dev);
    302  1.5  thorpej 	if (unit >= kbd_cd.cd_ndevs)
    303  1.1      gwr 		return (ENXIO);
    304  1.5  thorpej 	k = kbd_cd.cd_devs[unit];
    305  1.1      gwr 	if (k == NULL)
    306  1.1      gwr 		return (ENXIO);
    307  1.1      gwr 
    308  1.1      gwr 	/* Exclusive open required for /dev/kbd */
    309  1.1      gwr 	if (k->k_events.ev_io)
    310  1.1      gwr 		return (EBUSY);
    311  1.1      gwr 	k->k_events.ev_io = p;
    312  1.1      gwr 
    313  1.1      gwr 	if ((error = kbd_iopen(unit)) != 0) {
    314  1.1      gwr 		k->k_events.ev_io = NULL;
    315  1.1      gwr 		return (error);
    316  1.1      gwr 	}
    317  1.1      gwr 	ev_init(&k->k_events);
    318  1.1      gwr 	k->k_evmode = 1;	/* XXX: OK? */
    319  1.1      gwr 
    320  1.1      gwr 	if (k->k_repeating) {
    321  1.1      gwr 		k->k_repeating = 0;
    322  1.1      gwr 		untimeout(kbd_repeat, k);
    323  1.1      gwr 	}
    324  1.1      gwr 
    325  1.1      gwr 	return (0);
    326  1.1      gwr }
    327  1.1      gwr 
    328  1.1      gwr /*
    329  1.1      gwr  * Close:
    330  1.1      gwr  * Turn off event mode, dump the queue, and close the keyboard
    331  1.1      gwr  * unless it is supplying console input.
    332  1.1      gwr  */
    333  1.1      gwr int
    334  1.1      gwr kbdclose(dev, flags, mode, p)
    335  1.1      gwr 	dev_t dev;
    336  1.1      gwr 	int flags, mode;
    337  1.1      gwr 	struct proc *p;
    338  1.1      gwr {
    339  1.1      gwr 	struct kbd_softc *k;
    340  1.1      gwr 
    341  1.5  thorpej 	k = kbd_cd.cd_devs[minor(dev)];
    342  1.1      gwr 	k->k_evmode = 0;
    343  1.1      gwr 	ev_fini(&k->k_events);
    344  1.1      gwr 	k->k_events.ev_io = NULL;
    345  1.1      gwr 	return (0);
    346  1.1      gwr }
    347  1.1      gwr 
    348  1.1      gwr int
    349  1.1      gwr kbdread(dev, uio, flags)
    350  1.1      gwr 	dev_t dev;
    351  1.1      gwr 	struct uio *uio;
    352  1.1      gwr 	int flags;
    353  1.1      gwr {
    354  1.1      gwr 	struct kbd_softc *k;
    355  1.1      gwr 
    356  1.5  thorpej 	k = kbd_cd.cd_devs[minor(dev)];
    357  1.1      gwr 	return (ev_read(&k->k_events, uio, flags));
    358  1.1      gwr }
    359  1.1      gwr 
    360  1.1      gwr /* this routine should not exist, but is convenient to write here for now */
    361  1.1      gwr int
    362  1.1      gwr kbdwrite(dev, uio, flags)
    363  1.1      gwr 	dev_t dev;
    364  1.1      gwr 	struct uio *uio;
    365  1.1      gwr 	int flags;
    366  1.1      gwr {
    367  1.1      gwr 
    368  1.1      gwr 	return (EOPNOTSUPP);
    369  1.1      gwr }
    370  1.1      gwr 
    371  1.1      gwr int
    372  1.9      mrg kbdpoll(dev, events, p)
    373  1.1      gwr 	dev_t dev;
    374  1.9      mrg 	int events;
    375  1.1      gwr 	struct proc *p;
    376  1.1      gwr {
    377  1.1      gwr 	struct kbd_softc *k;
    378  1.1      gwr 
    379  1.5  thorpej 	k = kbd_cd.cd_devs[minor(dev)];
    380  1.9      mrg 	return (ev_poll(&k->k_events, events, p));
    381  1.1      gwr }
    382  1.1      gwr 
    383  1.1      gwr 
    384  1.7      gwr static int kbd_ioccmd(struct kbd_softc *k, int *data);
    385  1.1      gwr static int kbd_iockeymap __P((struct kbd_state *ks,
    386  1.1      gwr 	u_long cmd, struct kiockeymap *kio));
    387  1.1      gwr 
    388  1.7      gwr static int kbd_iocsled(struct kbd_softc *k, int *data);
    389  1.7      gwr 
    390  1.7      gwr #ifdef	KIOCGETKEY
    391  1.7      gwr static int kbd_oldkeymap __P((struct kbd_state *ks,
    392  1.7      gwr 	u_long cmd, struct okiockey *okio));
    393  1.7      gwr #endif
    394  1.7      gwr 
    395  1.1      gwr int
    396  1.1      gwr kbdioctl(dev, cmd, data, flag, p)
    397  1.1      gwr 	dev_t dev;
    398  1.1      gwr 	u_long cmd;
    399  1.1      gwr 	register caddr_t data;
    400  1.1      gwr 	int flag;
    401  1.1      gwr 	struct proc *p;
    402  1.1      gwr {
    403  1.1      gwr 	struct kbd_softc *k;
    404  1.1      gwr 	struct kbd_state *ks;
    405  1.1      gwr 	int *ip;
    406  1.1      gwr 	int error = 0;
    407  1.1      gwr 
    408  1.5  thorpej 	k = kbd_cd.cd_devs[minor(dev)];
    409  1.1      gwr 	ks = &k->k_state;
    410  1.1      gwr 
    411  1.1      gwr 	switch (cmd) {
    412  1.1      gwr 
    413  1.1      gwr 	case KIOCTRANS: 	/* Set translation mode */
    414  1.1      gwr 		ip = (int *)data;
    415  1.1      gwr 		/* We only support "raw" mode on /dev/kbd */
    416  1.1      gwr 		if (*ip != TR_UNTRANS_EVENT)
    417  1.1      gwr 			error = EINVAL;
    418  1.1      gwr 		break;
    419  1.1      gwr 
    420  1.1      gwr 	case KIOCGTRANS:	/* Get translation mode */
    421  1.1      gwr 		ip = (int *)data;
    422  1.1      gwr 		/* We only support "raw" mode on /dev/kbd */
    423  1.1      gwr 		*ip = TR_UNTRANS_EVENT;
    424  1.1      gwr 		break;
    425  1.1      gwr 
    426  1.1      gwr #ifdef	KIOCGETKEY
    427  1.1      gwr 	case KIOCGETKEY:	/* Get keymap entry (old format) */
    428  1.1      gwr 		error = kbd_oldkeymap(ks, cmd, (struct okiockey *)data);
    429  1.1      gwr 		break;
    430  1.1      gwr #endif	KIOCGETKEY */
    431  1.1      gwr 
    432  1.1      gwr 	case KIOCSKEY:  	/* Set keymap entry */
    433  1.1      gwr 		/* Don't let just anyone hose the keyboard. */
    434  1.1      gwr 		if ((error = suser(p->p_ucred, &p->p_acflag)) != 0)
    435  1.1      gwr 			return (error);
    436  1.1      gwr 		/* fallthrough */
    437  1.1      gwr 	case KIOCGKEY:  	/* Get keymap entry */
    438  1.1      gwr 		error = kbd_iockeymap(ks, cmd, (struct kiockeymap *)data);
    439  1.1      gwr 		break;
    440  1.1      gwr 
    441  1.1      gwr 	case KIOCCMD:	/* Send a command to the keyboard */
    442  1.7      gwr 		error = kbd_ioccmd(k, (int *)data);
    443  1.1      gwr 		break;
    444  1.1      gwr 
    445  1.1      gwr 	case KIOCTYPE:	/* Get keyboard type */
    446  1.1      gwr 		ip = (int *)data;
    447  1.1      gwr 		*ip = ks->kbd_id;
    448  1.1      gwr 		break;
    449  1.1      gwr 
    450  1.1      gwr 	case KIOCSDIRECT:	/* where to send input */
    451  1.1      gwr 		ip = (int *)data;
    452  1.1      gwr 		k->k_evmode = *ip;
    453  1.1      gwr 		break;
    454  1.1      gwr 
    455  1.1      gwr 	case KIOCLAYOUT:	/* Get keyboard layout */
    456  1.1      gwr 		*data = ks->kbd_layout;
    457  1.1      gwr 		break;
    458  1.1      gwr 
    459  1.1      gwr 	case KIOCSLED:
    460  1.7      gwr 		error = kbd_iocsled(k, (int *)data);
    461  1.1      gwr 		break;
    462  1.1      gwr 
    463  1.1      gwr 	case KIOCGLED:
    464  1.1      gwr 		*(char *)data = ks->kbd_leds;
    465  1.1      gwr 		break;
    466  1.1      gwr 
    467  1.1      gwr 	case FIONBIO:		/* we will remove this someday (soon???) */
    468  1.1      gwr 		break;
    469  1.1      gwr 
    470  1.1      gwr 	case FIOASYNC:
    471  1.1      gwr 		k->k_events.ev_async = *(int *)data != 0;
    472  1.1      gwr 		break;
    473  1.1      gwr 
    474  1.1      gwr 	case TIOCSPGRP:
    475  1.1      gwr 		ip = (int *)data;
    476  1.1      gwr 		if (*ip != k->k_events.ev_io->p_pgid)
    477  1.1      gwr 			error = EPERM;
    478  1.1      gwr 		break;
    479  1.1      gwr 
    480  1.1      gwr 	}
    481  1.1      gwr 
    482  1.1      gwr 	return (error);
    483  1.1      gwr }
    484  1.1      gwr 
    485  1.1      gwr /****************************************************************
    486  1.1      gwr  * ioctl helpers
    487  1.1      gwr  ****************************************************************/
    488  1.1      gwr 
    489  1.1      gwr /*
    490  1.1      gwr  * Get/Set keymap entry
    491  1.1      gwr  */
    492  1.7      gwr static int
    493  1.1      gwr kbd_iockeymap(ks, cmd, kio)
    494  1.1      gwr 	struct kbd_state *ks;
    495  1.1      gwr 	u_long cmd;
    496  1.1      gwr 	struct kiockeymap *kio;
    497  1.1      gwr {
    498  1.1      gwr 	struct keymap *km;
    499  1.1      gwr 	u_int station;
    500  1.1      gwr 
    501  1.1      gwr 	switch (kio->kio_tablemask) {
    502  1.1      gwr 	case KIOC_NOMASK:
    503  1.1      gwr 		km = ks->kbd_k.k_normal;
    504  1.1      gwr 		break;
    505  1.1      gwr 	case KIOC_SHIFTMASK:
    506  1.1      gwr 		km = ks->kbd_k.k_shifted;
    507  1.1      gwr 		break;
    508  1.1      gwr 	case KIOC_CTRLMASK:
    509  1.1      gwr 		km = ks->kbd_k.k_control;
    510  1.1      gwr 		break;
    511  1.1      gwr 	case KIOC_UPMASK:
    512  1.1      gwr 		km = ks->kbd_k.k_release;
    513  1.1      gwr 		break;
    514  1.1      gwr 	default:
    515  1.1      gwr 		/* Silently ignore unsupported masks */
    516  1.1      gwr 		return (0);
    517  1.1      gwr 	}
    518  1.1      gwr 
    519  1.1      gwr 	/* Range-check the table position. */
    520  1.1      gwr 	station = kio->kio_station;
    521  1.1      gwr 	if (station >= KEYMAP_SIZE)
    522  1.1      gwr 		return (EINVAL);
    523  1.1      gwr 
    524  1.1      gwr 	switch (cmd) {
    525  1.1      gwr 
    526  1.1      gwr 	case KIOCGKEY:	/* Get keymap entry */
    527  1.1      gwr 		kio->kio_entry = km->keymap[station];
    528  1.1      gwr 		break;
    529  1.1      gwr 
    530  1.1      gwr 	case KIOCSKEY:	/* Set keymap entry */
    531  1.1      gwr 		km->keymap[station] = kio->kio_entry;
    532  1.1      gwr 		break;
    533  1.1      gwr 
    534  1.1      gwr 	default:
    535  1.1      gwr 		return(ENOTTY);
    536  1.1      gwr 	}
    537  1.1      gwr 	return (0);
    538  1.1      gwr }
    539  1.1      gwr 
    540  1.1      gwr #ifdef	KIOCGETKEY
    541  1.1      gwr /*
    542  1.1      gwr  * Get/Set keymap entry,
    543  1.1      gwr  * old format (compatibility)
    544  1.1      gwr  */
    545  1.1      gwr int
    546  1.1      gwr kbd_oldkeymap(ks, cmd, kio)
    547  1.1      gwr 	struct kbd_state *ks;
    548  1.1      gwr 	u_long cmd;
    549  1.1      gwr 	struct okiockey *kio;
    550  1.1      gwr {
    551  1.1      gwr 	int error = 0;
    552  1.1      gwr 
    553  1.1      gwr 	switch (cmd) {
    554  1.1      gwr 
    555  1.1      gwr 	case KIOCGETKEY:
    556  1.1      gwr 		if (kio->kio_station == 118) {
    557  1.1      gwr 			/*
    558  1.1      gwr 			 * This is X11 asking if a type 3 keyboard is
    559  1.1      gwr 			 * really a type 3 keyboard.  Say yes, it is,
    560  1.1      gwr 			 * by reporting key station 118 as a "hole".
    561  1.1      gwr 			 * Note old (SunOS 3.5) definition of HOLE!
    562  1.1      gwr 			 */
    563  1.1      gwr 			kio->kio_entry = 0xA2;
    564  1.1      gwr 			break;
    565  1.1      gwr 		}
    566  1.1      gwr 		/* fall through */
    567  1.1      gwr 
    568  1.1      gwr 	default:
    569  1.1      gwr 		error = ENOTTY;
    570  1.1      gwr 		break;
    571  1.1      gwr 	}
    572  1.1      gwr 
    573  1.1      gwr 	return (error);
    574  1.1      gwr }
    575  1.1      gwr #endif	/* KIOCGETKEY */
    576  1.1      gwr 
    577  1.7      gwr 
    578  1.7      gwr /*
    579  1.7      gwr  * keyboard command ioctl
    580  1.7      gwr  * ``unimplemented commands are ignored'' (blech)
    581  1.7      gwr  */
    582  1.7      gwr static int
    583  1.7      gwr kbd_ioccmd(k, data)
    584  1.7      gwr 	struct kbd_softc *k;
    585  1.7      gwr 	int *data;
    586  1.7      gwr {
    587  1.7      gwr 	struct kbd_state *ks = &k->k_state;
    588  1.7      gwr 	int cmd, error, s;
    589  1.7      gwr 
    590  1.7      gwr 	cmd = *data;
    591  1.7      gwr 	switch (cmd) {
    592  1.7      gwr 
    593  1.7      gwr 	case KBD_CMD_BELL:
    594  1.7      gwr 	case KBD_CMD_NOBELL:
    595  1.7      gwr 		/* Supported by type 2, 3, and 4 keyboards */
    596  1.7      gwr 		break;
    597  1.7      gwr 
    598  1.7      gwr 	case KBD_CMD_CLICK:
    599  1.7      gwr 	case KBD_CMD_NOCLICK:
    600  1.7      gwr 		/* Unsupported by type 2 keyboards */
    601  1.7      gwr 		if (ks->kbd_id <= KB_SUN2)
    602  1.7      gwr 			return (0);
    603  1.7      gwr 		ks->kbd_click = (cmd == KBD_CMD_CLICK);
    604  1.7      gwr 		break;
    605  1.7      gwr 
    606  1.7      gwr 	default:
    607  1.7      gwr 		return (0);
    608  1.7      gwr 	}
    609  1.7      gwr 
    610  1.7      gwr 	s = spltty();
    611  1.7      gwr 
    612  1.7      gwr 	error = kbd_drain_tx(k);
    613  1.7      gwr 	if (error == 0) {
    614  1.7      gwr 		kbd_output(k, cmd);
    615  1.7      gwr 		kbd_start_tx(k);
    616  1.7      gwr 	}
    617  1.7      gwr 
    618  1.7      gwr 	splx(s);
    619  1.7      gwr 
    620  1.7      gwr 	return (error);
    621  1.7      gwr }
    622  1.7      gwr 
    623  1.7      gwr /*
    624  1.7      gwr  * Set LEDs ioctl.
    625  1.7      gwr  */
    626  1.7      gwr static int
    627  1.7      gwr kbd_iocsled(k, data)
    628  1.7      gwr 	struct kbd_softc *k;
    629  1.7      gwr 	int *data;
    630  1.7      gwr {
    631  1.7      gwr 	struct kbd_state *ks = &k->k_state;
    632  1.7      gwr 	int leds, error, s;
    633  1.7      gwr 
    634  1.7      gwr 	leds = *data;
    635  1.7      gwr 
    636  1.7      gwr 	s = spltty();
    637  1.7      gwr 	error = kbd_drain_tx(k);
    638  1.7      gwr 	if (error == 0) {
    639  1.7      gwr 		kbd_set_leds(k, leds);
    640  1.7      gwr 	}
    641  1.7      gwr 	splx(s);
    642  1.7      gwr 
    643  1.7      gwr 	return (error);
    644  1.7      gwr }
    645  1.7      gwr 
    646  1.7      gwr 
    647  1.1      gwr /****************************************************************
    648  1.1      gwr  * middle layers:
    649  1.1      gwr  *  - keysym to ASCII sequence
    650  1.1      gwr  *  - raw key codes to keysym
    651  1.1      gwr  ****************************************************************/
    652  1.1      gwr 
    653  1.1      gwr 
    654  1.1      gwr /*
    655  1.1      gwr  * Initialization done by either kdcninit or kbd_iopen
    656  1.1      gwr  */
    657  1.1      gwr void
    658  1.1      gwr kbd_xlate_init(ks)
    659  1.1      gwr 	struct kbd_state *ks;
    660  1.1      gwr {
    661  1.1      gwr 	struct keyboard *ktbls;
    662  1.1      gwr 	int id;
    663  1.1      gwr 
    664  1.1      gwr 	id = ks->kbd_id;
    665  1.1      gwr 	if (id < KBD_MIN_TYPE)
    666  1.1      gwr 		id = KBD_MIN_TYPE;
    667  1.1      gwr 	if (id > kbd_max_type)
    668  1.1      gwr 		id = kbd_max_type;
    669  1.1      gwr 	ktbls = keyboards[id];
    670  1.1      gwr 
    671  1.1      gwr 	ks->kbd_k = *ktbls; 	/* struct assignment */
    672  1.1      gwr 	ks->kbd_modbits = 0;
    673  1.1      gwr }
    674  1.1      gwr 
    675  1.1      gwr /*
    676  1.1      gwr  * Turn keyboard up/down codes into a KEYSYM.
    677  1.1      gwr  * Note that the "kd" driver uses this too!
    678  1.1      gwr  */
    679  1.1      gwr int
    680  1.1      gwr kbd_code_to_keysym(ks, c)
    681  1.1      gwr 	register struct kbd_state *ks;
    682  1.1      gwr 	register int c;
    683  1.1      gwr {
    684  1.1      gwr 	struct keymap *km;
    685  1.1      gwr 	int keysym;
    686  1.1      gwr 
    687  1.1      gwr 	/*
    688  1.1      gwr 	 * Get keymap pointer.  One of these:
    689  1.1      gwr 	 * release, control, shifted, normal, ...
    690  1.1      gwr 	 */
    691  1.1      gwr 	if (KEY_UP(c))
    692  1.1      gwr 		km = ks->kbd_k.k_release;
    693  1.4      gwr 	else if (ks->kbd_modbits & KBMOD_CTRL_MASK)
    694  1.4      gwr 		km = ks->kbd_k.k_control;
    695  1.4      gwr 	else if (ks->kbd_modbits & KBMOD_SHIFT_MASK)
    696  1.4      gwr 		km = ks->kbd_k.k_shifted;
    697  1.4      gwr 	else
    698  1.4      gwr 		km = ks->kbd_k.k_normal;
    699  1.4      gwr 
    700  1.1      gwr 	if (km == NULL) {
    701  1.1      gwr 		/*
    702  1.1      gwr 		 * Do not know how to translate yet.
    703  1.1      gwr 		 * We will find out when a RESET comes along.
    704  1.1      gwr 		 */
    705  1.4      gwr 		return (KEYSYM_NOP);
    706  1.4      gwr 	}
    707  1.4      gwr 	keysym = km->keymap[KEY_CODE(c)];
    708  1.4      gwr 
    709  1.4      gwr 	/*
    710  1.4      gwr 	 * Post-processing for Caps-lock
    711  1.4      gwr 	 */
    712  1.4      gwr 	if ((ks->kbd_modbits & (1 << KBMOD_CAPSLOCK)) &&
    713  1.4      gwr 		(KEYSYM_CLASS(keysym) == KEYSYM_ASCII) )
    714  1.4      gwr 	{
    715  1.4      gwr 		if (('a' <= keysym) && (keysym <= 'z'))
    716  1.4      gwr 			keysym -= ('a' - 'A');
    717  1.4      gwr 	}
    718  1.4      gwr 
    719  1.4      gwr 	/*
    720  1.4      gwr 	 * Post-processing for Num-lock
    721  1.4      gwr 	 */
    722  1.4      gwr 	if ((ks->kbd_modbits & (1 << KBMOD_NUMLOCK)) &&
    723  1.4      gwr 		(KEYSYM_CLASS(keysym) == KEYSYM_FUNC) )
    724  1.4      gwr 	{
    725  1.4      gwr 		keysym = kbd_numlock_map[keysym & 0x3F];
    726  1.4      gwr 	}
    727  1.1      gwr 
    728  1.1      gwr 	return (keysym);
    729  1.1      gwr }
    730  1.1      gwr 
    731  1.1      gwr void
    732  1.1      gwr kbd_input_string(k, str)
    733  1.1      gwr 	struct kbd_softc *k;
    734  1.1      gwr 	char *str;
    735  1.1      gwr {
    736  1.1      gwr 	while (*str) {
    737  1.1      gwr 		kd_input(*str);
    738  1.1      gwr 		str++;
    739  1.1      gwr 	}
    740  1.1      gwr }
    741  1.1      gwr 
    742  1.1      gwr void
    743  1.1      gwr kbd_input_funckey(k, keysym)
    744  1.1      gwr 	struct kbd_softc *k;
    745  1.1      gwr 	register int keysym;
    746  1.1      gwr {
    747  1.1      gwr 	register int n;
    748  1.1      gwr 	char str[12];
    749  1.1      gwr 
    750  1.1      gwr 	/*
    751  1.1      gwr 	 * Format the F-key sequence and send as a string.
    752  1.1      gwr 	 * XXX: Ugly compatibility mappings.
    753  1.1      gwr 	 */
    754  1.1      gwr 	n = 0xC0 + (keysym & 0x3F);
    755  1.1      gwr 	sprintf(str, "\033[%dz", n);
    756  1.1      gwr 	kbd_input_string(k, str);
    757  1.1      gwr }
    758  1.1      gwr 
    759  1.1      gwr /*
    760  1.1      gwr  * This is called by kbd_input_raw() or by kb_repeat()
    761  1.7      gwr  * to deliver ASCII input.  Called at spltty().
    762  1.1      gwr  */
    763  1.1      gwr void
    764  1.1      gwr kbd_input_keysym(k, keysym)
    765  1.1      gwr 	struct kbd_softc *k;
    766  1.1      gwr 	register int keysym;
    767  1.1      gwr {
    768  1.1      gwr 	struct kbd_state *ks = &k->k_state;
    769  1.4      gwr 	register int data;
    770  1.1      gwr 
    771  1.4      gwr 	switch (KEYSYM_CLASS(keysym)) {
    772  1.1      gwr 
    773  1.1      gwr 	case KEYSYM_ASCII:
    774  1.1      gwr 		data = KEYSYM_DATA(keysym);
    775  1.1      gwr 		if (ks->kbd_modbits & KBMOD_META_MASK)
    776  1.1      gwr 			data |= 0x80;
    777  1.1      gwr 		kd_input(data);
    778  1.1      gwr 		break;
    779  1.1      gwr 
    780  1.1      gwr 	case KEYSYM_STRING:
    781  1.1      gwr 		data = keysym & 0xF;
    782  1.1      gwr 		kbd_input_string(k, kbd_stringtab[data]);
    783  1.1      gwr 		break;
    784  1.1      gwr 
    785  1.1      gwr 	case KEYSYM_FUNC:
    786  1.1      gwr 		kbd_input_funckey(k, keysym);
    787  1.1      gwr 		break;
    788  1.1      gwr 
    789  1.1      gwr 	case KEYSYM_CLRMOD:
    790  1.1      gwr 		data = 1 << (keysym & 0x1F);
    791  1.1      gwr 		ks->kbd_modbits &= ~data;
    792  1.1      gwr 		break;
    793  1.1      gwr 
    794  1.1      gwr 	case KEYSYM_SETMOD:
    795  1.1      gwr 		data = 1 << (keysym & 0x1F);
    796  1.1      gwr 		ks->kbd_modbits |= data;
    797  1.1      gwr 		break;
    798  1.1      gwr 
    799  1.1      gwr 	case KEYSYM_INVMOD:
    800  1.1      gwr 		data = 1 << (keysym & 0x1F);
    801  1.1      gwr 		ks->kbd_modbits ^= data;
    802  1.4      gwr 		kbd_update_leds(k);
    803  1.1      gwr 		break;
    804  1.1      gwr 
    805  1.1      gwr 	case KEYSYM_ALL_UP:
    806  1.1      gwr 		ks->kbd_modbits &= ~0xFFFF;
    807  1.1      gwr 		break;
    808  1.1      gwr 
    809  1.1      gwr 	case KEYSYM_SPECIAL:
    810  1.1      gwr 		if (keysym == KEYSYM_NOP)
    811  1.1      gwr 			break;
    812  1.1      gwr 		/* fall through */
    813  1.1      gwr 	default:
    814  1.1      gwr 		log(LOG_WARNING, "%s: unexpected keysym 0x%x\n",
    815  1.1      gwr 			k->k_dev.dv_xname, keysym);
    816  1.1      gwr 		break;
    817  1.1      gwr 	}
    818  1.1      gwr }
    819  1.1      gwr 
    820  1.1      gwr /*
    821  1.1      gwr  * This is the autorepeat timeout function.
    822  1.7      gwr  * Called at splsoftclock().
    823  1.1      gwr  */
    824  1.1      gwr void
    825  1.1      gwr kbd_repeat(void *arg)
    826  1.1      gwr {
    827  1.1      gwr 	struct kbd_softc *k = (struct kbd_softc *)arg;
    828  1.7      gwr 	int s = spltty();
    829  1.1      gwr 
    830  1.1      gwr 	if (k->k_repeating && k->k_repeatsym >= 0) {
    831  1.1      gwr 		kbd_input_keysym(k, k->k_repeatsym);
    832  1.1      gwr 		timeout(kbd_repeat, k, k->k_repeat_step);
    833  1.1      gwr 	}
    834  1.7      gwr 	splx(s);
    835  1.1      gwr }
    836  1.1      gwr 
    837  1.1      gwr /*
    838  1.1      gwr  * Called by our kbd_softint() routine on input,
    839  1.1      gwr  * which passes the raw hardware scan codes.
    840  1.7      gwr  * Called at spltty()
    841  1.1      gwr  */
    842  1.1      gwr void
    843  1.1      gwr kbd_input_raw(k, c)
    844  1.1      gwr 	struct kbd_softc *k;
    845  1.1      gwr 	register int c;
    846  1.1      gwr {
    847  1.1      gwr 	struct kbd_state *ks = &k->k_state;
    848  1.1      gwr 	struct firm_event *fe;
    849  1.1      gwr 	int put, keysym;
    850  1.1      gwr 
    851  1.1      gwr 	/* XXX - Input errors already handled. */
    852  1.1      gwr 
    853  1.1      gwr 	/* Are we expecting special input? */
    854  1.1      gwr 	if (ks->kbd_expect) {
    855  1.1      gwr 		if (ks->kbd_expect & KBD_EXPECT_IDCODE) {
    856  1.1      gwr 			/* We read a KBD_RESET last time. */
    857  1.1      gwr 			ks->kbd_id = c;
    858  1.1      gwr 			kbd_was_reset(k);
    859  1.1      gwr 		}
    860  1.1      gwr 		if (ks->kbd_expect & KBD_EXPECT_LAYOUT) {
    861  1.1      gwr 			/* We read a KBD_LAYOUT last time. */
    862  1.1      gwr 			ks->kbd_layout = c;
    863  1.1      gwr 			kbd_new_layout(k);
    864  1.1      gwr 		}
    865  1.1      gwr 		ks->kbd_expect = 0;
    866  1.1      gwr 		return;
    867  1.1      gwr 	}
    868  1.1      gwr 
    869  1.1      gwr 	/* Is this one of the "special" input codes? */
    870  1.1      gwr 	if (KBD_SPECIAL(c)) {
    871  1.1      gwr 		switch (c) {
    872  1.1      gwr 		case KBD_RESET:
    873  1.1      gwr 			ks->kbd_expect |= KBD_EXPECT_IDCODE;
    874  1.1      gwr 			/* Fake an "all-up" to resync. translation. */
    875  1.1      gwr 			c = KBD_IDLE;
    876  1.1      gwr 			break;
    877  1.1      gwr 
    878  1.1      gwr 		case KBD_LAYOUT:
    879  1.1      gwr 			ks->kbd_expect |= KBD_EXPECT_LAYOUT;
    880  1.1      gwr 			return;
    881  1.1      gwr 
    882  1.1      gwr 		case KBD_ERROR:
    883  1.1      gwr 			log(LOG_WARNING, "%s: received error indicator\n",
    884  1.1      gwr 				k->k_dev.dv_xname);
    885  1.1      gwr 			return;
    886  1.1      gwr 
    887  1.1      gwr 		case KBD_IDLE:
    888  1.1      gwr 			/* Let this go to the translator. */
    889  1.1      gwr 			break;
    890  1.1      gwr 		}
    891  1.1      gwr 	}
    892  1.1      gwr 
    893  1.1      gwr 	/*
    894  1.1      gwr 	 * If /dev/kbd is not connected in event mode,
    895  1.1      gwr 	 * translate and send upstream (to console).
    896  1.1      gwr 	 */
    897  1.1      gwr 	if (!k->k_evmode) {
    898  1.1      gwr 
    899  1.1      gwr 		/* Any input stops auto-repeat (i.e. key release). */
    900  1.1      gwr 		if (k->k_repeating) {
    901  1.1      gwr 			k->k_repeating = 0;
    902  1.1      gwr 			untimeout(kbd_repeat, k);
    903  1.1      gwr 		}
    904  1.1      gwr 
    905  1.1      gwr 		/* Translate this code to a keysym */
    906  1.1      gwr 		keysym = kbd_code_to_keysym(ks, c);
    907  1.1      gwr 
    908  1.1      gwr 		/* Pass up to the next layer. */
    909  1.1      gwr 		kbd_input_keysym(k, keysym);
    910  1.1      gwr 
    911  1.1      gwr 		/* Does this symbol get auto-repeat? */
    912  1.1      gwr 		if (KEYSYM_NOREPEAT(keysym))
    913  1.1      gwr 			return;
    914  1.1      gwr 
    915  1.1      gwr 		/* Setup for auto-repeat after initial delay. */
    916  1.1      gwr 		k->k_repeating = 1;
    917  1.1      gwr 		k->k_repeatsym = keysym;
    918  1.1      gwr 		timeout(kbd_repeat, k, k->k_repeat_start);
    919  1.1      gwr 		return;
    920  1.1      gwr 	}
    921  1.1      gwr 
    922  1.1      gwr 	/*
    923  1.1      gwr 	 * IDLEs confuse the MIT X11R4 server badly, so we must drop them.
    924  1.1      gwr 	 * This is bad as it means the server will not automatically resync
    925  1.1      gwr 	 * on all-up IDLEs, but I did not drop them before, and the server
    926  1.1      gwr 	 * goes crazy when it comes time to blank the screen....
    927  1.1      gwr 	 */
    928  1.1      gwr 	if (c == KBD_IDLE)
    929  1.1      gwr 		return;
    930  1.1      gwr 
    931  1.1      gwr 	/*
    932  1.1      gwr 	 * Keyboard is generating events.  Turn this keystroke into an
    933  1.1      gwr 	 * event and put it in the queue.  If the queue is full, the
    934  1.1      gwr 	 * keystroke is lost (sorry!).
    935  1.1      gwr 	 */
    936  1.1      gwr 	put = k->k_events.ev_put;
    937  1.1      gwr 	fe = &k->k_events.ev_q[put];
    938  1.1      gwr 	put = (put + 1) % EV_QSIZE;
    939  1.1      gwr 	if (put == k->k_events.ev_get) {
    940  1.1      gwr 		log(LOG_WARNING, "%s: event queue overflow\n",
    941  1.1      gwr 			k->k_dev.dv_xname); /* ??? */
    942  1.1      gwr 		return;
    943  1.1      gwr 	}
    944  1.1      gwr 	fe->id = KEY_CODE(c);
    945  1.1      gwr 	fe->value = KEY_UP(c) ? VKEY_UP : VKEY_DOWN;
    946  1.1      gwr 	fe->time = time;
    947  1.1      gwr 	k->k_events.ev_put = put;
    948  1.1      gwr 	EV_WAKEUP(&k->k_events);
    949  1.1      gwr }
    950  1.1      gwr 
    951  1.1      gwr /****************************************************************
    952  1.1      gwr  * Interface to the lower layer (zscc)
    953  1.1      gwr  ****************************************************************/
    954  1.1      gwr 
    955  1.7      gwr static void
    956  1.1      gwr kbd_rxint(cs)
    957  1.1      gwr 	register struct zs_chanstate *cs;
    958  1.1      gwr {
    959  1.1      gwr 	register struct kbd_softc *k;
    960  1.1      gwr 	register int put, put_next;
    961  1.1      gwr 	register u_char c, rr1;
    962  1.1      gwr 
    963  1.1      gwr 	k = cs->cs_private;
    964  1.1      gwr 	put = k->k_rbput;
    965  1.1      gwr 
    966  1.7      gwr 	/*
    967  1.7      gwr 	 * First read the status, because reading the received char
    968  1.7      gwr 	 * destroys the status of this char.
    969  1.7      gwr 	 */
    970  1.7      gwr 	rr1 = zs_read_reg(cs, 1);
    971  1.2      gwr 	c = zs_read_data(cs);
    972  1.1      gwr 
    973  1.1      gwr 	if (rr1 & (ZSRR1_FE | ZSRR1_DO | ZSRR1_PE)) {
    974  1.1      gwr 		/* Clear the receive error. */
    975  1.2      gwr 		zs_write_csr(cs, ZSWR0_RESET_ERRORS);
    976  1.1      gwr 	}
    977  1.1      gwr 
    978  1.1      gwr 	/*
    979  1.1      gwr 	 * Check NOW for a console abort sequence, so that we can
    980  1.1      gwr 	 * abort even when interrupts are locking up the machine.
    981  1.1      gwr 	 */
    982  1.1      gwr 	if (k->k_magic1_down) {
    983  1.1      gwr 		/* The last keycode was "MAGIC1" down. */
    984  1.1      gwr 		k->k_magic1_down = 0;
    985  1.1      gwr 		if ((c == k->k_magic2) && k->k_isconsole) {
    986  1.1      gwr 			/* Magic "L1-A" sequence; enter debugger. */
    987  1.1      gwr 			zs_abort();
    988  1.1      gwr 			/* Debugger done.  Fake L1-up to finish it. */
    989  1.1      gwr 			c = k->k_magic1 | KBD_UP;
    990  1.1      gwr 		}
    991  1.1      gwr 	}
    992  1.1      gwr 	if (c == k->k_magic1) {
    993  1.1      gwr 		k->k_magic1_down = 1;
    994  1.1      gwr 	}
    995  1.1      gwr 
    996  1.1      gwr 	k->k_rbuf[put] = (c << 8) | rr1;
    997  1.1      gwr 	put_next = (put + 1) & KBD_RX_RING_MASK;
    998  1.1      gwr 
    999  1.1      gwr 	/* Would overrun if increment makes (put==get). */
   1000  1.1      gwr 	if (put_next == k->k_rbget) {
   1001  1.1      gwr 		k->k_intr_flags |= INTR_RX_OVERRUN;
   1002  1.1      gwr 	} else {
   1003  1.1      gwr 		/* OK, really increment. */
   1004  1.1      gwr 		put = put_next;
   1005  1.1      gwr 	}
   1006  1.1      gwr 
   1007  1.1      gwr 	/* Done reading. */
   1008  1.1      gwr 	k->k_rbput = put;
   1009  1.1      gwr 
   1010  1.1      gwr 	/* Ask for softint() call. */
   1011  1.1      gwr 	cs->cs_softreq = 1;
   1012  1.1      gwr }
   1013  1.1      gwr 
   1014  1.1      gwr 
   1015  1.7      gwr static void
   1016  1.1      gwr kbd_txint(cs)
   1017  1.1      gwr 	register struct zs_chanstate *cs;
   1018  1.1      gwr {
   1019  1.1      gwr 	register struct kbd_softc *k;
   1020  1.1      gwr 
   1021  1.1      gwr 	k = cs->cs_private;
   1022  1.2      gwr 	zs_write_csr(cs, ZSWR0_RESET_TXINT);
   1023  1.1      gwr 	k->k_intr_flags |= INTR_TX_EMPTY;
   1024  1.1      gwr 	/* Ask for softint() call. */
   1025  1.1      gwr 	cs->cs_softreq = 1;
   1026  1.1      gwr }
   1027  1.1      gwr 
   1028  1.1      gwr 
   1029  1.7      gwr static void
   1030  1.1      gwr kbd_stint(cs)
   1031  1.1      gwr 	register struct zs_chanstate *cs;
   1032  1.1      gwr {
   1033  1.1      gwr 	register struct kbd_softc *k;
   1034  1.1      gwr 	register int rr0;
   1035  1.1      gwr 
   1036  1.1      gwr 	k = cs->cs_private;
   1037  1.1      gwr 
   1038  1.7      gwr 	cs->cs_rr0_new = zs_read_csr(cs);
   1039  1.2      gwr 	zs_write_csr(cs, ZSWR0_RESET_STATUS);
   1040  1.1      gwr 
   1041  1.1      gwr #if 0
   1042  1.1      gwr 	if (rr0 & ZSRR0_BREAK) {
   1043  1.1      gwr 		/* Keyboard unplugged? */
   1044  1.1      gwr 		zs_abort();
   1045  1.1      gwr 		return (0);
   1046  1.1      gwr 	}
   1047  1.1      gwr #endif
   1048  1.1      gwr 
   1049  1.1      gwr 	k->k_intr_flags |= INTR_ST_CHECK;
   1050  1.1      gwr 	/* Ask for softint() call. */
   1051  1.1      gwr 	cs->cs_softreq = 1;
   1052  1.1      gwr }
   1053  1.1      gwr 
   1054  1.1      gwr /*
   1055  1.1      gwr  * Get input from the recieve ring and pass it on.
   1056  1.1      gwr  * Note: this is called at splsoftclock()
   1057  1.1      gwr  */
   1058  1.7      gwr static void
   1059  1.1      gwr kbd_softint(cs)
   1060  1.1      gwr 	struct zs_chanstate *cs;
   1061  1.1      gwr {
   1062  1.1      gwr 	register struct kbd_softc *k;
   1063  1.1      gwr 	register int get, c, s;
   1064  1.1      gwr 	int intr_flags;
   1065  1.1      gwr 	register u_short ring_data;
   1066  1.1      gwr 	register u_char rr0, rr1;
   1067  1.1      gwr 
   1068  1.1      gwr 	k = cs->cs_private;
   1069  1.1      gwr 
   1070  1.1      gwr 	/* Atomically get and clear flags. */
   1071  1.1      gwr 	s = splzs();
   1072  1.1      gwr 	intr_flags = k->k_intr_flags;
   1073  1.1      gwr 	k->k_intr_flags = 0;
   1074  1.7      gwr 
   1075  1.7      gwr 	/* Now lower to spltty for the rest. */
   1076  1.7      gwr 	(void) spltty();
   1077  1.1      gwr 
   1078  1.1      gwr 	/*
   1079  1.1      gwr 	 * Copy data from the receive ring to the event layer.
   1080  1.1      gwr 	 */
   1081  1.1      gwr 	get = k->k_rbget;
   1082  1.1      gwr 	while (get != k->k_rbput) {
   1083  1.1      gwr 		ring_data = k->k_rbuf[get];
   1084  1.1      gwr 		get = (get + 1) & KBD_RX_RING_MASK;
   1085  1.1      gwr 
   1086  1.1      gwr 		/* low byte of ring_data is rr1 */
   1087  1.1      gwr 		c = (ring_data >> 8) & 0xff;
   1088  1.1      gwr 
   1089  1.1      gwr 		if (ring_data & ZSRR1_DO)
   1090  1.1      gwr 			intr_flags |= INTR_RX_OVERRUN;
   1091  1.1      gwr 		if (ring_data & (ZSRR1_FE | ZSRR1_PE)) {
   1092  1.1      gwr 			/*
   1093  1.1      gwr 			 * After garbage, flush pending input, and
   1094  1.1      gwr 			 * send a reset to resync key translation.
   1095  1.1      gwr 			 */
   1096  1.1      gwr 			log(LOG_ERR, "%s: input error (0x%x)\n",
   1097  1.1      gwr 				k->k_dev.dv_xname, ring_data);
   1098  1.1      gwr 			get = k->k_rbput; /* flush */
   1099  1.1      gwr 			goto send_reset;
   1100  1.1      gwr 		}
   1101  1.1      gwr 
   1102  1.1      gwr 		/* Pass this up to the "middle" layer. */
   1103  1.1      gwr 		kbd_input_raw(k, c);
   1104  1.1      gwr 	}
   1105  1.1      gwr 	if (intr_flags & INTR_RX_OVERRUN) {
   1106  1.1      gwr 		log(LOG_ERR, "%s: input overrun\n",
   1107  1.1      gwr 		    k->k_dev.dv_xname);
   1108  1.1      gwr 	send_reset:
   1109  1.1      gwr 		/* Send a reset to resync translation. */
   1110  1.1      gwr 		kbd_output(k, KBD_CMD_RESET);
   1111  1.1      gwr 		kbd_start_tx(k);
   1112  1.1      gwr 	}
   1113  1.1      gwr 	k->k_rbget = get;
   1114  1.1      gwr 
   1115  1.1      gwr 	if (intr_flags & INTR_TX_EMPTY) {
   1116  1.1      gwr 		/*
   1117  1.1      gwr 		 * Transmit done.  Try to send more, or
   1118  1.1      gwr 		 * clear busy and wakeup drain waiters.
   1119  1.1      gwr 		 */
   1120  1.1      gwr 		k->k_txflags &= ~K_TXBUSY;
   1121  1.1      gwr 		kbd_start_tx(k);
   1122  1.1      gwr 	}
   1123  1.1      gwr 
   1124  1.1      gwr 	if (intr_flags & INTR_ST_CHECK) {
   1125  1.1      gwr 		/*
   1126  1.1      gwr 		 * Status line change.  (Not expected.)
   1127  1.1      gwr 		 */
   1128  1.1      gwr 		log(LOG_ERR, "%s: status interrupt?\n",
   1129  1.1      gwr 		    k->k_dev.dv_xname);
   1130  1.7      gwr 		cs->cs_rr0 = cs->cs_rr0_new;
   1131  1.1      gwr 	}
   1132  1.1      gwr 
   1133  1.7      gwr 	splx(s);
   1134  1.1      gwr }
   1135  1.1      gwr 
   1136  1.1      gwr struct zsops zsops_kbd = {
   1137  1.1      gwr 	kbd_rxint,	/* receive char available */
   1138  1.1      gwr 	kbd_stint,	/* external/status */
   1139  1.1      gwr 	kbd_txint,	/* xmit buffer empty */
   1140  1.1      gwr 	kbd_softint,	/* process software interrupt */
   1141  1.1      gwr };
   1142  1.1      gwr 
   1143  1.1      gwr /****************************************************************
   1144  1.1      gwr  * misc...
   1145  1.1      gwr  ****************************************************************/
   1146  1.1      gwr 
   1147  1.1      gwr /*
   1148  1.1      gwr  * Initialization to be done at first open.
   1149  1.1      gwr  * This is called from kbdopen or kdopen (in kd.c)
   1150  1.7      gwr  * Called with user context.
   1151  1.1      gwr  */
   1152  1.1      gwr int
   1153  1.1      gwr kbd_iopen(unit)
   1154  1.1      gwr 	int unit;
   1155  1.1      gwr {
   1156  1.1      gwr 	struct kbd_softc *k;
   1157  1.1      gwr 	struct kbd_state *ks;
   1158  1.1      gwr 	int error, s;
   1159  1.1      gwr 
   1160  1.5  thorpej 	if (unit >= kbd_cd.cd_ndevs)
   1161  1.1      gwr 		return (ENXIO);
   1162  1.5  thorpej 	k = kbd_cd.cd_devs[unit];
   1163  1.1      gwr 	if (k == NULL)
   1164  1.1      gwr 		return (ENXIO);
   1165  1.1      gwr 	ks = &k->k_state;
   1166  1.1      gwr 	error = 0;
   1167  1.1      gwr 
   1168  1.1      gwr 	/* Tolerate extra calls. */
   1169  1.1      gwr 	if (k->k_isopen)
   1170  1.1      gwr 		return (error);
   1171  1.1      gwr 
   1172  1.1      gwr 	s = spltty();
   1173  1.1      gwr 
   1174  1.1      gwr 	/* Reset the keyboard and find out its type. */
   1175  1.1      gwr 	kbd_output(k, KBD_CMD_RESET);
   1176  1.1      gwr 	kbd_start_tx(k);
   1177  1.1      gwr 	kbd_drain_tx(k);
   1178  1.1      gwr 	/* The wakeup for this is in kbd_was_reset(). */
   1179  1.1      gwr 	error = tsleep((caddr_t)&ks->kbd_id,
   1180  1.1      gwr 				   PZERO | PCATCH, devopn, hz);
   1181  1.1      gwr 	if (error == EWOULDBLOCK) { 	/* no response */
   1182  1.1      gwr 		error = 0;
   1183  1.1      gwr 		log(LOG_ERR, "%s: reset failed\n",
   1184  1.1      gwr 			k->k_dev.dv_xname);
   1185  1.1      gwr 		/*
   1186  1.1      gwr 		 * Allow the open anyway (to keep getty happy)
   1187  1.1      gwr 		 * but assume the "least common denominator".
   1188  1.1      gwr 		 */
   1189  1.1      gwr 		ks->kbd_id = KB_SUN2;
   1190  1.1      gwr 	}
   1191  1.1      gwr 
   1192  1.1      gwr 	/* Earlier than type 4 does not know "layout". */
   1193  1.1      gwr 	if (ks->kbd_id < KB_SUN4)
   1194  1.1      gwr 		goto out;
   1195  1.1      gwr 
   1196  1.1      gwr 	/* Ask for the layout. */
   1197  1.1      gwr 	kbd_output(k, KBD_CMD_GETLAYOUT);
   1198  1.1      gwr 	kbd_start_tx(k);
   1199  1.1      gwr 	kbd_drain_tx(k);
   1200  1.1      gwr 	/* The wakeup for this is in kbd_new_layout(). */
   1201  1.1      gwr 	error = tsleep((caddr_t)&ks->kbd_layout,
   1202  1.1      gwr 				   PZERO | PCATCH, devopn, hz);
   1203  1.1      gwr 	if (error == EWOULDBLOCK) { 	/* no response */
   1204  1.1      gwr 		error = 0;
   1205  1.1      gwr 		log(LOG_ERR, "%s: no response to get_layout\n",
   1206  1.1      gwr 			k->k_dev.dv_xname);
   1207  1.1      gwr 		ks->kbd_layout = 0;
   1208  1.1      gwr 	}
   1209  1.1      gwr 
   1210  1.1      gwr out:
   1211  1.1      gwr 	splx(s);
   1212  1.1      gwr 
   1213  1.1      gwr 	if (error == 0)
   1214  1.1      gwr 		k->k_isopen = 1;
   1215  1.1      gwr 
   1216  1.1      gwr 	return error;
   1217  1.1      gwr }
   1218  1.1      gwr 
   1219  1.7      gwr /*
   1220  1.7      gwr  * Called by kbd_input_raw, at spltty()
   1221  1.7      gwr  */
   1222  1.1      gwr void
   1223  1.1      gwr kbd_was_reset(k)
   1224  1.1      gwr 	struct kbd_softc *k;
   1225  1.1      gwr {
   1226  1.1      gwr 	struct kbd_state *ks = &k->k_state;
   1227  1.1      gwr 
   1228  1.1      gwr 	/*
   1229  1.1      gwr 	 * On first identification, wake up anyone waiting for type
   1230  1.1      gwr 	 * and set up the table pointers.
   1231  1.1      gwr 	 */
   1232  1.1      gwr 	wakeup((caddr_t)&ks->kbd_id);
   1233  1.1      gwr 
   1234  1.1      gwr 	/* Restore keyclick, if necessary */
   1235  1.1      gwr 	switch (ks->kbd_id) {
   1236  1.1      gwr 
   1237  1.1      gwr 	case KB_SUN2:
   1238  1.1      gwr 		/* Type 2 keyboards don't support keyclick */
   1239  1.1      gwr 		break;
   1240  1.1      gwr 
   1241  1.1      gwr 	case KB_SUN3:
   1242  1.1      gwr 		/* Type 3 keyboards come up with keyclick on */
   1243  1.7      gwr 		if (!ks->kbd_click) {
   1244  1.7      gwr 			/* turn off the click */
   1245  1.7      gwr 			kbd_output(k, KBD_CMD_NOCLICK);
   1246  1.7      gwr 			kbd_start_tx(k);
   1247  1.7      gwr 		}
   1248  1.1      gwr 		break;
   1249  1.1      gwr 
   1250  1.1      gwr 	case KB_SUN4:
   1251  1.1      gwr 		/* Type 4 keyboards come up with keyclick off */
   1252  1.7      gwr 		if (ks->kbd_click) {
   1253  1.7      gwr 			/* turn on the click */
   1254  1.7      gwr 			kbd_output(k, KBD_CMD_CLICK);
   1255  1.7      gwr 			kbd_start_tx(k);
   1256  1.7      gwr 		}
   1257  1.1      gwr 		break;
   1258  1.1      gwr 	}
   1259  1.1      gwr 
   1260  1.1      gwr 	/* LEDs are off after reset. */
   1261  1.1      gwr 	ks->kbd_leds = 0;
   1262  1.1      gwr }
   1263  1.1      gwr 
   1264  1.7      gwr /*
   1265  1.7      gwr  * Called by kbd_input_raw, at spltty()
   1266  1.7      gwr  */
   1267  1.1      gwr void
   1268  1.1      gwr kbd_new_layout(k)
   1269  1.1      gwr 	struct kbd_softc *k;
   1270  1.1      gwr {
   1271  1.1      gwr 	struct kbd_state *ks = &k->k_state;
   1272  1.1      gwr 
   1273  1.1      gwr 	/*
   1274  1.1      gwr 	 * On first identification, wake up anyone waiting for type
   1275  1.1      gwr 	 * and set up the table pointers.
   1276  1.1      gwr 	 */
   1277  1.1      gwr 	wakeup((caddr_t)&ks->kbd_layout);
   1278  1.1      gwr 
   1279  1.1      gwr 	/* XXX: switch decoding tables? */
   1280  1.1      gwr }
   1281  1.1      gwr 
   1282  1.1      gwr 
   1283  1.1      gwr /*
   1284  1.1      gwr  * Wait for output to finish.
   1285  1.7      gwr  * Called at spltty().  Has user context.
   1286  1.1      gwr  */
   1287  1.1      gwr int
   1288  1.1      gwr kbd_drain_tx(k)
   1289  1.1      gwr 	struct kbd_softc *k;
   1290  1.1      gwr {
   1291  1.7      gwr 	int error;
   1292  1.1      gwr 
   1293  1.1      gwr 	error = 0;
   1294  1.7      gwr 
   1295  1.1      gwr 	while (k->k_txflags & K_TXBUSY) {
   1296  1.1      gwr 		k->k_txflags |= K_TXWANT;
   1297  1.1      gwr 		error = tsleep((caddr_t)&k->k_txflags,
   1298  1.1      gwr 					   PZERO | PCATCH, "kbdout", 0);
   1299  1.1      gwr 	}
   1300  1.7      gwr 
   1301  1.1      gwr 	return (error);
   1302  1.1      gwr }
   1303  1.1      gwr 
   1304  1.1      gwr /*
   1305  1.7      gwr  * Enqueue some output for the keyboard
   1306  1.7      gwr  * Called at spltty().
   1307  1.1      gwr  */
   1308  1.1      gwr void
   1309  1.1      gwr kbd_output(k, c)
   1310  1.1      gwr 	struct kbd_softc *k;
   1311  1.1      gwr 	int c;	/* the data */
   1312  1.1      gwr {
   1313  1.1      gwr 	struct zs_chanstate *cs = k->k_cs;
   1314  1.7      gwr 	int put;
   1315  1.1      gwr 
   1316  1.1      gwr 	put = k->k_tbput;
   1317  1.1      gwr 	k->k_tbuf[put] = (u_char)c;
   1318  1.1      gwr 	put = (put + 1) & KBD_TX_RING_MASK;
   1319  1.1      gwr 
   1320  1.1      gwr 	/* Would overrun if increment makes (put==get). */
   1321  1.1      gwr 	if (put == k->k_tbget) {
   1322  1.1      gwr 		log(LOG_WARNING, "%s: output overrun\n",
   1323  1.1      gwr             k->k_dev.dv_xname);
   1324  1.1      gwr 	} else {
   1325  1.1      gwr 		/* OK, really increment. */
   1326  1.1      gwr 		k->k_tbput = put;
   1327  1.1      gwr 	}
   1328  1.1      gwr }
   1329  1.1      gwr 
   1330  1.7      gwr /*
   1331  1.7      gwr  * Start the sending data from the output queue
   1332  1.7      gwr  * Called at spltty().
   1333  1.7      gwr  */
   1334  1.1      gwr void
   1335  1.1      gwr kbd_start_tx(k)
   1336  1.1      gwr     struct kbd_softc *k;
   1337  1.1      gwr {
   1338  1.1      gwr 	struct zs_chanstate *cs = k->k_cs;
   1339  1.1      gwr 	int get, s;
   1340  1.1      gwr 	u_char c;
   1341  1.1      gwr 
   1342  1.1      gwr 	if (k->k_txflags & K_TXBUSY)
   1343  1.7      gwr 		return;
   1344  1.1      gwr 
   1345  1.1      gwr 	/* Is there anything to send? */
   1346  1.1      gwr 	get = k->k_tbget;
   1347  1.1      gwr 	if (get == k->k_tbput) {
   1348  1.1      gwr 		/* Nothing to send.  Wake drain waiters. */
   1349  1.1      gwr 		if (k->k_txflags & K_TXWANT) {
   1350  1.1      gwr 			k->k_txflags &= ~K_TXWANT;
   1351  1.1      gwr 			wakeup((caddr_t)&k->k_txflags);
   1352  1.1      gwr 		}
   1353  1.7      gwr 		return;
   1354  1.1      gwr 	}
   1355  1.1      gwr 
   1356  1.1      gwr 	/* Have something to send. */
   1357  1.1      gwr 	c = k->k_tbuf[get];
   1358  1.1      gwr 	get = (get + 1) & KBD_TX_RING_MASK;
   1359  1.1      gwr 	k->k_tbget = get;
   1360  1.1      gwr 	k->k_txflags |= K_TXBUSY;
   1361  1.1      gwr 
   1362  1.1      gwr 	/* Need splzs to avoid interruption of the delay. */
   1363  1.7      gwr 	s = splzs();
   1364  1.2      gwr 	zs_write_data(cs, c);
   1365  1.1      gwr 	splx(s);
   1366  1.1      gwr }
   1367  1.1      gwr 
   1368  1.7      gwr /*
   1369  1.7      gwr  * Called at spltty by:
   1370  1.7      gwr  * kbd_update_leds, kbd_iocsled
   1371  1.7      gwr  */
   1372  1.4      gwr void
   1373  1.4      gwr kbd_set_leds(k, new_leds)
   1374  1.1      gwr 	struct kbd_softc *k;
   1375  1.4      gwr 	int new_leds;
   1376  1.1      gwr {
   1377  1.1      gwr 	struct kbd_state *ks = &k->k_state;
   1378  1.1      gwr 
   1379  1.1      gwr 	/* Don't send unless state changes. */
   1380  1.1      gwr 	if (ks->kbd_leds == new_leds)
   1381  1.7      gwr 		return;
   1382  1.7      gwr 
   1383  1.1      gwr 	ks->kbd_leds = new_leds;
   1384  1.1      gwr 
   1385  1.1      gwr 	/* Only type 4 and later has LEDs anyway. */
   1386  1.1      gwr 	if (ks->kbd_id < 4)
   1387  1.7      gwr 		return;
   1388  1.1      gwr 
   1389  1.1      gwr 	kbd_output(k, KBD_CMD_SETLED);
   1390  1.1      gwr 	kbd_output(k, new_leds);
   1391  1.1      gwr 	kbd_start_tx(k);
   1392  1.4      gwr }
   1393  1.4      gwr 
   1394  1.7      gwr /*
   1395  1.7      gwr  * Called at spltty by:
   1396  1.7      gwr  * kbd_input_keysym
   1397  1.7      gwr  */
   1398  1.4      gwr void
   1399  1.4      gwr kbd_update_leds(k)
   1400  1.4      gwr     struct kbd_softc *k;
   1401  1.4      gwr {
   1402  1.4      gwr     struct kbd_state *ks = &k->k_state;
   1403  1.4      gwr     register char leds;
   1404  1.4      gwr 
   1405  1.4      gwr 	leds = ks->kbd_leds;
   1406  1.4      gwr 	leds &= ~(LED_CAPS_LOCK|LED_NUM_LOCK);
   1407  1.4      gwr 
   1408  1.4      gwr 	if (ks->kbd_modbits & (1 << KBMOD_CAPSLOCK))
   1409  1.4      gwr 		leds |= LED_CAPS_LOCK;
   1410  1.4      gwr 	if (ks->kbd_modbits & (1 << KBMOD_NUMLOCK))
   1411  1.4      gwr 		leds |= LED_NUM_LOCK;
   1412  1.4      gwr 
   1413  1.4      gwr 	kbd_set_leds(k, leds);
   1414  1.1      gwr }
   1415  1.1      gwr 
   1416