xref: /src/sys/arch/atari/dev/kbd.c

/*	$NetBSD: kbd.c,v 1.53 2022/06/25 15:36:33 tsutsui Exp $	*/

/*
 * Copyright (c) 1995 Leo Weppelman
 * Copyright (c) 1982, 1986, 1990 The Regents of the University of California.
 * All rights reserved.
 *
 * 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. 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.
 */

#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: kbd.c,v 1.53 2022/06/25 15:36:33 tsutsui Exp $");

#include "mouse.h"
#include "ite.h"
#include "wskbd.h"

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/ioctl.h>
#include <sys/tty.h>
#include <sys/proc.h>
#include <sys/conf.h>
#include <sys/file.h>
#include <sys/kernel.h>
#include <sys/signalvar.h>
#include <sys/syslog.h>
#include <dev/cons.h>
#include <machine/cpu.h>
#include <machine/iomap.h>
#include <machine/mfp.h>
#include <machine/acia.h>
#include <atari/dev/itevar.h>
#include <atari/dev/event_var.h>
#include <atari/dev/vuid_event.h>
#include <atari/dev/ym2149reg.h>
#include <atari/dev/kbdreg.h>
#include <atari/dev/kbdvar.h>
#include <atari/dev/kbdmap.h>
#include <atari/dev/msvar.h>

#if NWSKBD>0
#include <dev/wscons/wsconsio.h>
#include <dev/wscons/wskbdvar.h>
#include <dev/wscons/wsksymdef.h>
#include <dev/wscons/wsksymvar.h>
#include <atari/dev/wskbdmap_atari.h>
#endif

/*
 * The ringbuffer is the interface between the hard and soft interrupt handler.
 * The hard interrupt runs straight from the MFP interrupt.
 */
#define KBD_RING_SIZE	256   /* Sz of input ring buffer, must be power of 2 */
#define KBD_RING_MASK	255   /* Modulo mask for above			     */

struct kbd_softc {
	int		sc_event_mode;	/* if 1, collect events,	*/
					/*   else pass to ite		*/
	struct evvar	sc_events;	/* event queue state		*/
	uint8_t		sc_soft_cs;	/* control-reg. copy		*/
	uint8_t		sc_package[20];	/* XXX package being build	*/
	uint8_t		sc_pkg_size;	/* Size of the package		*/
	uint8_t		sc_pkg_idx;	/* Running pkg assembly index	*/
	uint8_t		sc_pkg_type;	/* Type of package		*/
	const uint8_t	*sc_sendp;	/* Output pointer		*/
	int		sc_send_cnt;	/* Chars left for output	*/
#if NWSKBD > 0
	device_t	sc_wskbddev;  /* pointer to wskbd for sending strokes */
	int		sc_pollingmode;	/* polling mode on? whatever it is... */
#endif
	void		*sc_sicookie;	/* softint(9) cookie		*/
};

/* WSKBD */
/*
 * If NWSKBD>0 we try to attach an wskbd device to us. What follows
 * is definitions of callback functions and structures that are passed
 * to wscons when initializing.
 */

/*
 * Now with wscons this driver exhibits some weird behaviour.
 * It may act both as a driver of its own and the md part of the
 * wskbd driver. Therefore it can be accessed through /dev/kbd
 * and /dev/wskbd0 both.
 *
 * The data from they keyboard may end up in at least four different
 * places:
 * - If this driver has been opened (/dev/kbd) and the
 *   direct mode (TIOCDIRECT) has been set, data goes to
 *   the process who opened the device. Data will transmit itself
 *   as described by the firm_event structure.
 * - If wskbd support is compiled in and a wskbd driver has been
 *   attached then the data is sent to it. Wskbd in turn may
 *   - Send the data in the wscons_event form to a process that
 *     has opened /dev/wskbd0
 *   - Feed the data to a virtual terminal.
 * - If an ite is present the data may be fed to it.
 */

uint8_t			kbd_modifier;	/* Modifier mask		*/

static uint8_t		kbd_ring[KBD_RING_SIZE];
static volatile u_int	kbd_rbput = 0;	/* 'put' index			*/
static u_int		kbd_rbget = 0;	/* 'get' index			*/

static struct kbd_softc kbd_softc;	/* XXX */

