1436 lines
30 KiB
C
1436 lines
30 KiB
C
/* $NetBSD: kbd.c,v 1.15 1997/10/03 23:04:46 gwr Exp $ */
|
|
|
|
/*
|
|
* Copyright (c) 1992, 1993
|
|
* The Regents of the University of California. All rights reserved.
|
|
*
|
|
* This software was developed by the Computer Systems Engineering group
|
|
* at Lawrence Berkeley Laboratory under DARPA contract BG 91-66 and
|
|
* contributed to Berkeley.
|
|
*
|
|
* All advertising materials mentioning features or use of this software
|
|
* must display the following acknowledgement:
|
|
* This product includes software developed by the University of
|
|
* California, Lawrence Berkeley Laboratory.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. All advertising materials mentioning features or use of this software
|
|
* must display the following acknowledgement:
|
|
* This product includes software developed by the University of
|
|
* California, Berkeley and its contributors.
|
|
* 4. Neither the name of the University nor the names of its contributors
|
|
* may be used to endorse or promote products derived from this software
|
|
* without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
|
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
|
|
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
|
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
|
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
|
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
|
* SUCH DAMAGE.
|
|
*
|
|
* @(#)kbd.c 8.2 (Berkeley) 10/30/93
|
|
*/
|
|
|
|
/*
|
|
* Keyboard driver (/dev/kbd -- note that we do not have minor numbers
|
|
* [yet?]). Translates incoming bytes to ASCII or to `firm_events' and
|
|
* passes them up to the appropriate reader.
|
|
*/
|
|
|
|
/*
|
|
* Zilog Z8530 Dual UART driver (keyboard interface)
|
|
*
|
|
* This is the "slave" driver that will be attached to
|
|
* the "zsc" driver for a Sun keyboard.
|
|
*/
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/conf.h>
|
|
#include <sys/device.h>
|
|
#include <sys/ioctl.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/proc.h>
|
|
#include <sys/signal.h>
|
|
#include <sys/signalvar.h>
|
|
#include <sys/time.h>
|
|
#include <sys/syslog.h>
|
|
#include <sys/select.h>
|
|
#include <sys/poll.h>
|
|
|
|
#include <dev/ic/z8530reg.h>
|
|
#include <machine/z8530var.h>
|
|
#include <machine/vuid_event.h>
|
|
#include <machine/kbd.h>
|
|
#include <machine/kbio.h>
|
|
|
|
#include "event_var.h"
|
|
#include "kbd_xlate.h"
|
|
#include "locators.h"
|
|
|
|
/*
|
|
* Ideas:
|
|
* /dev/kbd is not a tty (plain device)
|
|
*/
|
|
|
|
/*
|
|
* How many input characters we can buffer.
|
|
* The port-specific var.h may override this.
|
|
* Note: must be a power of two!
|
|
*/
|
|
#define KBD_RX_RING_SIZE 256
|
|
#define KBD_RX_RING_MASK (KBD_RX_RING_SIZE-1)
|
|
/*
|
|
* Output buffer. Only need a few chars.
|
|
*/
|
|
#define KBD_TX_RING_SIZE 16
|
|
#define KBD_TX_RING_MASK (KBD_TX_RING_SIZE-1)
|
|
/*
|
|
* Keyboard serial line speed is fixed at 1200 bps.
|
|
*/
|
|
#define KBD_BPS 1200
|
|
#define KBD_RESET_TIMO 1000 /* mS. */
|
|
|
|
/*
|
|
* XXX - Historical comment - no longer quite right...
|
|
* Keyboard driver state. The ascii and kbd links go up and down and
|
|
* we just sit in the middle doing translation. Note that it is possible
|
|
* to get just one of the two links, in which case /dev/kbd is unavailable.
|
|
* The downlink supplies us with `internal' open and close routines which
|
|
* will enable dataflow across the downlink. We promise to call open when
|
|
* we are willing to take keystrokes, and to call close when we are not.
|
|
* If /dev/kbd is not the console tty input source, we do this whenever
|
|
* /dev/kbd is in use; otherwise we just leave it open forever.
|
|
*/
|
|
struct kbd_softc {
|
|
struct device k_dev; /* required first: base device */
|
|
struct zs_chanstate *k_cs;
|
|
|
|
/* Flags to communicate with kbd_softint() */
|
|
volatile int k_intr_flags;
|
|
#define INTR_RX_OVERRUN 1
|
|
#define INTR_TX_EMPTY 2
|
|
#define INTR_ST_CHECK 4
|
|
|
|
/* Transmit state */
|
|
volatile int k_txflags;
|
|
#define K_TXBUSY 1
|
|
#define K_TXWANT 2
|
|
|
|
/*
|
|
* State of upper interface.
|
|
*/
|
|
int k_isopen; /* set if open has been done */
|
|
int k_evmode; /* set if we should produce events */
|
|
struct evvar k_events; /* event queue state */
|
|
|
|
/*
|
|
* ACSI translation state
|
|
*/
|
|
int k_repeat_start; /* initial delay */
|
|
int k_repeat_step; /* inter-char delay */
|
|
int k_repeatsym; /* repeating symbol */
|
|
int k_repeating; /* we've called timeout() */
|
|
struct kbd_state k_state; /* ASCII translation state */
|
|
|
|
/*
|
|
* Magic sequence stuff (L1-A)
|
|
*/
|
|
char k_isconsole;
|
|
char k_magic1_down;
|
|
u_char k_magic1; /* L1 */
|
|
u_char k_magic2; /* A */
|
|
|
|
/*
|
|
* The transmit ring buffer.
|
|
*/
|
|
volatile u_int k_tbget; /* transmit buffer `get' index */
|
|
volatile u_int k_tbput; /* transmit buffer `put' index */
|
|
u_char k_tbuf[KBD_TX_RING_SIZE]; /* data */
|
|
|
|
/*
|
|
* The receive ring buffer.
|
|
*/
|
|
u_int k_rbget; /* ring buffer `get' index */
|
|
volatile u_int k_rbput; /* ring buffer `put' index */
|
|
u_short k_rbuf[KBD_RX_RING_SIZE]; /* rr1, data pairs */
|
|
|
|
};
|
|
|
|
/* Prototypes */
|
|
static void kbd_new_layout(struct kbd_softc *k);
|
|
static void kbd_output(struct kbd_softc *k, int c);
|
|
static void kbd_repeat(void *arg);
|
|
static void kbd_set_leds(struct kbd_softc *k, int leds);
|
|
static void kbd_start_tx(struct kbd_softc *k);
|
|
static void kbd_update_leds(struct kbd_softc *k);
|
|
static void kbd_was_reset(struct kbd_softc *k);
|
|
static int kbd_drain_tx(struct kbd_softc *k);
|
|
|
|
cdev_decl(kbd); /* open, close, read, write, ioctl, stop, ... */
|
|
|
|
struct zsops zsops_kbd;
|
|
|
|
/****************************************************************
|
|
* Definition of the driver for autoconfig.
|
|
****************************************************************/
|
|
|
|
static int kbd_match(struct device *, struct cfdata *, void *);
|
|
static void kbd_attach(struct device *, struct device *, void *);
|
|
|
|
struct cfattach kbd_ca = {
|
|
sizeof(struct kbd_softc), kbd_match, kbd_attach
|
|
};
|
|
|
|
struct cfdriver kbd_cd = {
|
|
NULL, "kbd", DV_DULL
|
|
};
|
|
|
|
|
|
/*
|
|
* kbd_match: how is this zs channel configured?
|
|
*/
|
|
int
|
|
kbd_match(parent, cf, aux)
|
|
struct device *parent;
|
|
struct cfdata *cf;
|
|
void *aux;
|
|
{
|
|
struct zsc_attach_args *args = aux;
|
|
|
|
/* Exact match required for keyboard. */
|
|
if (cf->cf_loc[ZSCCF_CHANNEL] == args->channel)
|
|
return 2;
|
|
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
kbd_attach(parent, self, aux)
|
|
struct device *parent, *self;
|
|
void *aux;
|
|
|
|
{
|
|
struct zsc_softc *zsc = (void *) parent;
|
|
struct kbd_softc *k = (void *) self;
|
|
struct zsc_attach_args *args = aux;
|
|
struct zs_chanstate *cs;
|
|
struct cfdata *cf;
|
|
int channel, kbd_unit;
|
|
int reset, s;
|
|
|
|
cf = k->k_dev.dv_cfdata;
|
|
kbd_unit = k->k_dev.dv_unit;
|
|
channel = args->channel;
|
|
cs = zsc->zsc_cs[channel];
|
|
cs->cs_private = k;
|
|
cs->cs_ops = &zsops_kbd;
|
|
k->k_cs = cs;
|
|
|
|
if (args->hwflags & ZS_HWFLAG_CONSOLE) {
|
|
k->k_isconsole = 1;
|
|
printf(" (console)");
|
|
}
|
|
printf("\n");
|
|
|
|
/* Initialize the speed, etc. */
|
|
s = splzs();
|
|
if (k->k_isconsole == 0) {
|
|
/* Not the console; may need reset. */
|
|
reset = (channel == 0) ?
|
|
ZSWR9_A_RESET : ZSWR9_B_RESET;
|
|
zs_write_reg(cs, 9, reset);
|
|
}
|
|
/* These are OK as set by zscc: WR3, WR4, WR5 */
|
|
/* We don't care about status interrupts. */
|
|
cs->cs_preg[1] = ZSWR1_RIE | ZSWR1_TIE;
|
|
(void) zs_set_speed(cs, KBD_BPS);
|
|
zs_loadchannelregs(cs);
|
|
splx(s);
|
|
|
|
/* Do this before any calls to kbd_rint(). */
|
|
kbd_xlate_init(&k->k_state);
|
|
|
|
/* XXX - Do this in open? */
|
|
k->k_repeat_start = hz/2;
|
|
k->k_repeat_step = hz/20;
|
|
|
|
/* Magic sequence. */
|
|
k->k_magic1 = KBD_L1;
|
|
k->k_magic2 = KBD_A;
|
|
|
|
/* Now attach the (kd) pseudo-driver. */
|
|
kd_init(kbd_unit);
|
|
}
|
|
|
|
|
|
/****************************************************************
|
|
* Entry points for /dev/kbd
|
|
* (open,close,read,write,...)
|
|
****************************************************************/
|
|
|
|
/*
|
|
* Open:
|
|
* Check exclusion, open actual device (_iopen),
|
|
* setup event channel, clear ASCII repeat stuff.
|
|
*/
|
|
int
|
|
kbdopen(dev, flags, mode, p)
|
|
dev_t dev;
|
|
int flags, mode;
|
|
struct proc *p;
|
|
{
|
|
struct kbd_softc *k;
|
|
int error, unit;
|
|
|
|
unit = minor(dev);
|
|
if (unit >= kbd_cd.cd_ndevs)
|
|
return (ENXIO);
|
|
k = kbd_cd.cd_devs[unit];
|
|
if (k == NULL)
|
|
return (ENXIO);
|
|
|
|
/* Exclusive open required for /dev/kbd */
|
|
if (k->k_events.ev_io)
|
|
return (EBUSY);
|
|
k->k_events.ev_io = p;
|
|
|
|
if ((error = kbd_iopen(unit)) != 0) {
|
|
k->k_events.ev_io = NULL;
|
|
return (error);
|
|
}
|
|
ev_init(&k->k_events);
|
|
k->k_evmode = 1; /* XXX: OK? */
|
|
|
|
if (k->k_repeating) {
|
|
k->k_repeating = 0;
|
|
untimeout(kbd_repeat, k);
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* Close:
|
|
* Turn off event mode, dump the queue, and close the keyboard
|
|
* unless it is supplying console input.
|
|
*/
|
|
int
|
|
kbdclose(dev, flags, mode, p)
|
|
dev_t dev;
|
|
int flags, mode;
|
|
struct proc *p;
|
|
{
|
|
struct kbd_softc *k;
|
|
|
|
k = kbd_cd.cd_devs[minor(dev)];
|
|
k->k_evmode = 0;
|
|
ev_fini(&k->k_events);
|
|
k->k_events.ev_io = NULL;
|
|
return (0);
|
|
}
|
|
|
|
int
|
|
kbdread(dev, uio, flags)
|
|
dev_t dev;
|
|
struct uio *uio;
|
|
int flags;
|
|
{
|
|
struct kbd_softc *k;
|
|
|
|
k = kbd_cd.cd_devs[minor(dev)];
|
|
return (ev_read(&k->k_events, uio, flags));
|
|
}
|
|
|
|
/* this routine should not exist, but is convenient to write here for now */
|
|
int
|
|
kbdwrite(dev, uio, flags)
|
|
dev_t dev;
|
|
struct uio *uio;
|
|
int flags;
|
|
{
|
|
|
|
return (EOPNOTSUPP);
|
|
}
|
|
|
|
int
|
|
kbdpoll(dev, events, p)
|
|
dev_t dev;
|
|
int events;
|
|
struct proc *p;
|
|
{
|
|
struct kbd_softc *k;
|
|
|
|
k = kbd_cd.cd_devs[minor(dev)];
|
|
return (ev_poll(&k->k_events, events, p));
|
|
}
|
|
|
|
|
|
static int kbd_iockeymap __P((struct kbd_state *ks,
|
|
u_long cmd, struct kiockeymap *kio));
|
|
|
|
static int kbd_iocsled(struct kbd_softc *k, int *data);
|
|
|
|
#ifdef KIOCGETKEY
|
|
static int kbd_oldkeymap __P((struct kbd_state *ks,
|
|
u_long cmd, struct okiockey *okio));
|
|
#endif
|
|
|
|
int
|
|
kbdioctl(dev, cmd, data, flag, p)
|
|
dev_t dev;
|
|
u_long cmd;
|
|
register caddr_t data;
|
|
int flag;
|
|
struct proc *p;
|
|
{
|
|
struct kbd_softc *k;
|
|
struct kbd_state *ks;
|
|
int *ip;
|
|
int error = 0;
|
|
|
|
k = kbd_cd.cd_devs[minor(dev)];
|
|
ks = &k->k_state;
|
|
|
|
switch (cmd) {
|
|
|
|
case KIOCTRANS: /* Set translation mode */
|
|
ip = (int *)data;
|
|
/* We only support "raw" mode on /dev/kbd */
|
|
if (*ip != TR_UNTRANS_EVENT)
|
|
error = EINVAL;
|
|
break;
|
|
|
|
case KIOCGTRANS: /* Get translation mode */
|
|
ip = (int *)data;
|
|
/* We only support "raw" mode on /dev/kbd */
|
|
*ip = TR_UNTRANS_EVENT;
|
|
break;
|
|
|
|
#ifdef KIOCGETKEY
|
|
case KIOCGETKEY: /* Get keymap entry (old format) */
|
|
error = kbd_oldkeymap(ks, cmd, (struct okiockey *)data);
|
|
break;
|
|
#endif KIOCGETKEY */
|
|
|
|
case KIOCSKEY: /* Set keymap entry */
|
|
/* Don't let just anyone hose the keyboard. */
|
|
if ((error = suser(p->p_ucred, &p->p_acflag)) != 0)
|
|
return (error);
|
|
/* fallthrough */
|
|
case KIOCGKEY: /* Get keymap entry */
|
|
error = kbd_iockeymap(ks, cmd, (struct kiockeymap *)data);
|
|
break;
|
|
|
|
case KIOCCMD: /* Send a command to the keyboard */
|
|
error = kbd_docmd(*((int *)data), 1);
|
|
break;
|
|
|
|
case KIOCTYPE: /* Get keyboard type */
|
|
ip = (int *)data;
|
|
*ip = ks->kbd_id;
|
|
break;
|
|
|
|
case KIOCSDIRECT: /* where to send input */
|
|
ip = (int *)data;
|
|
k->k_evmode = *ip;
|
|
break;
|
|
|
|
case KIOCLAYOUT: /* Get keyboard layout */
|
|
*data = ks->kbd_layout;
|
|
break;
|
|
|
|
case KIOCSLED:
|
|
error = kbd_iocsled(k, (int *)data);
|
|
break;
|
|
|
|
case KIOCGLED:
|
|
*(char *)data = ks->kbd_leds;
|
|
break;
|
|
|
|
case FIONBIO: /* we will remove this someday (soon???) */
|
|
break;
|
|
|
|
case FIOASYNC:
|
|
k->k_events.ev_async = *(int *)data != 0;
|
|
break;
|
|
|
|
case TIOCSPGRP:
|
|
ip = (int *)data;
|
|
if (*ip != k->k_events.ev_io->p_pgid)
|
|
error = EPERM;
|
|
break;
|
|
|
|
}
|
|
|
|
return (error);
|
|
}
|
|
|
|
/****************************************************************
|
|
* ioctl helpers
|
|
****************************************************************/
|
|
|
|
/*
|
|
* Get/Set keymap entry
|
|
*/
|
|
static int
|
|
kbd_iockeymap(ks, cmd, kio)
|
|
struct kbd_state *ks;
|
|
u_long cmd;
|
|
struct kiockeymap *kio;
|
|
{
|
|
u_short *km;
|
|
u_int station;
|
|
|
|
switch (kio->kio_tablemask) {
|
|
case KIOC_NOMASK:
|
|
km = ks->kbd_k.k_normal;
|
|
break;
|
|
case KIOC_SHIFTMASK:
|
|
km = ks->kbd_k.k_shifted;
|
|
break;
|
|
case KIOC_CTRLMASK:
|
|
km = ks->kbd_k.k_control;
|
|
break;
|
|
case KIOC_UPMASK:
|
|
km = ks->kbd_k.k_release;
|
|
break;
|
|
default:
|
|
/* Silently ignore unsupported masks */
|
|
return (0);
|
|
}
|
|
|
|
/* Range-check the table position. */
|
|
station = kio->kio_station;
|
|
if (station >= KEYMAP_SIZE)
|
|
return (EINVAL);
|
|
|
|
switch (cmd) {
|
|
|
|
case KIOCGKEY: /* Get keymap entry */
|
|
kio->kio_entry = km[station];
|
|
break;
|
|
|
|
case KIOCSKEY: /* Set keymap entry */
|
|
km[station] = kio->kio_entry;
|
|
break;
|
|
|
|
default:
|
|
return(ENOTTY);
|
|
}
|
|
return (0);
|
|
}
|
|
|
|
#ifdef KIOCGETKEY
|
|
/*
|
|
* Get/Set keymap entry,
|
|
* old format (compatibility)
|
|
*/
|
|
int
|
|
kbd_oldkeymap(ks, cmd, kio)
|
|
struct kbd_state *ks;
|
|
u_long cmd;
|
|
struct okiockey *kio;
|
|
{
|
|
int error = 0;
|
|
|
|
switch (cmd) {
|
|
|
|
case KIOCGETKEY:
|
|
if (kio->kio_station == 118) {
|
|
/*
|
|
* This is X11 asking if a type 3 keyboard is
|
|
* really a type 3 keyboard. Say yes, it is,
|
|
* by reporting key station 118 as a "hole".
|
|
* Note old (SunOS 3.5) definition of HOLE!
|
|
*/
|
|
kio->kio_entry = 0xA2;
|
|
break;
|
|
}
|
|
/* fall through */
|
|
|
|
default:
|
|
error = ENOTTY;
|
|
break;
|
|
}
|
|
|
|
return (error);
|
|
}
|
|
#endif /* KIOCGETKEY */
|
|
|
|
|
|
/*
|
|
* keyboard command ioctl
|
|
* ``unimplemented commands are ignored'' (blech)
|
|
* This is also export to the fb driver.
|
|
*/
|
|
int
|
|
kbd_docmd(cmd, isuser)
|
|
int cmd;
|
|
int isuser;
|
|
{
|
|
struct kbd_softc *k;
|
|
struct kbd_state *ks;
|
|
int error, s;
|
|
|
|
error = 0;
|
|
k = kbd_cd.cd_devs[0];
|
|
ks = &k->k_state;
|
|
|
|
switch (cmd) {
|
|
|
|
case KBD_CMD_BELL:
|
|
case KBD_CMD_NOBELL:
|
|
/* Supported by type 2, 3, and 4 keyboards */
|
|
break;
|
|
|
|
case KBD_CMD_CLICK:
|
|
case KBD_CMD_NOCLICK:
|
|
/* Unsupported by type 2 keyboards */
|
|
if (ks->kbd_id <= KB_SUN2)
|
|
return (0);
|
|
ks->kbd_click = (cmd == KBD_CMD_CLICK);
|
|
break;
|
|
|
|
default:
|
|
return (0);
|
|
}
|
|
|
|
s = spltty();
|
|
|
|
if (isuser)
|
|
error = kbd_drain_tx(k);
|
|
|
|
if (error == 0) {
|
|
kbd_output(k, cmd);
|
|
kbd_start_tx(k);
|
|
}
|
|
|
|
splx(s);
|
|
|
|
return (error);
|
|
}
|
|
|
|
/*
|
|
* Set LEDs ioctl.
|
|
*/
|
|
static int
|
|
kbd_iocsled(k, data)
|
|
struct kbd_softc *k;
|
|
int *data;
|
|
{
|
|
int leds, error, s;
|
|
|
|
leds = *data;
|
|
|
|
s = spltty();
|
|
error = kbd_drain_tx(k);
|
|
if (error == 0) {
|
|
kbd_set_leds(k, leds);
|
|
}
|
|
splx(s);
|
|
|
|
return (error);
|
|
}
|
|
|
|
|
|
/****************************************************************
|
|
* middle layers:
|
|
* - keysym to ASCII sequence
|
|
* - raw key codes to keysym
|
|
****************************************************************/
|
|
|
|
static void kbd_input_string __P((struct kbd_softc *, char *));
|
|
static void kbd_input_funckey __P((struct kbd_softc *, int));
|
|
static void kbd_input_keysym __P((struct kbd_softc *, int));
|
|
static void kbd_input_raw __P((struct kbd_softc *k, int));
|
|
|
|
/*
|
|
* Initialization done by either kdcninit or kbd_iopen
|
|
*/
|
|
void
|
|
kbd_xlate_init(ks)
|
|
struct kbd_state *ks;
|
|
{
|
|
struct keyboard *ktbls;
|
|
int id;
|
|
|
|
id = ks->kbd_id;
|
|
if (id < KBD_MIN_TYPE)
|
|
id = KBD_MIN_TYPE;
|
|
if (id > kbd_max_type)
|
|
id = kbd_max_type;
|
|
ktbls = keyboards[id];
|
|
|
|
ks->kbd_k = *ktbls; /* struct assignment */
|
|
ks->kbd_modbits = 0;
|
|
}
|
|
|
|
/*
|
|
* Turn keyboard up/down codes into a KEYSYM.
|
|
* Note that the "kd" driver uses this too!
|
|
*/
|
|
int
|
|
kbd_code_to_keysym(ks, c)
|
|
register struct kbd_state *ks;
|
|
register int c;
|
|
{
|
|
u_short *km;
|
|
int keysym;
|
|
|
|
/*
|
|
* Get keymap pointer. One of these:
|
|
* release, control, shifted, normal, ...
|
|
*/
|
|
if (KEY_UP(c))
|
|
km = ks->kbd_k.k_release;
|
|
else if (ks->kbd_modbits & KBMOD_CTRL_MASK)
|
|
km = ks->kbd_k.k_control;
|
|
else if (ks->kbd_modbits & KBMOD_SHIFT_MASK)
|
|
km = ks->kbd_k.k_shifted;
|
|
else
|
|
km = ks->kbd_k.k_normal;
|
|
|
|
if (km == NULL) {
|
|
/*
|
|
* Do not know how to translate yet.
|
|
* We will find out when a RESET comes along.
|
|
*/
|
|
return (KEYSYM_NOP);
|
|
}
|
|
keysym = km[KEY_CODE(c)];
|
|
|
|
/*
|
|
* Post-processing for Caps-lock
|
|
*/
|
|
if ((ks->kbd_modbits & (1 << KBMOD_CAPSLOCK)) &&
|
|
(KEYSYM_CLASS(keysym) == KEYSYM_ASCII) )
|
|
{
|
|
if (('a' <= keysym) && (keysym <= 'z'))
|
|
keysym -= ('a' - 'A');
|
|
}
|
|
|
|
/*
|
|
* Post-processing for Num-lock
|
|
*/
|
|
if ((ks->kbd_modbits & (1 << KBMOD_NUMLOCK)) &&
|
|
(KEYSYM_CLASS(keysym) == KEYSYM_FUNC) )
|
|
{
|
|
keysym = kbd_numlock_map[keysym & 0x3F];
|
|
}
|
|
|
|
return (keysym);
|
|
}
|
|
|
|
void
|
|
kbd_input_string(k, str)
|
|
struct kbd_softc *k;
|
|
char *str;
|
|
{
|
|
while (*str) {
|
|
kd_input(*str);
|
|
str++;
|
|
}
|
|
}
|
|
|
|
void
|
|
kbd_input_funckey(k, keysym)
|
|
struct kbd_softc *k;
|
|
register int keysym;
|
|
{
|
|
register int n;
|
|
char str[12];
|
|
|
|
/*
|
|
* Format the F-key sequence and send as a string.
|
|
* XXX: Ugly compatibility mappings.
|
|
*/
|
|
n = 0xC0 + (keysym & 0x3F);
|
|
sprintf(str, "\033[%dz", n);
|
|
kbd_input_string(k, str);
|
|
}
|
|
|
|
/*
|
|
* This is called by kbd_input_raw() or by kb_repeat()
|
|
* to deliver ASCII input. Called at spltty().
|
|
*/
|
|
void
|
|
kbd_input_keysym(k, keysym)
|
|
struct kbd_softc *k;
|
|
register int keysym;
|
|
{
|
|
struct kbd_state *ks = &k->k_state;
|
|
register int data;
|
|
|
|
switch (KEYSYM_CLASS(keysym)) {
|
|
|
|
case KEYSYM_ASCII:
|
|
data = KEYSYM_DATA(keysym);
|
|
if (ks->kbd_modbits & KBMOD_META_MASK)
|
|
data |= 0x80;
|
|
kd_input(data);
|
|
break;
|
|
|
|
case KEYSYM_STRING:
|
|
data = keysym & 0xF;
|
|
kbd_input_string(k, kbd_stringtab[data]);
|
|
break;
|
|
|
|
case KEYSYM_FUNC:
|
|
kbd_input_funckey(k, keysym);
|
|
break;
|
|
|
|
case KEYSYM_CLRMOD:
|
|
data = 1 << (keysym & 0x1F);
|
|
ks->kbd_modbits &= ~data;
|
|
break;
|
|
|
|
case KEYSYM_SETMOD:
|
|
data = 1 << (keysym & 0x1F);
|
|
ks->kbd_modbits |= data;
|
|
break;
|
|
|
|
case KEYSYM_INVMOD:
|
|
data = 1 << (keysym & 0x1F);
|
|
ks->kbd_modbits ^= data;
|
|
kbd_update_leds(k);
|
|
break;
|
|
|
|
case KEYSYM_ALL_UP:
|
|
ks->kbd_modbits &= ~0xFFFF;
|
|
break;
|
|
|
|
case KEYSYM_SPECIAL:
|
|
if (keysym == KEYSYM_NOP)
|
|
break;
|
|
/* fall through */
|
|
default:
|
|
log(LOG_WARNING, "%s: unexpected keysym 0x%x\n",
|
|
k->k_dev.dv_xname, keysym);
|
|
break;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* This is the autorepeat timeout function.
|
|
* Called at splsoftclock().
|
|
*/
|
|
static void
|
|
kbd_repeat(void *arg)
|
|
{
|
|
struct kbd_softc *k = (struct kbd_softc *)arg;
|
|
int s = spltty();
|
|
|
|
if (k->k_repeating && k->k_repeatsym >= 0) {
|
|
kbd_input_keysym(k, k->k_repeatsym);
|
|
timeout(kbd_repeat, k, k->k_repeat_step);
|
|
}
|
|
splx(s);
|
|
}
|
|
|
|
/*
|
|
* Called by our kbd_softint() routine on input,
|
|
* which passes the raw hardware scan codes.
|
|
* Called at spltty()
|
|
*/
|
|
void
|
|
kbd_input_raw(k, c)
|
|
struct kbd_softc *k;
|
|
register int c;
|
|
{
|
|
struct kbd_state *ks = &k->k_state;
|
|
struct firm_event *fe;
|
|
int put, keysym;
|
|
|
|
/* XXX - Input errors already handled. */
|
|
|
|
/* Are we expecting special input? */
|
|
if (ks->kbd_expect) {
|
|
if (ks->kbd_expect & KBD_EXPECT_IDCODE) {
|
|
/* We read a KBD_RESET last time. */
|
|
ks->kbd_id = c;
|
|
kbd_was_reset(k);
|
|
}
|
|
if (ks->kbd_expect & KBD_EXPECT_LAYOUT) {
|
|
/* We read a KBD_LAYOUT last time. */
|
|
ks->kbd_layout = c;
|
|
kbd_new_layout(k);
|
|
}
|
|
ks->kbd_expect = 0;
|
|
return;
|
|
}
|
|
|
|
/* Is this one of the "special" input codes? */
|
|
if (KBD_SPECIAL(c)) {
|
|
switch (c) {
|
|
case KBD_RESET:
|
|
ks->kbd_expect |= KBD_EXPECT_IDCODE;
|
|
/* Fake an "all-up" to resync. translation. */
|
|
c = KBD_IDLE;
|
|
break;
|
|
|
|
case KBD_LAYOUT:
|
|
ks->kbd_expect |= KBD_EXPECT_LAYOUT;
|
|
return;
|
|
|
|
case KBD_ERROR:
|
|
log(LOG_WARNING, "%s: received error indicator\n",
|
|
k->k_dev.dv_xname);
|
|
return;
|
|
|
|
case KBD_IDLE:
|
|
/* Let this go to the translator. */
|
|
break;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* If /dev/kbd is not connected in event mode,
|
|
* translate and send upstream (to console).
|
|
*/
|
|
if (!k->k_evmode) {
|
|
|
|
/* Any input stops auto-repeat (i.e. key release). */
|
|
if (k->k_repeating) {
|
|
k->k_repeating = 0;
|
|
untimeout(kbd_repeat, k);
|
|
}
|
|
|
|
/* Translate this code to a keysym */
|
|
keysym = kbd_code_to_keysym(ks, c);
|
|
|
|
/* Pass up to the next layer. */
|
|
kbd_input_keysym(k, keysym);
|
|
|
|
/* Does this symbol get auto-repeat? */
|
|
if (KEYSYM_NOREPEAT(keysym))
|
|
return;
|
|
|
|
/* Setup for auto-repeat after initial delay. */
|
|
k->k_repeating = 1;
|
|
k->k_repeatsym = keysym;
|
|
timeout(kbd_repeat, k, k->k_repeat_start);
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* IDLEs confuse the MIT X11R4 server badly, so we must drop them.
|
|
* This is bad as it means the server will not automatically resync
|
|
* on all-up IDLEs, but I did not drop them before, and the server
|
|
* goes crazy when it comes time to blank the screen....
|
|
*/
|
|
if (c == KBD_IDLE)
|
|
return;
|
|
|
|
/*
|
|
* Keyboard is generating events. Turn this keystroke into an
|
|
* event and put it in the queue. If the queue is full, the
|
|
* keystroke is lost (sorry!).
|
|
*/
|
|
put = k->k_events.ev_put;
|
|
fe = &k->k_events.ev_q[put];
|
|
put = (put + 1) % EV_QSIZE;
|
|
if (put == k->k_events.ev_get) {
|
|
log(LOG_WARNING, "%s: event queue overflow\n",
|
|
k->k_dev.dv_xname); /* ??? */
|
|
return;
|
|
}
|
|
fe->id = KEY_CODE(c);
|
|
fe->value = KEY_UP(c) ? VKEY_UP : VKEY_DOWN;
|
|
fe->time = time;
|
|
k->k_events.ev_put = put;
|
|
EV_WAKEUP(&k->k_events);
|
|
}
|
|
|
|
/****************************************************************
|
|
* Interface to the lower layer (zscc)
|
|
****************************************************************/
|
|
|
|
static void kbd_rxint __P((struct zs_chanstate *));
|
|
static void kbd_txint __P((struct zs_chanstate *));
|
|
static void kbd_stint __P((struct zs_chanstate *));
|
|
static void kbd_softint __P((struct zs_chanstate *));
|
|
|
|
static void
|
|
kbd_rxint(cs)
|
|
register struct zs_chanstate *cs;
|
|
{
|
|
register struct kbd_softc *k;
|
|
register int put, put_next;
|
|
register u_char c, rr1;
|
|
|
|
k = cs->cs_private;
|
|
put = k->k_rbput;
|
|
|
|
/*
|
|
* First read the status, because reading the received char
|
|
* destroys the status of this char.
|
|
*/
|
|
rr1 = zs_read_reg(cs, 1);
|
|
c = zs_read_data(cs);
|
|
|
|
if (rr1 & (ZSRR1_FE | ZSRR1_DO | ZSRR1_PE)) {
|
|
/* Clear the receive error. */
|
|
zs_write_csr(cs, ZSWR0_RESET_ERRORS);
|
|
}
|
|
|
|
/*
|
|
* Check NOW for a console abort sequence, so that we can
|
|
* abort even when interrupts are locking up the machine.
|
|
*/
|
|
if (k->k_magic1_down) {
|
|
/* The last keycode was "MAGIC1" down. */
|
|
k->k_magic1_down = 0;
|
|
if ((c == k->k_magic2) && k->k_isconsole) {
|
|
/* Magic "L1-A" sequence; enter debugger. */
|
|
zs_abort(cs);
|
|
/* Debugger done. Fake L1-up to finish it. */
|
|
c = k->k_magic1 | KBD_UP;
|
|
}
|
|
}
|
|
if (c == k->k_magic1) {
|
|
k->k_magic1_down = 1;
|
|
}
|
|
|
|
k->k_rbuf[put] = (c << 8) | rr1;
|
|
put_next = (put + 1) & KBD_RX_RING_MASK;
|
|
|
|
/* Would overrun if increment makes (put==get). */
|
|
if (put_next == k->k_rbget) {
|
|
k->k_intr_flags |= INTR_RX_OVERRUN;
|
|
} else {
|
|
/* OK, really increment. */
|
|
put = put_next;
|
|
}
|
|
|
|
/* Done reading. */
|
|
k->k_rbput = put;
|
|
|
|
/* Ask for softint() call. */
|
|
cs->cs_softreq = 1;
|
|
}
|
|
|
|
|
|
static void
|
|
kbd_txint(cs)
|
|
register struct zs_chanstate *cs;
|
|
{
|
|
register struct kbd_softc *k;
|
|
|
|
k = cs->cs_private;
|
|
zs_write_csr(cs, ZSWR0_RESET_TXINT);
|
|
k->k_intr_flags |= INTR_TX_EMPTY;
|
|
/* Ask for softint() call. */
|
|
cs->cs_softreq = 1;
|
|
}
|
|
|
|
|
|
static void
|
|
kbd_stint(cs)
|
|
register struct zs_chanstate *cs;
|
|
{
|
|
register struct kbd_softc *k;
|
|
register int rr0;
|
|
|
|
k = cs->cs_private;
|
|
|
|
rr0 = zs_read_csr(cs);
|
|
zs_write_csr(cs, ZSWR0_RESET_STATUS);
|
|
|
|
#if 0
|
|
if (rr0 & ZSRR0_BREAK) {
|
|
/* Keyboard unplugged? */
|
|
zs_abort(cs);
|
|
return (0);
|
|
}
|
|
#endif
|
|
|
|
/*
|
|
* We have to accumulate status line changes here.
|
|
* Otherwise, if we get multiple status interrupts
|
|
* before the softint runs, we could fail to notice
|
|
* some status line changes in the softint routine.
|
|
* Fix from Bill Studenmund, October 1996.
|
|
*/
|
|
cs->cs_rr0_delta |= (cs->cs_rr0 ^ rr0);
|
|
cs->cs_rr0 = rr0;
|
|
k->k_intr_flags |= INTR_ST_CHECK;
|
|
|
|
/* Ask for softint() call. */
|
|
cs->cs_softreq = 1;
|
|
}
|
|
|
|
/*
|
|
* Get input from the recieve ring and pass it on.
|
|
* Note: this is called at splsoftclock()
|
|
*/
|
|
static void
|
|
kbd_softint(cs)
|
|
struct zs_chanstate *cs;
|
|
{
|
|
register struct kbd_softc *k;
|
|
register int get, c, s;
|
|
int intr_flags;
|
|
register u_short ring_data;
|
|
|
|
k = cs->cs_private;
|
|
|
|
/* Atomically get and clear flags. */
|
|
s = splzs();
|
|
intr_flags = k->k_intr_flags;
|
|
k->k_intr_flags = 0;
|
|
|
|
/* Now lower to spltty for the rest. */
|
|
(void) spltty();
|
|
|
|
/*
|
|
* Copy data from the receive ring to the event layer.
|
|
*/
|
|
get = k->k_rbget;
|
|
while (get != k->k_rbput) {
|
|
ring_data = k->k_rbuf[get];
|
|
get = (get + 1) & KBD_RX_RING_MASK;
|
|
|
|
/* low byte of ring_data is rr1 */
|
|
c = (ring_data >> 8) & 0xff;
|
|
|
|
if (ring_data & ZSRR1_DO)
|
|
intr_flags |= INTR_RX_OVERRUN;
|
|
if (ring_data & (ZSRR1_FE | ZSRR1_PE)) {
|
|
/*
|
|
* After garbage, flush pending input, and
|
|
* send a reset to resync key translation.
|
|
*/
|
|
log(LOG_ERR, "%s: input error (0x%x)\n",
|
|
k->k_dev.dv_xname, ring_data);
|
|
get = k->k_rbput; /* flush */
|
|
goto send_reset;
|
|
}
|
|
|
|
/* Pass this up to the "middle" layer. */
|
|
kbd_input_raw(k, c);
|
|
}
|
|
if (intr_flags & INTR_RX_OVERRUN) {
|
|
log(LOG_ERR, "%s: input overrun\n",
|
|
k->k_dev.dv_xname);
|
|
send_reset:
|
|
/* Send a reset to resync translation. */
|
|
kbd_output(k, KBD_CMD_RESET);
|
|
kbd_start_tx(k);
|
|
}
|
|
k->k_rbget = get;
|
|
|
|
if (intr_flags & INTR_TX_EMPTY) {
|
|
/*
|
|
* Transmit done. Try to send more, or
|
|
* clear busy and wakeup drain waiters.
|
|
*/
|
|
k->k_txflags &= ~K_TXBUSY;
|
|
kbd_start_tx(k);
|
|
}
|
|
|
|
if (intr_flags & INTR_ST_CHECK) {
|
|
/*
|
|
* Status line change. (Not expected.)
|
|
*/
|
|
log(LOG_ERR, "%s: status interrupt?\n",
|
|
k->k_dev.dv_xname);
|
|
cs->cs_rr0_delta = 0;
|
|
}
|
|
|
|
splx(s);
|
|
}
|
|
|
|
struct zsops zsops_kbd = {
|
|
kbd_rxint, /* receive char available */
|
|
kbd_stint, /* external/status */
|
|
kbd_txint, /* xmit buffer empty */
|
|
kbd_softint, /* process software interrupt */
|
|
};
|
|
|
|
/****************************************************************
|
|
* misc...
|
|
****************************************************************/
|
|
|
|
/*
|
|
* Initialization to be done at first open.
|
|
* This is called from kbdopen or kdopen (in kd.c)
|
|
* Called with user context.
|
|
*/
|
|
int
|
|
kbd_iopen(unit)
|
|
int unit;
|
|
{
|
|
struct kbd_softc *k;
|
|
struct kbd_state *ks;
|
|
int error, s;
|
|
|
|
if (unit >= kbd_cd.cd_ndevs)
|
|
return (ENXIO);
|
|
k = kbd_cd.cd_devs[unit];
|
|
if (k == NULL)
|
|
return (ENXIO);
|
|
ks = &k->k_state;
|
|
error = 0;
|
|
|
|
/* Tolerate extra calls. */
|
|
if (k->k_isopen)
|
|
return (error);
|
|
|
|
s = spltty();
|
|
|
|
/* Reset the keyboard and find out its type. */
|
|
kbd_output(k, KBD_CMD_RESET);
|
|
kbd_start_tx(k);
|
|
kbd_drain_tx(k);
|
|
/* The wakeup for this is in kbd_was_reset(). */
|
|
error = tsleep((caddr_t)&ks->kbd_id,
|
|
PZERO | PCATCH, devopn, hz);
|
|
if (error == EWOULDBLOCK) { /* no response */
|
|
error = 0;
|
|
log(LOG_ERR, "%s: reset failed\n",
|
|
k->k_dev.dv_xname);
|
|
/*
|
|
* Allow the open anyway (to keep getty happy)
|
|
* but assume the "least common denominator".
|
|
*/
|
|
ks->kbd_id = KB_SUN2;
|
|
}
|
|
|
|
/* Earlier than type 4 does not know "layout". */
|
|
if (ks->kbd_id < KB_SUN4)
|
|
goto out;
|
|
|
|
/* Ask for the layout. */
|
|
kbd_output(k, KBD_CMD_GETLAYOUT);
|
|
kbd_start_tx(k);
|
|
kbd_drain_tx(k);
|
|
/* The wakeup for this is in kbd_new_layout(). */
|
|
error = tsleep((caddr_t)&ks->kbd_layout,
|
|
PZERO | PCATCH, devopn, hz);
|
|
if (error == EWOULDBLOCK) { /* no response */
|
|
error = 0;
|
|
log(LOG_ERR, "%s: no response to get_layout\n",
|
|
k->k_dev.dv_xname);
|
|
ks->kbd_layout = 0;
|
|
}
|
|
|
|
out:
|
|
splx(s);
|
|
|
|
if (error == 0)
|
|
k->k_isopen = 1;
|
|
|
|
return error;
|
|
}
|
|
|
|
/*
|
|
* Called by kbd_input_raw, at spltty()
|
|
*/
|
|
static void
|
|
kbd_was_reset(k)
|
|
struct kbd_softc *k;
|
|
{
|
|
struct kbd_state *ks = &k->k_state;
|
|
|
|
/*
|
|
* On first identification, wake up anyone waiting for type
|
|
* and set up the table pointers.
|
|
*/
|
|
wakeup((caddr_t)&ks->kbd_id);
|
|
|
|
/* Restore keyclick, if necessary */
|
|
switch (ks->kbd_id) {
|
|
|
|
case KB_SUN2:
|
|
/* Type 2 keyboards don't support keyclick */
|
|
break;
|
|
|
|
case KB_SUN3:
|
|
/* Type 3 keyboards come up with keyclick on */
|
|
if (!ks->kbd_click) {
|
|
/* turn off the click */
|
|
kbd_output(k, KBD_CMD_NOCLICK);
|
|
kbd_start_tx(k);
|
|
}
|
|
break;
|
|
|
|
case KB_SUN4:
|
|
/* Type 4 keyboards come up with keyclick off */
|
|
if (ks->kbd_click) {
|
|
/* turn on the click */
|
|
kbd_output(k, KBD_CMD_CLICK);
|
|
kbd_start_tx(k);
|
|
}
|
|
break;
|
|
}
|
|
|
|
/* LEDs are off after reset. */
|
|
ks->kbd_leds = 0;
|
|
}
|
|
|
|
/*
|
|
* Called by kbd_input_raw, at spltty()
|
|
*/
|
|
static void
|
|
kbd_new_layout(k)
|
|
struct kbd_softc *k;
|
|
{
|
|
struct kbd_state *ks = &k->k_state;
|
|
|
|
/*
|
|
* On first identification, wake up anyone waiting for type
|
|
* and set up the table pointers.
|
|
*/
|
|
wakeup((caddr_t)&ks->kbd_layout);
|
|
|
|
/* XXX: switch decoding tables? */
|
|
}
|
|
|
|
|
|
/*
|
|
* Wait for output to finish.
|
|
* Called at spltty(). Has user context.
|
|
*/
|
|
static int
|
|
kbd_drain_tx(k)
|
|
struct kbd_softc *k;
|
|
{
|
|
int error;
|
|
|
|
error = 0;
|
|
|
|
while (k->k_txflags & K_TXBUSY) {
|
|
k->k_txflags |= K_TXWANT;
|
|
error = tsleep((caddr_t)&k->k_txflags,
|
|
PZERO | PCATCH, "kbdout", 0);
|
|
}
|
|
|
|
return (error);
|
|
}
|
|
|
|
/*
|
|
* Enqueue some output for the keyboard
|
|
* Called at spltty().
|
|
*/
|
|
static void
|
|
kbd_output(k, c)
|
|
struct kbd_softc *k;
|
|
int c; /* the data */
|
|
{
|
|
int put;
|
|
|
|
put = k->k_tbput;
|
|
k->k_tbuf[put] = (u_char)c;
|
|
put = (put + 1) & KBD_TX_RING_MASK;
|
|
|
|
/* Would overrun if increment makes (put==get). */
|
|
if (put == k->k_tbget) {
|
|
log(LOG_WARNING, "%s: output overrun\n",
|
|
k->k_dev.dv_xname);
|
|
} else {
|
|
/* OK, really increment. */
|
|
k->k_tbput = put;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Start the sending data from the output queue
|
|
* Called at spltty().
|
|
*/
|
|
static void
|
|
kbd_start_tx(k)
|
|
struct kbd_softc *k;
|
|
{
|
|
struct zs_chanstate *cs = k->k_cs;
|
|
int get, s;
|
|
u_char c;
|
|
|
|
if (k->k_txflags & K_TXBUSY)
|
|
return;
|
|
|
|
/* Is there anything to send? */
|
|
get = k->k_tbget;
|
|
if (get == k->k_tbput) {
|
|
/* Nothing to send. Wake drain waiters. */
|
|
if (k->k_txflags & K_TXWANT) {
|
|
k->k_txflags &= ~K_TXWANT;
|
|
wakeup((caddr_t)&k->k_txflags);
|
|
}
|
|
return;
|
|
}
|
|
|
|
/* Have something to send. */
|
|
c = k->k_tbuf[get];
|
|
get = (get + 1) & KBD_TX_RING_MASK;
|
|
k->k_tbget = get;
|
|
k->k_txflags |= K_TXBUSY;
|
|
|
|
/* Need splzs to avoid interruption of the delay. */
|
|
s = splzs();
|
|
zs_write_data(cs, c);
|
|
splx(s);
|
|
}
|
|
|
|
/*
|
|
* Called at spltty by:
|
|
* kbd_update_leds, kbd_iocsled
|
|
*/
|
|
static void
|
|
kbd_set_leds(k, new_leds)
|
|
struct kbd_softc *k;
|
|
int new_leds;
|
|
{
|
|
struct kbd_state *ks = &k->k_state;
|
|
|
|
/* Don't send unless state changes. */
|
|
if (ks->kbd_leds == new_leds)
|
|
return;
|
|
|
|
ks->kbd_leds = new_leds;
|
|
|
|
/* Only type 4 and later has LEDs anyway. */
|
|
if (ks->kbd_id < 4)
|
|
return;
|
|
|
|
kbd_output(k, KBD_CMD_SETLED);
|
|
kbd_output(k, new_leds);
|
|
kbd_start_tx(k);
|
|
}
|
|
|
|
/*
|
|
* Called at spltty by:
|
|
* kbd_input_keysym
|
|
*/
|
|
static void
|
|
kbd_update_leds(k)
|
|
struct kbd_softc *k;
|
|
{
|
|
struct kbd_state *ks = &k->k_state;
|
|
register char leds;
|
|
|
|
leds = ks->kbd_leds;
|
|
leds &= ~(LED_CAPS_LOCK|LED_NUM_LOCK);
|
|
|
|
if (ks->kbd_modbits & (1 << KBMOD_CAPSLOCK))
|
|
leds |= LED_CAPS_LOCK;
|
|
if (ks->kbd_modbits & (1 << KBMOD_NUMLOCK))
|
|
leds |= LED_NUM_LOCK;
|
|
|
|
kbd_set_leds(k, leds);
|
|
}
|
|
|