/* {b,c}devsw[] function prototypes */
static dev_type_open(kbdopen);
static dev_type_close(kbdclose);
static dev_type_read(kbdread);
static dev_type_ioctl(kbdioctl);
static dev_type_poll(kbdpoll);
static dev_type_kqfilter(kbdkqfilter);

static void kbdsoft(void *);
static void kbdattach(device_t, device_t, void *);
static int  kbdmatch(device_t, cfdata_t, void *);
#if NITE > 0
static int  kbd_do_modifier(uint8_t);
#endif
static int  kbd_write_poll(const uint8_t *, int);
static void kbd_pkg_start(struct kbd_softc *, uint8_t);

CFATTACH_DECL_NEW(kbd, 0,
    kbdmatch, kbdattach, NULL, NULL);

const struct cdevsw kbd_cdevsw = {
	.d_open = kbdopen,
	.d_close = kbdclose,
	.d_read = kbdread,
	.d_write = nowrite,
	.d_ioctl = kbdioctl,
	.d_stop = nostop,
	.d_tty = notty,
	.d_poll = kbdpoll,
	.d_mmap = nommap,
	.d_kqfilter = kbdkqfilter,
	.d_discard = nodiscard,
	.d_flag = 0
};

#if NWSKBD>0
/* accessops */
static int	kbd_enable(void *, int);
static void	kbd_set_leds(void *, int);
static int	kbd_ioctl(void *, u_long, void *, int, struct lwp *);

/* console ops */
static void	kbd_getc(void *, u_int *, int *);
static void	kbd_pollc(void *, int);
static void	kbd_bell(void *, u_int, u_int, u_int);

static struct wskbd_accessops kbd_accessops = {
	kbd_enable,
	kbd_set_leds,
	kbd_ioctl
};

static struct wskbd_consops kbd_consops = {
	kbd_getc,
	kbd_pollc,
	kbd_bell
};

/* Pointer to keymaps. */
static struct wskbd_mapdata kbd_mapdata = {
	atarikbd_keydesctab,
	KB_US
};
#endif /* WSKBD */

/*ARGSUSED*/
static int
kbdmatch(device_t parent, cfdata_t cf, void *aux)
{

	if (!strcmp((char *)aux, "kbd"))
		return 1;
	return 0;
}

/*ARGSUSED*/
static void
kbdattach(device_t parent, device_t self, void *aux)
{
	struct kbd_softc *sc = &kbd_softc;
	int timeout;
	const uint8_t kbd_rst[]  = { 0x80, 0x01 };
	const uint8_t kbd_icmd[] = { 0x12, 0x15 };

	/*
	 * Disable keyboard interrupts from MFP
	 */
	MFP->mf_ierb &= ~IB_AINT;

	/*
	 * Reset ACIA and initialize to:
	 *    divide by 16, 8 data, 1 stop, no parity, enable RX interrupts
	 */
	KBD->ac_cs = A_RESET;
	delay(100);	/* XXX: enough? */
	KBD->ac_cs = sc->sc_soft_cs = KBD_INIT | A_RXINT;

	/*
	 * Clear error conditions
	 */
	while ((KBD->ac_cs & (A_IRQ | A_RXRDY)) != 0)
		timeout = KBD->ac_da;

	/*
	 * Now send the reset string, and read+ignore its response
	 */
	aprint_normal("\n");
	if (kbd_write_poll(kbd_rst, 2) == 0)
		aprint_error_dev(self, "error cannot reset keyboard\n");
	for (timeout = 1000; timeout > 0; timeout--) {
		if ((KBD->ac_cs & (A_IRQ | A_RXRDY)) != 0) {
			timeout = KBD->ac_da;
			timeout = 100;
		}
		delay(100);
	}
	/*
	 * Send init command: disable mice & joysticks
	 */
	kbd_write_poll(kbd_icmd, sizeof(kbd_icmd));

	sc->sc_sicookie = softint_establish(SOFTINT_SERIAL, kbdsoft, NULL);

#if NWSKBD > 0
	if (self != NULL) {
		/*
		 * Try to attach the wskbd.
		 */
		struct wskbddev_attach_args waa;

		/* Maybe should be done before this?... */
		wskbd_cnattach(&kbd_consops, NULL, &kbd_mapdata);

		waa.console = 1;
		waa.keymap = &kbd_mapdata;
		waa.accessops = &kbd_accessops;
		waa.accesscookie = NULL;
		sc->sc_wskbddev = config_found(self, &waa, wskbddevprint,
		    CFARGS_NONE);

		sc->sc_pollingmode = 0;

		kbdenable();
	}
#endif /* WSKBD */
}

void
kbdenable(void)
{
	struct kbd_softc *sc = &kbd_softc;
	int s;

	s = spltty();

	/*
	 * Clear error conditions...
	 */
	while ((KBD->ac_cs & (A_IRQ | A_RXRDY)) != 0)
		(void)KBD->ac_da;
	/*
	 * Enable interrupts from MFP
	 */
	MFP->mf_iprb  = (uint8_t)~IB_AINT;
	MFP->mf_ierb |= IB_AINT;
	MFP->mf_imrb |= IB_AINT;

	sc->sc_event_mode   = 0;
	sc->sc_events.ev_io = 0;
	sc->sc_pkg_size     = 0;
	splx(s);
}

static int
kbdopen(dev_t dev, int flags, int mode, struct lwp *l)
{
	struct kbd_softc *sc = &kbd_softc;

	if (sc->sc_events.ev_io)
		return EBUSY;

	sc->sc_events.ev_io = l->l_proc;
	ev_init(&sc->sc_events);
	return 0;
}

static int
kbdclose(dev_t dev, int flags, int mode, struct lwp *l)
{
	struct kbd_softc *sc = &kbd_softc;

	/* Turn off event mode, dump the queue */
	sc->sc_event_mode = 0;
	ev_fini(&sc->sc_events);
	sc->sc_events.ev_io = NULL;
	return 0;
}

static int
kbdread(dev_t dev, struct uio *uio, int flags)
{
	struct kbd_softc *sc = &kbd_softc;

	return ev_read(&sc->sc_events, uio, flags);
}

static int
kbdioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l)
{
	struct kbd_softc *sc = &kbd_softc;
	struct kbdbell *kb;

	switch (cmd) {
	case KIOCTRANS:
		if (*(int *)data == TR_UNTRANS_EVENT)
			return 0;
		break;

	case KIOCGTRANS:
		/*
		 * Get translation mode
		 */
		*(int *)data = TR_UNTRANS_EVENT;
		return 0;

	case KIOCSDIRECT:
		sc->sc_event_mode = *(int *)data;
		return 0;

	case KIOCRINGBELL:
		kb = (struct kbdbell *)data;
		if (kb)
			kbd_bell_sparms(kb->volume, kb->pitch,
			    kb->duration);
		kbdbell();
		return 0;

	case FIONBIO:	/* we will remove this someday (soon???) */
		return 0;

	case FIOASYNC:
		sc->sc_events.ev_async = *(int *)data != 0;
		return 0;

	case FIOSETOWN:
		if (-*(int *)data != sc->sc_events.ev_io->p_pgid &&
		    *(int *)data != sc->sc_events.ev_io->p_pid)
			return EPERM;
		return 0;

	case TIOCSPGRP:
		if (*(int *)data != sc->sc_events.ev_io->p_pgid)
			return EPERM;
		return 0;

	default:
		return ENOTTY;
	}

	/*
	 * We identified the ioctl, but we do not handle it.
	 */
	return EOPNOTSUPP;		/* misuse, but what the heck */
}

static int
kbdpoll(dev_t dev, int events, struct lwp *l)
{
	struct kbd_softc *sc = &kbd_softc;

	return ev_poll(&sc->sc_events, events, l);
}

static int
kbdkqfilter(dev_t dev, struct knote *kn)
{
	struct kbd_softc *sc = &kbd_softc;

	return ev_kqfilter(&sc->sc_events, kn);
}

/*
 * Keyboard interrupt handler called straight from MFP at spl6.
 */
void
kbdintr(int sr)
	/* sr: sr at time of interrupt	*/
{
	struct kbd_softc *sc = &kbd_softc;
	uint8_t code;
	bool got_char = false;

	/*
	 * There may be multiple keys available. Read them all.
	 */
	while ((KBD->ac_cs & (A_RXRDY | A_OE | A_PE)) != 0) {
		got_char = true;
		code = KBD->ac_da;
		if ((KBD->ac_cs & (A_OE | A_PE)) != 0) {
			/* Silently ignore errors */
			continue;
		}
		kbd_ring[kbd_rbput++ & KBD_RING_MASK] = code;
	}

	/*
	 * If characters are waiting for transmit, send them.
	 */
	if ((sc->sc_soft_cs & A_TXINT) != 0 &&
	    (KBD->ac_cs & A_TXRDY) != 0) {
		if (sc->sc_sendp != NULL)
			KBD->ac_da = *sc->sc_sendp++;
		if (--sc->sc_send_cnt <= 0) {
			/*
			 * The total package has been transmitted,
			 * wakeup anyone waiting for it.
			 */
			KBD->ac_cs = (sc->sc_soft_cs &= ~A_TXINT);
			sc->sc_sendp = NULL;
			sc->sc_send_cnt = 0;
			wakeup((void *)&sc->sc_send_cnt);
		}
	}

	/*
	 * Activate software-level to handle possible input.
	 */
	if (got_char)
		softint_schedule(sc->sc_sicookie);
}

/*
 * Keyboard soft interrupt handler
 */
static void
kbdsoft(void *junk1)
{
	struct kbd_softc *sc = &kbd_softc;
	int s;
	uint8_t code;
	struct firm_event *fe;
	int put, get, n;

	get = kbd_rbget;

	for (;;) {
		n = kbd_rbput;
		if (get == n) /* We're done	*/
			break;
		n -= get;
		if (n > KBD_RING_SIZE) { /* Ring buffer overflow	*/
			get += n - KBD_RING_SIZE;
			n    = KBD_RING_SIZE;
		}
		while (--n >= 0) {
			code = kbd_ring[get++ & KBD_RING_MASK];

			/*
			 * If collecting a package, stuff it in and
			 * continue.
			 */
			if (sc->sc_pkg_size &&
			    (sc->sc_pkg_idx < sc->sc_pkg_size)) {
				sc->sc_package[sc->sc_pkg_idx++] = code;
				if (sc->sc_pkg_idx == sc->sc_pkg_size) {
					/*
					 * Package is complete.
					 */
					switch (sc->sc_pkg_type) {
#if NMOUSE > 0
					case KBD_AMS_PKG:
					case KBD_RMS_PKG:
					case KBD_JOY1_PKG:
						mouse_soft(
						    (REL_MOUSE *)sc->sc_package,
						    sc->sc_pkg_size,
						    sc->sc_pkg_type);
#endif /* NMOUSE */
					}
					sc->sc_pkg_size = 0;
				}
				continue;
			}
			/*
			 * If this is a package header, init pkg. handling.
			 */
			if (!KBD_IS_KEY(code)) {
				kbd_pkg_start(sc, code);
				continue;
			}
#if NWSKBD > 0
			/*
			 * If we have attached a wskbd and not in polling mode
			 * and nobody has opened us directly, then send the
			 * keystroke to the wskbd.
			 */

			if (sc->sc_pollingmode == 0 &&
			    sc->sc_wskbddev != NULL &&
			    sc->sc_event_mode == 0) {
				wskbd_input(sc->sc_wskbddev,
				    KBD_RELEASED(code) ?
				    WSCONS_EVENT_KEY_UP :
				    WSCONS_EVENT_KEY_DOWN,
				    KBD_SCANCODE(code));
				continue;
			}
#endif /* NWSKBD */
#if NITE > 0
			if (kbd_do_modifier(code) && !sc->sc_event_mode)
				continue;
#endif

			/*
			 * if not in event mode, deliver straight to ite to
			 * process key stroke
			 */
			if (!sc->sc_event_mode) {
				/* Gets to spltty() by itself	*/
#if NITE > 0
				ite_filter(code, ITEFILT_TTY);
#endif
				continue;
			}

			/*
			 * 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!).
			 */
			s = spltty();
			put = sc->sc_events.ev_put;
			fe  = &sc->sc_events.ev_q[put];
			put = (put + 1) % EV_QSIZE;
			if (put == sc->sc_events.ev_get) {
				log(LOG_WARNING,
				    "keyboard event queue overflow\n");
				splx(s);
				continue;
			}
			fe->id    = KBD_SCANCODE(code);
			fe->value = KBD_RELEASED(code) ? VKEY_UP : VKEY_DOWN;
			firm_gettime(fe);
			sc->sc_events.ev_put = put;
			EV_WAKEUP(&sc->sc_events);
			splx(s);
		}
		kbd_rbget = get;
	}
}

static uint8_t sound[] = {
	0xA8, 0x01, 0xA9, 0x01, 0xAA, 0x01, 0x00,
	0xF8, 0x10, 0x10, 0x10, 0x00, 0x20, 0x03
};

void
kbdbell(void)
{
	int i, s;

	s = splhigh();
	for (i = 0; i < sizeof(sound); i++) {
		YM2149->sd_selr = i;
		YM2149->sd_wdat = sound[i];
	}
	splx(s);
}


/*
 * Set the parameters of the 'default' beep.
 */

#define KBDBELLCLOCK	125000	/* 2MHz / 16 */
#define KBDBELLDURATION	128	/* 256 / 2MHz */

void
kbd_bell_gparms(u_int *volume, u_int *pitch, u_int *duration)
{
	u_int tmp;

	tmp = sound[11] | (sound[12] << 8);
	*duration = (tmp * KBDBELLDURATION) / 1000;

	tmp = sound[0] | (sound[1] << 8);
	*pitch = KBDBELLCLOCK / tmp;

	*volume = 0;
}

void
kbd_bell_sparms(u_int volume, u_int pitch, u_int duration)
{
	u_int f, t;

	f = pitch > 10 ? pitch : 10;	/* minimum pitch */
	if (f > 20000)
		f = 20000;		/* maximum pitch */

	f = KBDBELLCLOCK / f;

	t = (duration * 1000) / KBDBELLDURATION;

	sound[ 0] = f & 0xff;
	sound[ 1] = (f >> 8) & 0xf;
	f -= 1;
	sound[ 2] = f & 0xff;
	sound[ 3] = (f >> 8) & 0xf;
	f += 2;
	sound[ 4] = f & 0xff;
	sound[ 5] = (f >> 8) & 0xf;

	sound[11] = t & 0xff;
	sound[12] = (t >> 8) & 0xff;

	sound[13] = 0x03;
}

int
kbdgetcn(void)
{
	uint8_t code;
	int s = spltty();
	int ints_active;

	ints_active = 0;
	if ((MFP->mf_imrb & IB_AINT) != 0) {
		ints_active   = 1;
		MFP->mf_imrb &= ~IB_AINT;
	}
	for (;;) {
		while (!((KBD->ac_cs & (A_IRQ | A_RXRDY)) == (A_IRQ | A_RXRDY)))
			continue;	/* Wait for key	*/
		if ((KBD->ac_cs & (A_OE | A_PE)) != 0) {
			code = KBD->ac_da;	/* Silently ignore errors */
			continue;
		}
		code = KBD->ac_da;
#if NITE>0
		if (!kbd_do_modifier(code))
#endif
			break;
	}

	if (ints_active) {
		MFP->mf_iprb  = (uint8_t)~IB_AINT;
		MFP->mf_imrb |=  IB_AINT;
	}

	splx(s);
	return code;
}

/*
 * Write a command to the keyboard in 'polled' mode.
 */
static int
kbd_write_poll(const uint8_t *cmd, int len)
{
	int timeout;

	while (len-- > 0) {
		KBD->ac_da = *cmd++;
		for (timeout = 100; (KBD->ac_cs & A_TXRDY) == 0; timeout--)
			delay(10);
		if ((KBD->ac_cs & A_TXRDY) == 0)
			return 0;
	}
	return 1;
}

/*
 * Write a command to the keyboard. Return when command is send.
 */
void
kbd_write(const uint8_t *cmd, int len)
{
	struct kbd_softc *sc = &kbd_softc;
	int s;

	/*
	 * Get to splhigh, 'real' interrupts arrive at spl6!
	 */
	s = splhigh();

	/*
	 * Make sure any privious write has ended...
	 */
	while (sc->sc_sendp != NULL)
		tsleep((void *)&sc->sc_sendp, TTOPRI, "kbd_write1", 0);

	/*
	 * If the KBD-acia is not currently busy, send the first
	 * character now.
	 */
	KBD->ac_cs = (sc->sc_soft_cs |= A_TXINT);
	if ((KBD->ac_cs & A_TXRDY) != 0) {
		KBD->ac_da = *cmd++;
		len--;
	}

	/*
	 * If we're not yet done, wait until all characters are send.
	 */
	if (len > 0) {
		sc->sc_sendp    = cmd;
		sc->sc_send_cnt = len;
		tsleep((void *)&sc->sc_send_cnt, TTOPRI, "kbd_write2", 0);
	}
	splx(s);

	/*
	 * Wakeup all procs waiting for us.
	 */
	wakeup((void *)&sc->sc_sendp);
}

/*
 * Setup softc-fields to assemble a keyboard package.
 */
static void
kbd_pkg_start(struct kbd_softc *sc, uint8_t msg_start)
{

	sc->sc_pkg_idx    = 1;
	sc->sc_package[0] = msg_start;
	switch (msg_start) {
	case 0xf6:
		sc->sc_pkg_type = KBD_MEM_PKG;
		sc->sc_pkg_size = 8;
		break;
	case 0xf7:
		sc->sc_pkg_type = KBD_AMS_PKG;
		sc->sc_pkg_size = 6;
		break;
	case 0xf8:
	case 0xf9:
	case 0xfa:
	case 0xfb:
		sc->sc_pkg_type = KBD_RMS_PKG;
		sc->sc_pkg_size = 3;
		break;
	case 0xfc:
		sc->sc_pkg_type = KBD_CLK_PKG;
		sc->sc_pkg_size = 7;
		break;
	case 0xfe:
		sc->sc_pkg_type = KBD_JOY0_PKG;
		sc->sc_pkg_size = 2;
		break;
	case 0xff:
		sc->sc_pkg_type = KBD_JOY1_PKG;
		sc->sc_pkg_size = 2;
		break;
	default:
		printf("kbd: Unknown packet 0x%x\n", msg_start);
		break;
	}
}

#if NITE > 0
/*
 * Modifier processing
 */
static int
kbd_do_modifier(uint8_t code)
{
	uint8_t up, mask;

	up   = KBD_RELEASED(code);
	mask = 0;

	switch (KBD_SCANCODE(code)) {
	case KBD_LEFT_SHIFT:
		mask = KBD_MOD_LSHIFT;
		break;
	case KBD_RIGHT_SHIFT:
		mask = KBD_MOD_RSHIFT;
		break;
	case KBD_CTRL:
		mask = KBD_MOD_CTRL;
		break;
	case KBD_ALT:
		mask = KBD_MOD_ALT;
		break;
	case KBD_CAPS_LOCK:
		/* CAPSLOCK is a toggle */
		if (!up)
			kbd_modifier ^= KBD_MOD_CAPS;
		return 1;
	}
	if (mask) {
		if (up)
			kbd_modifier &= ~mask;
		else
			kbd_modifier |= mask;
		return 1;
	}
	return 0;
}
#endif

#if NWSKBD > 0
/*
 * These are the callback functions that are passed to wscons.
 * They really don't do anything worth noting, just call the
 * other functions above.
 */

static int
kbd_enable(void *c, int on)
{

	/* Wonder what this is supposed to do... */
	return 0;
}

static void
kbd_set_leds(void *c, int leds)
{

	/* we can not set the leds */
}

static int
kbd_ioctl(void *c, u_long cmd, void *data, int flag, struct lwp *p)
{
	struct wskbd_bell_data *kd;

	switch (cmd) {
	case WSKBDIO_COMPLEXBELL:
		kd = (struct wskbd_bell_data *)data;
		kbd_bell(0, kd->pitch, kd->period, kd->volume);
		return 0;
	case WSKBDIO_SETLEDS:
		return 0;
	case WSKBDIO_GETLEDS:
		*(int *)data = 0;
		return 0;
	case WSKBDIO_GTYPE:
		*(u_int *)data = WSKBD_TYPE_ATARI;
		return 0;
	}

	/*
	 * We are supposed to return EPASSTHROUGH to wscons if we didn't
	 * understand.
	 */
	return EPASSTHROUGH;
}

static void
kbd_getc(void *c, u_int *type, int *data)
{
	int key;

	key = kbdgetcn();

	*data = KBD_SCANCODE(key);
	*type = KBD_RELEASED(key) ? WSCONS_EVENT_KEY_UP : WSCONS_EVENT_KEY_DOWN;
}

static void
kbd_pollc(void *c, int on)
{
	struct kbd_softc *sc = &kbd_softc;

	sc->sc_pollingmode = on;
}

static void
kbd_bell(void *v, u_int pitch, u_int duration, u_int volume)
{

	kbd_bell_sparms(volume, pitch, duration);
	kbdbell();
}
#endif /* NWSKBD */