xref: /freebsd/sys/dev/atkbdc/atkbd.c (revision d3c87b851256744a7c106899d624910aa1967d4f)
1617b9080SKazutaka YOKOTA /*-
2617b9080SKazutaka YOKOTA  * Copyright (c) 1999 Kazutaka YOKOTA <yokota@zodiac.mech.utsunomiya-u.ac.jp>
3617b9080SKazutaka YOKOTA  * All rights reserved.
4617b9080SKazutaka YOKOTA  *
5617b9080SKazutaka YOKOTA  * Redistribution and use in source and binary forms, with or without
6617b9080SKazutaka YOKOTA  * modification, are permitted provided that the following conditions
7617b9080SKazutaka YOKOTA  * are met:
8617b9080SKazutaka YOKOTA  * 1. Redistributions of source code must retain the above copyright
9617b9080SKazutaka YOKOTA  *    notice, this list of conditions and the following disclaimer as
10617b9080SKazutaka YOKOTA  *    the first lines of this file unmodified.
11617b9080SKazutaka YOKOTA  * 2. Redistributions in binary form must reproduce the above copyright
12617b9080SKazutaka YOKOTA  *    notice, this list of conditions and the following disclaimer in the
13617b9080SKazutaka YOKOTA  *    documentation and/or other materials provided with the distribution.
14617b9080SKazutaka YOKOTA  *
15617b9080SKazutaka YOKOTA  * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
16617b9080SKazutaka YOKOTA  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17617b9080SKazutaka YOKOTA  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18617b9080SKazutaka YOKOTA  * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
19617b9080SKazutaka YOKOTA  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
20617b9080SKazutaka YOKOTA  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
21617b9080SKazutaka YOKOTA  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
22617b9080SKazutaka YOKOTA  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
23617b9080SKazutaka YOKOTA  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
24617b9080SKazutaka YOKOTA  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
25617b9080SKazutaka YOKOTA  *
26d3c87b85SKazutaka YOKOTA  * $Id: atkbd.c,v 1.9 1999/05/18 11:05:58 yokota Exp $
27617b9080SKazutaka YOKOTA  */
28617b9080SKazutaka YOKOTA 
29617b9080SKazutaka YOKOTA #include "atkbd.h"
30617b9080SKazutaka YOKOTA #include "opt_kbd.h"
31e9deda23SKazutaka YOKOTA #include "opt_atkbd.h"
32617b9080SKazutaka YOKOTA #include "opt_devfs.h"
33617b9080SKazutaka YOKOTA 
34617b9080SKazutaka YOKOTA #if NATKBD > 0
35617b9080SKazutaka YOKOTA 
36617b9080SKazutaka YOKOTA #include <sys/param.h>
37617b9080SKazutaka YOKOTA #include <sys/systm.h>
38617b9080SKazutaka YOKOTA #include <sys/kernel.h>
39617b9080SKazutaka YOKOTA #include <sys/conf.h>
40d3c87b85SKazutaka YOKOTA #include <sys/bus.h>
41617b9080SKazutaka YOKOTA #include <sys/proc.h>
42617b9080SKazutaka YOKOTA #include <sys/tty.h>
43617b9080SKazutaka YOKOTA #include <sys/fcntl.h>
44617b9080SKazutaka YOKOTA #include <sys/malloc.h>
45617b9080SKazutaka YOKOTA 
46617b9080SKazutaka YOKOTA #include <dev/kbd/kbdreg.h>
47617b9080SKazutaka YOKOTA #include <dev/kbd/atkbdreg.h>
48617b9080SKazutaka YOKOTA #include <dev/kbd/atkbdcreg.h>
49617b9080SKazutaka YOKOTA 
50f359876fSKazutaka YOKOTA #include <isa/isareg.h>
51f359876fSKazutaka YOKOTA 
52617b9080SKazutaka YOKOTA #define ATKBD_SOFTC(unit)		\
53617b9080SKazutaka YOKOTA 	((atkbd_softc_t *)devclass_get_softc(atkbd_devclass, unit))
54617b9080SKazutaka YOKOTA 
55d3c87b85SKazutaka YOKOTA extern devclass_t	atkbd_devclass;
56617b9080SKazutaka YOKOTA 
57617b9080SKazutaka YOKOTA static timeout_t	atkbd_timeout;
58617b9080SKazutaka YOKOTA 
59617b9080SKazutaka YOKOTA #ifdef KBD_INSTALL_CDEV
60617b9080SKazutaka YOKOTA 
61617b9080SKazutaka YOKOTA static d_open_t		atkbdopen;
62617b9080SKazutaka YOKOTA static d_close_t	atkbdclose;
63617b9080SKazutaka YOKOTA static d_read_t		atkbdread;
64617b9080SKazutaka YOKOTA static d_ioctl_t	atkbdioctl;
65617b9080SKazutaka YOKOTA static d_poll_t		atkbdpoll;
66617b9080SKazutaka YOKOTA 
67617b9080SKazutaka YOKOTA static struct  cdevsw atkbd_cdevsw = {
68617b9080SKazutaka YOKOTA 	atkbdopen,	atkbdclose,	atkbdread,	nowrite,
69617b9080SKazutaka YOKOTA 	atkbdioctl,	nostop,		nullreset,	nodevtotty,
70617b9080SKazutaka YOKOTA 	atkbdpoll,	nommap,		NULL,		ATKBD_DRIVER_NAME,
71617b9080SKazutaka YOKOTA 	NULL,		-1,
72617b9080SKazutaka YOKOTA };
73617b9080SKazutaka YOKOTA 
74617b9080SKazutaka YOKOTA #endif /* KBD_INSTALL_CDEV */
75617b9080SKazutaka YOKOTA 
76617b9080SKazutaka YOKOTA int
77e9deda23SKazutaka YOKOTA atkbd_probe_unit(int unit, int port, int irq, int flags)
78617b9080SKazutaka YOKOTA {
79617b9080SKazutaka YOKOTA 	keyboard_switch_t *sw;
80617b9080SKazutaka YOKOTA 	int args[2];
81e9deda23SKazutaka YOKOTA 	int error;
82617b9080SKazutaka YOKOTA 
83617b9080SKazutaka YOKOTA 	sw = kbd_get_switch(ATKBD_DRIVER_NAME);
84617b9080SKazutaka YOKOTA 	if (sw == NULL)
85617b9080SKazutaka YOKOTA 		return ENXIO;
86617b9080SKazutaka YOKOTA 
87617b9080SKazutaka YOKOTA 	args[0] = port;
88617b9080SKazutaka YOKOTA 	args[1] = irq;
89e9deda23SKazutaka YOKOTA 	error = (*sw->probe)(unit, args, flags);
90e9deda23SKazutaka YOKOTA 	if (error)
91e9deda23SKazutaka YOKOTA 		return error;
92e9deda23SKazutaka YOKOTA 	return 0;
93617b9080SKazutaka YOKOTA }
94617b9080SKazutaka YOKOTA 
95617b9080SKazutaka YOKOTA int
96e9deda23SKazutaka YOKOTA atkbd_attach_unit(int unit, atkbd_softc_t *sc, int port, int irq, int flags)
97617b9080SKazutaka YOKOTA {
98617b9080SKazutaka YOKOTA 	keyboard_switch_t *sw;
99e9deda23SKazutaka YOKOTA 	int args[2];
100617b9080SKazutaka YOKOTA 	int error;
101617b9080SKazutaka YOKOTA 
102617b9080SKazutaka YOKOTA 	if (sc->flags & ATKBD_ATTACHED)
103617b9080SKazutaka YOKOTA 		return 0;
104617b9080SKazutaka YOKOTA 
105617b9080SKazutaka YOKOTA 	sw = kbd_get_switch(ATKBD_DRIVER_NAME);
106617b9080SKazutaka YOKOTA 	if (sw == NULL)
107617b9080SKazutaka YOKOTA 		return ENXIO;
108617b9080SKazutaka YOKOTA 
109617b9080SKazutaka YOKOTA 	/* reset, initialize and enable the device */
110e9deda23SKazutaka YOKOTA 	args[0] = port;
111e9deda23SKazutaka YOKOTA 	args[1] = irq;
112e9deda23SKazutaka YOKOTA 	sc->kbd = NULL;
113e9deda23SKazutaka YOKOTA 	error = (*sw->probe)(unit, args, flags);
114617b9080SKazutaka YOKOTA 	if (error)
115e9deda23SKazutaka YOKOTA 		return error;
116e9deda23SKazutaka YOKOTA 	error = (*sw->init)(unit, &sc->kbd, args, flags);
117e9deda23SKazutaka YOKOTA 	if (error)
118e9deda23SKazutaka YOKOTA 		return error;
119617b9080SKazutaka YOKOTA 	(*sw->enable)(sc->kbd);
120617b9080SKazutaka YOKOTA 
121617b9080SKazutaka YOKOTA #ifdef KBD_INSTALL_CDEV
122617b9080SKazutaka YOKOTA 	/* attach a virtual keyboard cdev */
123617b9080SKazutaka YOKOTA 	error = kbd_attach(makedev(0, ATKBD_MKMINOR(unit)), sc->kbd,
124617b9080SKazutaka YOKOTA 			   &atkbd_cdevsw);
125617b9080SKazutaka YOKOTA 	if (error)
126617b9080SKazutaka YOKOTA 		return error;
127617b9080SKazutaka YOKOTA #endif
128617b9080SKazutaka YOKOTA 
129617b9080SKazutaka YOKOTA 	/*
130617b9080SKazutaka YOKOTA 	 * This is a kludge to compensate for lost keyboard interrupts.
131617b9080SKazutaka YOKOTA 	 * A similar code used to be in syscons. See below. XXX
132617b9080SKazutaka YOKOTA 	 */
133617b9080SKazutaka YOKOTA 	atkbd_timeout(sc->kbd);
134617b9080SKazutaka YOKOTA 
135617b9080SKazutaka YOKOTA 	if (bootverbose)
136617b9080SKazutaka YOKOTA 		(*sw->diag)(sc->kbd, bootverbose);
137617b9080SKazutaka YOKOTA 
138617b9080SKazutaka YOKOTA 	sc->flags |= ATKBD_ATTACHED;
139617b9080SKazutaka YOKOTA 	return 0;
140617b9080SKazutaka YOKOTA }
141617b9080SKazutaka YOKOTA 
142617b9080SKazutaka YOKOTA static void
143617b9080SKazutaka YOKOTA atkbd_timeout(void *arg)
144617b9080SKazutaka YOKOTA {
145617b9080SKazutaka YOKOTA 	keyboard_t *kbd;
146617b9080SKazutaka YOKOTA 	int s;
147617b9080SKazutaka YOKOTA 
148617b9080SKazutaka YOKOTA 	/* The following comments are extracted from syscons.c (1.287) */
149617b9080SKazutaka YOKOTA 	/*
150617b9080SKazutaka YOKOTA 	 * With release 2.1 of the Xaccel server, the keyboard is left
151617b9080SKazutaka YOKOTA 	 * hanging pretty often. Apparently an interrupt from the
152617b9080SKazutaka YOKOTA 	 * keyboard is lost, and I don't know why (yet).
153617b9080SKazutaka YOKOTA 	 * This ugly hack calls scintr if input is ready for the keyboard
154617b9080SKazutaka YOKOTA 	 * and conveniently hides the problem.			XXX
155617b9080SKazutaka YOKOTA 	 */
156617b9080SKazutaka YOKOTA 	/*
157617b9080SKazutaka YOKOTA 	 * Try removing anything stuck in the keyboard controller; whether
158617b9080SKazutaka YOKOTA 	 * it's a keyboard scan code or mouse data. `scintr()' doesn't
159617b9080SKazutaka YOKOTA 	 * read the mouse data directly, but `kbdio' routines will, as a
160617b9080SKazutaka YOKOTA 	 * side effect.
161617b9080SKazutaka YOKOTA 	 */
162617b9080SKazutaka YOKOTA 	s = spltty();
163617b9080SKazutaka YOKOTA 	kbd = (keyboard_t *)arg;
164617b9080SKazutaka YOKOTA 	if ((*kbdsw[kbd->kb_index]->lock)(kbd, TRUE)) {
165617b9080SKazutaka YOKOTA 		/*
166617b9080SKazutaka YOKOTA 		 * We have seen the lock flag is not set. Let's reset
167617b9080SKazutaka YOKOTA 		 * the flag early, otherwise the LED update routine fails
168617b9080SKazutaka YOKOTA 		 * which may want the lock during the interrupt routine.
169617b9080SKazutaka YOKOTA 		 */
170617b9080SKazutaka YOKOTA 		(*kbdsw[kbd->kb_index]->lock)(kbd, FALSE);
171617b9080SKazutaka YOKOTA 		if ((*kbdsw[kbd->kb_index]->check_char)(kbd))
172e9deda23SKazutaka YOKOTA 			(*kbdsw[kbd->kb_index]->intr)(kbd, NULL);
173617b9080SKazutaka YOKOTA 	}
174617b9080SKazutaka YOKOTA 	splx(s);
175617b9080SKazutaka YOKOTA 	timeout(atkbd_timeout, arg, hz/10);
176617b9080SKazutaka YOKOTA }
177617b9080SKazutaka YOKOTA 
178617b9080SKazutaka YOKOTA /* cdev driver functions */
179617b9080SKazutaka YOKOTA 
180617b9080SKazutaka YOKOTA #ifdef KBD_INSTALL_CDEV
181617b9080SKazutaka YOKOTA 
182617b9080SKazutaka YOKOTA static int
183617b9080SKazutaka YOKOTA atkbdopen(dev_t dev, int flag, int mode, struct proc *p)
184617b9080SKazutaka YOKOTA {
185617b9080SKazutaka YOKOTA 	atkbd_softc_t *sc;
186617b9080SKazutaka YOKOTA 
187e9deda23SKazutaka YOKOTA 	sc = ATKBD_SOFTC(ATKBD_UNIT(dev));
188e9deda23SKazutaka YOKOTA 	if (sc == NULL)
189617b9080SKazutaka YOKOTA 		return ENXIO;
190617b9080SKazutaka YOKOTA 	if (mode & (FWRITE | O_CREAT | O_APPEND | O_TRUNC))
191617b9080SKazutaka YOKOTA 		return ENODEV;
192617b9080SKazutaka YOKOTA 
193617b9080SKazutaka YOKOTA 	/* FIXME: set the initial input mode (K_XLATE?) and lock state? */
194617b9080SKazutaka YOKOTA 	return genkbdopen(&sc->gensc, sc->kbd, flag, mode, p);
195617b9080SKazutaka YOKOTA }
196617b9080SKazutaka YOKOTA 
197617b9080SKazutaka YOKOTA static int
198617b9080SKazutaka YOKOTA atkbdclose(dev_t dev, int flag, int mode, struct proc *p)
199617b9080SKazutaka YOKOTA {
200617b9080SKazutaka YOKOTA 	atkbd_softc_t *sc;
201617b9080SKazutaka YOKOTA 
202617b9080SKazutaka YOKOTA 	sc = ATKBD_SOFTC(ATKBD_UNIT(dev));
203617b9080SKazutaka YOKOTA 	return genkbdclose(&sc->gensc, sc->kbd, flag, mode, p);
204617b9080SKazutaka YOKOTA }
205617b9080SKazutaka YOKOTA 
206617b9080SKazutaka YOKOTA static int
207617b9080SKazutaka YOKOTA atkbdread(dev_t dev, struct uio *uio, int flag)
208617b9080SKazutaka YOKOTA {
209617b9080SKazutaka YOKOTA 	atkbd_softc_t *sc;
210617b9080SKazutaka YOKOTA 
211617b9080SKazutaka YOKOTA 	sc = ATKBD_SOFTC(ATKBD_UNIT(dev));
212617b9080SKazutaka YOKOTA 	return genkbdread(&sc->gensc, sc->kbd, uio, flag);
213617b9080SKazutaka YOKOTA }
214617b9080SKazutaka YOKOTA 
215617b9080SKazutaka YOKOTA static int
216617b9080SKazutaka YOKOTA atkbdioctl(dev_t dev, u_long cmd, caddr_t arg, int flag, struct proc *p)
217617b9080SKazutaka YOKOTA {
218617b9080SKazutaka YOKOTA 	atkbd_softc_t *sc;
219617b9080SKazutaka YOKOTA 
220617b9080SKazutaka YOKOTA 	sc = ATKBD_SOFTC(ATKBD_UNIT(dev));
221617b9080SKazutaka YOKOTA 	return genkbdioctl(&sc->gensc, sc->kbd, cmd, arg, flag, p);
222617b9080SKazutaka YOKOTA }
223617b9080SKazutaka YOKOTA 
224617b9080SKazutaka YOKOTA static int
225617b9080SKazutaka YOKOTA atkbdpoll(dev_t dev, int event, struct proc *p)
226617b9080SKazutaka YOKOTA {
227617b9080SKazutaka YOKOTA 	atkbd_softc_t *sc;
228617b9080SKazutaka YOKOTA 
229617b9080SKazutaka YOKOTA 	sc = ATKBD_SOFTC(ATKBD_UNIT(dev));
230617b9080SKazutaka YOKOTA 	return genkbdpoll(&sc->gensc, sc->kbd, event, p);
231617b9080SKazutaka YOKOTA }
232617b9080SKazutaka YOKOTA 
233617b9080SKazutaka YOKOTA #endif /* KBD_INSTALL_CDEV */
234617b9080SKazutaka YOKOTA 
235617b9080SKazutaka YOKOTA /* LOW-LEVEL */
236617b9080SKazutaka YOKOTA 
237617b9080SKazutaka YOKOTA #include <machine/limits.h>
238617b9080SKazutaka YOKOTA #include <machine/console.h>
239617b9080SKazutaka YOKOTA #include <machine/clock.h>
240617b9080SKazutaka YOKOTA 
241617b9080SKazutaka YOKOTA #define ATKBD_DEFAULT	0
242617b9080SKazutaka YOKOTA 
243617b9080SKazutaka YOKOTA typedef struct atkbd_state {
244617b9080SKazutaka YOKOTA 	KBDC		kbdc;		/* keyboard controller */
245617b9080SKazutaka YOKOTA 					/* XXX: don't move this field; pcvt
246617b9080SKazutaka YOKOTA 					 * expects `kbdc' to be the first
247617b9080SKazutaka YOKOTA 					 * field in this structure. */
248617b9080SKazutaka YOKOTA 	int		ks_mode;	/* input mode (K_XLATE,K_RAW,K_CODE) */
249617b9080SKazutaka YOKOTA 	int		ks_flags;	/* flags */
250617b9080SKazutaka YOKOTA #define COMPOSE		(1 << 0)
251e9deda23SKazutaka YOKOTA 	int		ks_polling;
252617b9080SKazutaka YOKOTA 	int		ks_state;	/* shift/lock key state */
253617b9080SKazutaka YOKOTA 	int		ks_accents;	/* accent key index (> 0) */
254617b9080SKazutaka YOKOTA 	u_int		ks_composed_char; /* composed char code (> 0) */
255617b9080SKazutaka YOKOTA 	u_char		ks_prefix;	/* AT scan code prefix */
256617b9080SKazutaka YOKOTA } atkbd_state_t;
257617b9080SKazutaka YOKOTA 
258617b9080SKazutaka YOKOTA /* keyboard driver declaration */
259617b9080SKazutaka YOKOTA static int		atkbd_configure(int flags);
260617b9080SKazutaka YOKOTA static kbd_probe_t	atkbd_probe;
261617b9080SKazutaka YOKOTA static kbd_init_t	atkbd_init;
262617b9080SKazutaka YOKOTA static kbd_term_t	atkbd_term;
263617b9080SKazutaka YOKOTA static kbd_intr_t	atkbd_intr;
264617b9080SKazutaka YOKOTA static kbd_test_if_t	atkbd_test_if;
265617b9080SKazutaka YOKOTA static kbd_enable_t	atkbd_enable;
266617b9080SKazutaka YOKOTA static kbd_disable_t	atkbd_disable;
267617b9080SKazutaka YOKOTA static kbd_read_t	atkbd_read;
268617b9080SKazutaka YOKOTA static kbd_check_t	atkbd_check;
269617b9080SKazutaka YOKOTA static kbd_read_char_t	atkbd_read_char;
270617b9080SKazutaka YOKOTA static kbd_check_char_t	atkbd_check_char;
271617b9080SKazutaka YOKOTA static kbd_ioctl_t	atkbd_ioctl;
272617b9080SKazutaka YOKOTA static kbd_lock_t	atkbd_lock;
273617b9080SKazutaka YOKOTA static kbd_clear_state_t atkbd_clear_state;
274617b9080SKazutaka YOKOTA static kbd_get_state_t	atkbd_get_state;
275617b9080SKazutaka YOKOTA static kbd_set_state_t	atkbd_set_state;
276e9deda23SKazutaka YOKOTA static kbd_poll_mode_t	atkbd_poll;
277617b9080SKazutaka YOKOTA 
278617b9080SKazutaka YOKOTA keyboard_switch_t atkbdsw = {
279617b9080SKazutaka YOKOTA 	atkbd_probe,
280617b9080SKazutaka YOKOTA 	atkbd_init,
281617b9080SKazutaka YOKOTA 	atkbd_term,
282617b9080SKazutaka YOKOTA 	atkbd_intr,
283617b9080SKazutaka YOKOTA 	atkbd_test_if,
284617b9080SKazutaka YOKOTA 	atkbd_enable,
285617b9080SKazutaka YOKOTA 	atkbd_disable,
286617b9080SKazutaka YOKOTA 	atkbd_read,
287617b9080SKazutaka YOKOTA 	atkbd_check,
288617b9080SKazutaka YOKOTA 	atkbd_read_char,
289617b9080SKazutaka YOKOTA 	atkbd_check_char,
290617b9080SKazutaka YOKOTA 	atkbd_ioctl,
291617b9080SKazutaka YOKOTA 	atkbd_lock,
292617b9080SKazutaka YOKOTA 	atkbd_clear_state,
293617b9080SKazutaka YOKOTA 	atkbd_get_state,
294617b9080SKazutaka YOKOTA 	atkbd_set_state,
295617b9080SKazutaka YOKOTA 	genkbd_get_fkeystr,
296e9deda23SKazutaka YOKOTA 	atkbd_poll,
297617b9080SKazutaka YOKOTA 	genkbd_diag,
298617b9080SKazutaka YOKOTA };
299617b9080SKazutaka YOKOTA 
300617b9080SKazutaka YOKOTA KEYBOARD_DRIVER(atkbd, atkbdsw, atkbd_configure);
301617b9080SKazutaka YOKOTA 
302617b9080SKazutaka YOKOTA /* local functions */
303617b9080SKazutaka YOKOTA static int		setup_kbd_port(KBDC kbdc, int port, int intr);
304617b9080SKazutaka YOKOTA static int		get_kbd_echo(KBDC kbdc);
305617b9080SKazutaka YOKOTA static int		probe_keyboard(KBDC kbdc, int flags);
306617b9080SKazutaka YOKOTA static int		init_keyboard(KBDC kbdc, int *type, int flags);
307617b9080SKazutaka YOKOTA static int		write_kbd(KBDC kbdc, int command, int data);
308617b9080SKazutaka YOKOTA static int		get_kbd_id(KBDC kbdc);
309e9deda23SKazutaka YOKOTA static int		typematic(int delay, int rate);
310617b9080SKazutaka YOKOTA 
311617b9080SKazutaka YOKOTA /* local variables */
312617b9080SKazutaka YOKOTA 
313617b9080SKazutaka YOKOTA /* the initial key map, accent map and fkey strings */
314e9deda23SKazutaka YOKOTA #ifdef ATKBD_DFLT_KEYMAP
315e9deda23SKazutaka YOKOTA #define KBD_DFLT_KEYMAP
316e9deda23SKazutaka YOKOTA #include "atkbdmap.h"
317e9deda23SKazutaka YOKOTA #endif
318f359876fSKazutaka YOKOTA #include <dev/kbd/kbdtables.h>
319617b9080SKazutaka YOKOTA 
320617b9080SKazutaka YOKOTA /* structures for the default keyboard */
321617b9080SKazutaka YOKOTA static keyboard_t	default_kbd;
322617b9080SKazutaka YOKOTA static atkbd_state_t	default_kbd_state;
323617b9080SKazutaka YOKOTA static keymap_t		default_keymap;
324617b9080SKazutaka YOKOTA static accentmap_t	default_accentmap;
325617b9080SKazutaka YOKOTA static fkeytab_t	default_fkeytab[NUM_FKEYS];
326617b9080SKazutaka YOKOTA 
327617b9080SKazutaka YOKOTA /*
328617b9080SKazutaka YOKOTA  * The back door to the keyboard driver!
329617b9080SKazutaka YOKOTA  * This function is called by the console driver, via the kbdio module,
330617b9080SKazutaka YOKOTA  * to tickle keyboard drivers when the low-level console is being initialized.
331617b9080SKazutaka YOKOTA  * Almost nothing in the kernel has been initialied yet.  Try to probe
332617b9080SKazutaka YOKOTA  * keyboards if possible.
333617b9080SKazutaka YOKOTA  * NOTE: because of the way the low-level conole is initialized, this routine
334617b9080SKazutaka YOKOTA  * may be called more than once!!
335617b9080SKazutaka YOKOTA  */
336617b9080SKazutaka YOKOTA static int
337617b9080SKazutaka YOKOTA atkbd_configure(int flags)
338617b9080SKazutaka YOKOTA {
339617b9080SKazutaka YOKOTA 	keyboard_t *kbd;
340617b9080SKazutaka YOKOTA 	int arg[2];
341e9deda23SKazutaka YOKOTA 	int i;
342617b9080SKazutaka YOKOTA 
343e9deda23SKazutaka YOKOTA 	/* if the driver is disabled, unregister the keyboard if any */
34457600c23SKazutaka YOKOTA 	if ((resource_int_value("atkbd", ATKBD_DEFAULT, "disabled", &i) == 0)
3456182fdbdSPeter Wemm 	    && i != 0) {
346e9deda23SKazutaka YOKOTA 		i = kbd_find_keyboard(ATKBD_DRIVER_NAME, ATKBD_DEFAULT);
347e9deda23SKazutaka YOKOTA 		if (i >= 0) {
348e9deda23SKazutaka YOKOTA 			kbd = kbd_get_keyboard(i);
349e9deda23SKazutaka YOKOTA 			kbd_unregister(kbd);
350e9deda23SKazutaka YOKOTA 			kbd->kb_flags &= ~KB_REGISTERED;
351e9deda23SKazutaka YOKOTA 			return 0;
352e9deda23SKazutaka YOKOTA 		}
353e9deda23SKazutaka YOKOTA 	}
35457600c23SKazutaka YOKOTA 
35557600c23SKazutaka YOKOTA 	/* XXX: a kludge to obtain the device configuration flags */
35657600c23SKazutaka YOKOTA 	if (resource_int_value("atkbd", ATKBD_DEFAULT, "flags", &i) == 0)
35757600c23SKazutaka YOKOTA 		flags |= i;
358617b9080SKazutaka YOKOTA 
359617b9080SKazutaka YOKOTA 	/* probe the keyboard controller */
360617b9080SKazutaka YOKOTA 	atkbdc_configure();
361617b9080SKazutaka YOKOTA 
362617b9080SKazutaka YOKOTA 	/* probe the default keyboard */
363617b9080SKazutaka YOKOTA 	arg[0] = -1;
364617b9080SKazutaka YOKOTA 	arg[1] = -1;
365e9deda23SKazutaka YOKOTA 	kbd = NULL;
366e9deda23SKazutaka YOKOTA 	if (atkbd_probe(ATKBD_DEFAULT, arg, flags))
367e9deda23SKazutaka YOKOTA 		return 0;
368e9deda23SKazutaka YOKOTA 	if (atkbd_init(ATKBD_DEFAULT, &kbd, arg, flags))
369617b9080SKazutaka YOKOTA 		return 0;
370617b9080SKazutaka YOKOTA 
371e9deda23SKazutaka YOKOTA 	/* return the number of found keyboards */
372e9deda23SKazutaka YOKOTA 	return 1;
373617b9080SKazutaka YOKOTA }
374617b9080SKazutaka YOKOTA 
375617b9080SKazutaka YOKOTA /* low-level functions */
376617b9080SKazutaka YOKOTA 
377e9deda23SKazutaka YOKOTA /* detect a keyboard */
378617b9080SKazutaka YOKOTA static int
379e9deda23SKazutaka YOKOTA atkbd_probe(int unit, void *arg, int flags)
380e9deda23SKazutaka YOKOTA {
381e9deda23SKazutaka YOKOTA 	KBDC kbdc;
382e9deda23SKazutaka YOKOTA 	int *data = (int *)arg;
383e9deda23SKazutaka YOKOTA 
384e9deda23SKazutaka YOKOTA 	/* XXX */
385e9deda23SKazutaka YOKOTA 	if (unit == ATKBD_DEFAULT) {
386e9deda23SKazutaka YOKOTA 		if (KBD_IS_PROBED(&default_kbd))
387e9deda23SKazutaka YOKOTA 			return 0;
388e9deda23SKazutaka YOKOTA 	}
389e9deda23SKazutaka YOKOTA 
390e9deda23SKazutaka YOKOTA 	kbdc = kbdc_open(data[0]);
391e9deda23SKazutaka YOKOTA 	if (kbdc == NULL)
392e9deda23SKazutaka YOKOTA 		return ENXIO;
393e9deda23SKazutaka YOKOTA 	if (probe_keyboard(kbdc, flags)) {
394e9deda23SKazutaka YOKOTA 		if (flags & KB_CONF_FAIL_IF_NO_KBD)
395e9deda23SKazutaka YOKOTA 			return ENXIO;
396e9deda23SKazutaka YOKOTA 	}
397e9deda23SKazutaka YOKOTA 	return 0;
398e9deda23SKazutaka YOKOTA }
399e9deda23SKazutaka YOKOTA 
400e9deda23SKazutaka YOKOTA /* reset and initialize the device */
401e9deda23SKazutaka YOKOTA static int
402e9deda23SKazutaka YOKOTA atkbd_init(int unit, keyboard_t **kbdp, void *arg, int flags)
403617b9080SKazutaka YOKOTA {
404617b9080SKazutaka YOKOTA 	keyboard_t *kbd;
405617b9080SKazutaka YOKOTA 	atkbd_state_t *state;
406617b9080SKazutaka YOKOTA 	keymap_t *keymap;
407617b9080SKazutaka YOKOTA 	accentmap_t *accmap;
408617b9080SKazutaka YOKOTA 	fkeytab_t *fkeymap;
409617b9080SKazutaka YOKOTA 	int fkeymap_size;
410617b9080SKazutaka YOKOTA 	int *data = (int *)arg;
411617b9080SKazutaka YOKOTA 
412617b9080SKazutaka YOKOTA 	/* XXX */
413617b9080SKazutaka YOKOTA 	if (unit == ATKBD_DEFAULT) {
414617b9080SKazutaka YOKOTA 		*kbdp = kbd = &default_kbd;
415e9deda23SKazutaka YOKOTA 		if (KBD_IS_INITIALIZED(kbd) && KBD_IS_CONFIGURED(kbd))
416617b9080SKazutaka YOKOTA 			return 0;
417617b9080SKazutaka YOKOTA 		state = &default_kbd_state;
418617b9080SKazutaka YOKOTA 		keymap = &default_keymap;
419617b9080SKazutaka YOKOTA 		accmap = &default_accentmap;
420617b9080SKazutaka YOKOTA 		fkeymap = default_fkeytab;
421617b9080SKazutaka YOKOTA 		fkeymap_size =
422617b9080SKazutaka YOKOTA 			sizeof(default_fkeytab)/sizeof(default_fkeytab[0]);
423617b9080SKazutaka YOKOTA 	} else if (*kbdp == NULL) {
424617b9080SKazutaka YOKOTA 		*kbdp = kbd = malloc(sizeof(*kbd), M_DEVBUF, M_NOWAIT);
425617b9080SKazutaka YOKOTA 		if (kbd == NULL)
426617b9080SKazutaka YOKOTA 			return ENOMEM;
427617b9080SKazutaka YOKOTA 		bzero(kbd, sizeof(*kbd));
428617b9080SKazutaka YOKOTA 		state = malloc(sizeof(*state), M_DEVBUF, M_NOWAIT);
429617b9080SKazutaka YOKOTA 		keymap = malloc(sizeof(key_map), M_DEVBUF, M_NOWAIT);
430617b9080SKazutaka YOKOTA 		accmap = malloc(sizeof(accent_map), M_DEVBUF, M_NOWAIT);
431617b9080SKazutaka YOKOTA 		fkeymap = malloc(sizeof(fkey_tab), M_DEVBUF, M_NOWAIT);
432617b9080SKazutaka YOKOTA 		fkeymap_size = sizeof(fkey_tab)/sizeof(fkey_tab[0]);
433617b9080SKazutaka YOKOTA 		if ((state == NULL) || (keymap == NULL) || (accmap == NULL)
434617b9080SKazutaka YOKOTA 		     || (fkeymap == NULL)) {
435617b9080SKazutaka YOKOTA 			if (state != NULL)
436617b9080SKazutaka YOKOTA 				free(state, M_DEVBUF);
437617b9080SKazutaka YOKOTA 			if (keymap != NULL)
438617b9080SKazutaka YOKOTA 				free(keymap, M_DEVBUF);
439617b9080SKazutaka YOKOTA 			if (accmap != NULL)
440617b9080SKazutaka YOKOTA 				free(accmap, M_DEVBUF);
441617b9080SKazutaka YOKOTA 			if (fkeymap != NULL)
442617b9080SKazutaka YOKOTA 				free(fkeymap, M_DEVBUF);
443617b9080SKazutaka YOKOTA 			free(kbd, M_DEVBUF);
444617b9080SKazutaka YOKOTA 			return ENOMEM;
445617b9080SKazutaka YOKOTA 		}
446617b9080SKazutaka YOKOTA 		bzero(state, sizeof(*state));
447e9deda23SKazutaka YOKOTA 	} else if (KBD_IS_INITIALIZED(*kbdp) && KBD_IS_CONFIGURED(*kbdp)) {
448617b9080SKazutaka YOKOTA 		return 0;
449617b9080SKazutaka YOKOTA 	} else {
450617b9080SKazutaka YOKOTA 		kbd = *kbdp;
451617b9080SKazutaka YOKOTA 		state = (atkbd_state_t *)kbd->kb_data;
452617b9080SKazutaka YOKOTA 		bzero(state, sizeof(*state));
453617b9080SKazutaka YOKOTA 		keymap = kbd->kb_keymap;
454617b9080SKazutaka YOKOTA 		accmap = kbd->kb_accentmap;
455617b9080SKazutaka YOKOTA 		fkeymap = kbd->kb_fkeytab;
456617b9080SKazutaka YOKOTA 		fkeymap_size = kbd->kb_fkeytab_size;
457617b9080SKazutaka YOKOTA 	}
458617b9080SKazutaka YOKOTA 
459e9deda23SKazutaka YOKOTA 	if (!KBD_IS_PROBED(kbd)) {
460e9deda23SKazutaka YOKOTA 		state->kbdc = kbdc_open(data[0]);
461e9deda23SKazutaka YOKOTA 		if (state->kbdc == NULL)
462617b9080SKazutaka YOKOTA 			return ENXIO;
463e9deda23SKazutaka YOKOTA 		kbd_init_struct(kbd, ATKBD_DRIVER_NAME, KB_OTHER, unit, flags,
464e9deda23SKazutaka YOKOTA 				data[0], IO_KBDSIZE);
465617b9080SKazutaka YOKOTA 		bcopy(&key_map, keymap, sizeof(key_map));
466617b9080SKazutaka YOKOTA 		bcopy(&accent_map, accmap, sizeof(accent_map));
467617b9080SKazutaka YOKOTA 		bcopy(fkey_tab, fkeymap,
468617b9080SKazutaka YOKOTA 		      imin(fkeymap_size*sizeof(fkeymap[0]), sizeof(fkey_tab)));
469617b9080SKazutaka YOKOTA 		kbd_set_maps(kbd, keymap, accmap, fkeymap, fkeymap_size);
470617b9080SKazutaka YOKOTA 		kbd->kb_data = (void *)state;
471617b9080SKazutaka YOKOTA 
472e9deda23SKazutaka YOKOTA 		if (probe_keyboard(state->kbdc, flags)) { /* shouldn't happen */
473617b9080SKazutaka YOKOTA 			if (flags & KB_CONF_FAIL_IF_NO_KBD)
474617b9080SKazutaka YOKOTA 				return ENXIO;
475617b9080SKazutaka YOKOTA 		} else {
476617b9080SKazutaka YOKOTA 			KBD_FOUND_DEVICE(kbd);
477617b9080SKazutaka YOKOTA 		}
478617b9080SKazutaka YOKOTA 		atkbd_clear_state(kbd);
479617b9080SKazutaka YOKOTA 		state->ks_mode = K_XLATE;
480617b9080SKazutaka YOKOTA 		/*
481617b9080SKazutaka YOKOTA 		 * FIXME: set the initial value for lock keys in ks_state
482617b9080SKazutaka YOKOTA 		 * according to the BIOS data?
483617b9080SKazutaka YOKOTA 		 */
484617b9080SKazutaka YOKOTA 		KBD_PROBE_DONE(kbd);
485617b9080SKazutaka YOKOTA 	}
486e9deda23SKazutaka YOKOTA 	if (!KBD_IS_INITIALIZED(kbd) && !(flags & KB_CONF_PROBE_ONLY)) {
487617b9080SKazutaka YOKOTA 		if (KBD_HAS_DEVICE(kbd)
488e9deda23SKazutaka YOKOTA 	    	    && init_keyboard(state->kbdc, &kbd->kb_type, kbd->kb_config)
489617b9080SKazutaka YOKOTA 	    	    && (kbd->kb_config & KB_CONF_FAIL_IF_NO_KBD))
490617b9080SKazutaka YOKOTA 			return ENXIO;
491e9deda23SKazutaka YOKOTA 		atkbd_ioctl(kbd, KDSETLED, (caddr_t)&state->ks_state);
492617b9080SKazutaka YOKOTA 		KBD_INIT_DONE(kbd);
493617b9080SKazutaka YOKOTA 	}
494617b9080SKazutaka YOKOTA 	if (!KBD_IS_CONFIGURED(kbd)) {
495617b9080SKazutaka YOKOTA 		if (kbd_register(kbd) < 0)
496617b9080SKazutaka YOKOTA 			return ENXIO;
497617b9080SKazutaka YOKOTA 		KBD_CONFIG_DONE(kbd);
498617b9080SKazutaka YOKOTA 	}
499617b9080SKazutaka YOKOTA 
500617b9080SKazutaka YOKOTA 	return 0;
501617b9080SKazutaka YOKOTA }
502617b9080SKazutaka YOKOTA 
503617b9080SKazutaka YOKOTA /* finish using this keyboard */
504617b9080SKazutaka YOKOTA static int
505617b9080SKazutaka YOKOTA atkbd_term(keyboard_t *kbd)
506617b9080SKazutaka YOKOTA {
507617b9080SKazutaka YOKOTA 	kbd_unregister(kbd);
508617b9080SKazutaka YOKOTA 	return 0;
509617b9080SKazutaka YOKOTA }
510617b9080SKazutaka YOKOTA 
511617b9080SKazutaka YOKOTA /* keyboard interrupt routine */
512617b9080SKazutaka YOKOTA static int
513e9deda23SKazutaka YOKOTA atkbd_intr(keyboard_t *kbd, void *arg)
514617b9080SKazutaka YOKOTA {
515617b9080SKazutaka YOKOTA 	atkbd_state_t *state;
516617b9080SKazutaka YOKOTA 	int c;
517617b9080SKazutaka YOKOTA 
518617b9080SKazutaka YOKOTA 	if (KBD_IS_ACTIVE(kbd) && KBD_IS_BUSY(kbd)) {
519617b9080SKazutaka YOKOTA 		/* let the callback function to process the input */
520617b9080SKazutaka YOKOTA 		(*kbd->kb_callback.kc_func)(kbd, KBDIO_KEYINPUT,
521617b9080SKazutaka YOKOTA 					    kbd->kb_callback.kc_arg);
522617b9080SKazutaka YOKOTA 	} else {
523617b9080SKazutaka YOKOTA 		/* read and discard the input; no one is waiting for input */
524617b9080SKazutaka YOKOTA 		do {
525617b9080SKazutaka YOKOTA 			c = atkbd_read_char(kbd, FALSE);
526617b9080SKazutaka YOKOTA 		} while (c != NOKEY);
527617b9080SKazutaka YOKOTA 
528617b9080SKazutaka YOKOTA 		if (!KBD_HAS_DEVICE(kbd)) {
529617b9080SKazutaka YOKOTA 			/*
530617b9080SKazutaka YOKOTA 			 * The keyboard was not detected before;
531617b9080SKazutaka YOKOTA 			 * it must have been reconnected!
532617b9080SKazutaka YOKOTA 			 */
533617b9080SKazutaka YOKOTA 			state = (atkbd_state_t *)kbd->kb_data;
534617b9080SKazutaka YOKOTA 			init_keyboard(state->kbdc, &kbd->kb_type,
535617b9080SKazutaka YOKOTA 				      kbd->kb_config);
536617b9080SKazutaka YOKOTA 			atkbd_ioctl(kbd, KDSETLED, (caddr_t)&state->ks_state);
537617b9080SKazutaka YOKOTA 			KBD_FOUND_DEVICE(kbd);
538617b9080SKazutaka YOKOTA 		}
539617b9080SKazutaka YOKOTA 	}
540617b9080SKazutaka YOKOTA 	return 0;
541617b9080SKazutaka YOKOTA }
542617b9080SKazutaka YOKOTA 
543617b9080SKazutaka YOKOTA /* test the interface to the device */
544617b9080SKazutaka YOKOTA static int
545617b9080SKazutaka YOKOTA atkbd_test_if(keyboard_t *kbd)
546617b9080SKazutaka YOKOTA {
547617b9080SKazutaka YOKOTA 	int error;
548617b9080SKazutaka YOKOTA 	int s;
549617b9080SKazutaka YOKOTA 
550617b9080SKazutaka YOKOTA 	error = 0;
551617b9080SKazutaka YOKOTA 	empty_both_buffers(((atkbd_state_t *)kbd->kb_data)->kbdc, 10);
552617b9080SKazutaka YOKOTA 	s = spltty();
553617b9080SKazutaka YOKOTA 	if (!test_controller(((atkbd_state_t *)kbd->kb_data)->kbdc))
554617b9080SKazutaka YOKOTA 		error = EIO;
555617b9080SKazutaka YOKOTA 	else if (test_kbd_port(((atkbd_state_t *)kbd->kb_data)->kbdc) != 0)
556617b9080SKazutaka YOKOTA 		error = EIO;
557617b9080SKazutaka YOKOTA 	splx(s);
558617b9080SKazutaka YOKOTA 
559617b9080SKazutaka YOKOTA 	return error;
560617b9080SKazutaka YOKOTA }
561617b9080SKazutaka YOKOTA 
562617b9080SKazutaka YOKOTA /*
563617b9080SKazutaka YOKOTA  * Enable the access to the device; until this function is called,
564617b9080SKazutaka YOKOTA  * the client cannot read from the keyboard.
565617b9080SKazutaka YOKOTA  */
566617b9080SKazutaka YOKOTA static int
567617b9080SKazutaka YOKOTA atkbd_enable(keyboard_t *kbd)
568617b9080SKazutaka YOKOTA {
569617b9080SKazutaka YOKOTA 	int s;
570617b9080SKazutaka YOKOTA 
571617b9080SKazutaka YOKOTA 	s = spltty();
572617b9080SKazutaka YOKOTA 	KBD_ACTIVATE(kbd);
573617b9080SKazutaka YOKOTA 	splx(s);
574617b9080SKazutaka YOKOTA 	return 0;
575617b9080SKazutaka YOKOTA }
576617b9080SKazutaka YOKOTA 
577617b9080SKazutaka YOKOTA /* disallow the access to the device */
578617b9080SKazutaka YOKOTA static int
579617b9080SKazutaka YOKOTA atkbd_disable(keyboard_t *kbd)
580617b9080SKazutaka YOKOTA {
581617b9080SKazutaka YOKOTA 	int s;
582617b9080SKazutaka YOKOTA 
583617b9080SKazutaka YOKOTA 	s = spltty();
584617b9080SKazutaka YOKOTA 	KBD_DEACTIVATE(kbd);
585617b9080SKazutaka YOKOTA 	splx(s);
586617b9080SKazutaka YOKOTA 	return 0;
587617b9080SKazutaka YOKOTA }
588617b9080SKazutaka YOKOTA 
589617b9080SKazutaka YOKOTA /* read one byte from the keyboard if it's allowed */
590617b9080SKazutaka YOKOTA static int
591617b9080SKazutaka YOKOTA atkbd_read(keyboard_t *kbd, int wait)
592617b9080SKazutaka YOKOTA {
593617b9080SKazutaka YOKOTA 	int c;
594617b9080SKazutaka YOKOTA 
595617b9080SKazutaka YOKOTA 	if (wait)
596617b9080SKazutaka YOKOTA 		c = read_kbd_data(((atkbd_state_t *)kbd->kb_data)->kbdc);
597617b9080SKazutaka YOKOTA 	else
598617b9080SKazutaka YOKOTA 		c = read_kbd_data_no_wait(((atkbd_state_t *)kbd->kb_data)->kbdc);
599617b9080SKazutaka YOKOTA 	return (KBD_IS_ACTIVE(kbd) ? c : -1);
600617b9080SKazutaka YOKOTA }
601617b9080SKazutaka YOKOTA 
602617b9080SKazutaka YOKOTA /* check if data is waiting */
603617b9080SKazutaka YOKOTA static int
604617b9080SKazutaka YOKOTA atkbd_check(keyboard_t *kbd)
605617b9080SKazutaka YOKOTA {
606617b9080SKazutaka YOKOTA 	if (!KBD_IS_ACTIVE(kbd))
607617b9080SKazutaka YOKOTA 		return FALSE;
608617b9080SKazutaka YOKOTA 	return kbdc_data_ready(((atkbd_state_t *)kbd->kb_data)->kbdc);
609617b9080SKazutaka YOKOTA }
610617b9080SKazutaka YOKOTA 
611617b9080SKazutaka YOKOTA /* read char from the keyboard */
612617b9080SKazutaka YOKOTA static u_int
613617b9080SKazutaka YOKOTA atkbd_read_char(keyboard_t *kbd, int wait)
614617b9080SKazutaka YOKOTA {
615617b9080SKazutaka YOKOTA 	atkbd_state_t *state;
616617b9080SKazutaka YOKOTA 	u_int action;
617617b9080SKazutaka YOKOTA 	int scancode;
618617b9080SKazutaka YOKOTA 	int keycode;
619617b9080SKazutaka YOKOTA 
620617b9080SKazutaka YOKOTA 	state = (atkbd_state_t *)kbd->kb_data;
621617b9080SKazutaka YOKOTA next_code:
622617b9080SKazutaka YOKOTA 	/* do we have a composed char to return? */
623617b9080SKazutaka YOKOTA 	if (!(state->ks_flags & COMPOSE) && (state->ks_composed_char > 0)) {
624617b9080SKazutaka YOKOTA 		action = state->ks_composed_char;
625617b9080SKazutaka YOKOTA 		state->ks_composed_char = 0;
626617b9080SKazutaka YOKOTA 		if (action > UCHAR_MAX)
627617b9080SKazutaka YOKOTA 			return ERRKEY;
628617b9080SKazutaka YOKOTA 		return action;
629617b9080SKazutaka YOKOTA 	}
630617b9080SKazutaka YOKOTA 
631617b9080SKazutaka YOKOTA 	/* see if there is something in the keyboard port */
632617b9080SKazutaka YOKOTA 	if (wait) {
633617b9080SKazutaka YOKOTA 		do {
634617b9080SKazutaka YOKOTA 			scancode = read_kbd_data(state->kbdc);
635617b9080SKazutaka YOKOTA 		} while (scancode == -1);
636617b9080SKazutaka YOKOTA 	} else {
637617b9080SKazutaka YOKOTA 		scancode = read_kbd_data_no_wait(state->kbdc);
638617b9080SKazutaka YOKOTA 		if (scancode == -1)
639617b9080SKazutaka YOKOTA 			return NOKEY;
640617b9080SKazutaka YOKOTA 	}
641617b9080SKazutaka YOKOTA 
642617b9080SKazutaka YOKOTA 	/* return the byte as is for the K_RAW mode */
643617b9080SKazutaka YOKOTA 	if (state->ks_mode == K_RAW)
644617b9080SKazutaka YOKOTA 		return scancode;
645617b9080SKazutaka YOKOTA 
646617b9080SKazutaka YOKOTA 	/* translate the scan code into a keycode */
647617b9080SKazutaka YOKOTA 	keycode = scancode & 0x7F;
648617b9080SKazutaka YOKOTA 	switch (state->ks_prefix) {
649617b9080SKazutaka YOKOTA 	case 0x00:	/* normal scancode */
650617b9080SKazutaka YOKOTA 		switch(scancode) {
651617b9080SKazutaka YOKOTA 		case 0xB8:	/* left alt (compose key) released */
652617b9080SKazutaka YOKOTA 			if (state->ks_flags & COMPOSE) {
653617b9080SKazutaka YOKOTA 				state->ks_flags &= ~COMPOSE;
654617b9080SKazutaka YOKOTA 				if (state->ks_composed_char > UCHAR_MAX)
655617b9080SKazutaka YOKOTA 					state->ks_composed_char = 0;
656617b9080SKazutaka YOKOTA 			}
657617b9080SKazutaka YOKOTA 			break;
658617b9080SKazutaka YOKOTA 		case 0x38:	/* left alt (compose key) pressed */
659617b9080SKazutaka YOKOTA 			if (!(state->ks_flags & COMPOSE)) {
660617b9080SKazutaka YOKOTA 				state->ks_flags |= COMPOSE;
661617b9080SKazutaka YOKOTA 				state->ks_composed_char = 0;
662617b9080SKazutaka YOKOTA 			}
663617b9080SKazutaka YOKOTA 			break;
664617b9080SKazutaka YOKOTA 		case 0xE0:
665617b9080SKazutaka YOKOTA 		case 0xE1:
666617b9080SKazutaka YOKOTA 			state->ks_prefix = scancode;
667617b9080SKazutaka YOKOTA 			goto next_code;
668617b9080SKazutaka YOKOTA 		}
669617b9080SKazutaka YOKOTA 		break;
670617b9080SKazutaka YOKOTA 	case 0xE0:      /* 0xE0 prefix */
671617b9080SKazutaka YOKOTA 		state->ks_prefix = 0;
672617b9080SKazutaka YOKOTA 		switch (keycode) {
673617b9080SKazutaka YOKOTA 		case 0x1C:	/* right enter key */
674617b9080SKazutaka YOKOTA 			keycode = 0x59;
675617b9080SKazutaka YOKOTA 			break;
676617b9080SKazutaka YOKOTA 		case 0x1D:	/* right ctrl key */
677617b9080SKazutaka YOKOTA 			keycode = 0x5A;
678617b9080SKazutaka YOKOTA 			break;
679617b9080SKazutaka YOKOTA 		case 0x35:	/* keypad divide key */
680617b9080SKazutaka YOKOTA 	    		keycode = 0x5B;
681617b9080SKazutaka YOKOTA 	    		break;
682617b9080SKazutaka YOKOTA 		case 0x37:	/* print scrn key */
683617b9080SKazutaka YOKOTA 	    		keycode = 0x5C;
684617b9080SKazutaka YOKOTA 	    		break;
685617b9080SKazutaka YOKOTA 		case 0x38:	/* right alt key (alt gr) */
686617b9080SKazutaka YOKOTA 	    		keycode = 0x5D;
687617b9080SKazutaka YOKOTA 	    		break;
688ffba82a9SKazutaka YOKOTA 		case 0x46:	/* ctrl-pause/break on AT 101 (see below) */
689ffba82a9SKazutaka YOKOTA 			keycode = 0x68;
690ffba82a9SKazutaka YOKOTA 	    		break;
691617b9080SKazutaka YOKOTA 		case 0x47:	/* grey home key */
692617b9080SKazutaka YOKOTA 	    		keycode = 0x5E;
693617b9080SKazutaka YOKOTA 	    		break;
694617b9080SKazutaka YOKOTA 		case 0x48:	/* grey up arrow key */
695617b9080SKazutaka YOKOTA 	    		keycode = 0x5F;
696617b9080SKazutaka YOKOTA 	    		break;
697617b9080SKazutaka YOKOTA 		case 0x49:	/* grey page up key */
698617b9080SKazutaka YOKOTA 	    		keycode = 0x60;
699617b9080SKazutaka YOKOTA 	    		break;
700617b9080SKazutaka YOKOTA 		case 0x4B:	/* grey left arrow key */
701617b9080SKazutaka YOKOTA 	    		keycode = 0x61;
702617b9080SKazutaka YOKOTA 	    		break;
703617b9080SKazutaka YOKOTA 		case 0x4D:	/* grey right arrow key */
704617b9080SKazutaka YOKOTA 	    		keycode = 0x62;
705617b9080SKazutaka YOKOTA 	    		break;
706617b9080SKazutaka YOKOTA 		case 0x4F:	/* grey end key */
707617b9080SKazutaka YOKOTA 	    		keycode = 0x63;
708617b9080SKazutaka YOKOTA 	    		break;
709617b9080SKazutaka YOKOTA 		case 0x50:	/* grey down arrow key */
710617b9080SKazutaka YOKOTA 	    		keycode = 0x64;
711617b9080SKazutaka YOKOTA 	    		break;
712617b9080SKazutaka YOKOTA 		case 0x51:	/* grey page down key */
713617b9080SKazutaka YOKOTA 	    		keycode = 0x65;
714617b9080SKazutaka YOKOTA 	    		break;
715617b9080SKazutaka YOKOTA 		case 0x52:	/* grey insert key */
716617b9080SKazutaka YOKOTA 	    		keycode = 0x66;
717617b9080SKazutaka YOKOTA 	    		break;
718617b9080SKazutaka YOKOTA 		case 0x53:	/* grey delete key */
719617b9080SKazutaka YOKOTA 	    		keycode = 0x67;
720617b9080SKazutaka YOKOTA 	    		break;
721617b9080SKazutaka YOKOTA 		/* the following 3 are only used on the MS "Natural" keyboard */
722617b9080SKazutaka YOKOTA 		case 0x5b:	/* left Window key */
723617b9080SKazutaka YOKOTA 	    		keycode = 0x69;
724617b9080SKazutaka YOKOTA 	    		break;
725617b9080SKazutaka YOKOTA 		case 0x5c:	/* right Window key */
726617b9080SKazutaka YOKOTA 	    		keycode = 0x6a;
727617b9080SKazutaka YOKOTA 	    		break;
728617b9080SKazutaka YOKOTA 		case 0x5d:	/* menu key */
729617b9080SKazutaka YOKOTA 	    		keycode = 0x6b;
730617b9080SKazutaka YOKOTA 	    		break;
731617b9080SKazutaka YOKOTA 		default:	/* ignore everything else */
732617b9080SKazutaka YOKOTA 	    		goto next_code;
733617b9080SKazutaka YOKOTA 		}
734617b9080SKazutaka YOKOTA 		break;
735617b9080SKazutaka YOKOTA     	case 0xE1:	/* 0xE1 prefix */
736ffba82a9SKazutaka YOKOTA 		/*
737ffba82a9SKazutaka YOKOTA 		 * The pause/break key on the 101 keyboard produces:
738ffba82a9SKazutaka YOKOTA 		 * E1-1D-45 E1-9D-C5
739ffba82a9SKazutaka YOKOTA 		 * Ctrl-pause/break produces:
740ffba82a9SKazutaka YOKOTA 		 * E0-46 E0-C6 (See above.)
741ffba82a9SKazutaka YOKOTA 		 */
742617b9080SKazutaka YOKOTA 		state->ks_prefix = 0;
743617b9080SKazutaka YOKOTA 		if (keycode == 0x1D)
744617b9080SKazutaka YOKOTA 	    		state->ks_prefix = 0x1D;
745617b9080SKazutaka YOKOTA 		goto next_code;
746617b9080SKazutaka YOKOTA 		/* NOT REACHED */
747617b9080SKazutaka YOKOTA     	case 0x1D:	/* pause / break */
748617b9080SKazutaka YOKOTA 		state->ks_prefix = 0;
749617b9080SKazutaka YOKOTA 		if (keycode != 0x45)
750617b9080SKazutaka YOKOTA 			goto next_code;
751617b9080SKazutaka YOKOTA 		keycode = 0x68;
752617b9080SKazutaka YOKOTA 		break;
753617b9080SKazutaka YOKOTA 	}
754617b9080SKazutaka YOKOTA 
755ffba82a9SKazutaka YOKOTA 	if (kbd->kb_type == KB_84) {
756ffba82a9SKazutaka YOKOTA 		switch (keycode) {
757ffba82a9SKazutaka YOKOTA 		case 0x37:	/* *(numpad)/print screen */
758ffba82a9SKazutaka YOKOTA 			if (state->ks_flags & SHIFTS)
759ffba82a9SKazutaka YOKOTA 	    			keycode = 0x5c;	/* print screen */
760ffba82a9SKazutaka YOKOTA 			break;
761ffba82a9SKazutaka YOKOTA 		case 0x45:	/* num lock/pause */
762ffba82a9SKazutaka YOKOTA 			if (state->ks_flags & CTLS)
763ffba82a9SKazutaka YOKOTA 				keycode = 0x68;	/* pause */
764ffba82a9SKazutaka YOKOTA 			break;
765ffba82a9SKazutaka YOKOTA 		case 0x46:	/* scroll lock/break */
766ffba82a9SKazutaka YOKOTA 			if (state->ks_flags & CTLS)
767ffba82a9SKazutaka YOKOTA 				keycode = 0x6c;	/* break */
768ffba82a9SKazutaka YOKOTA 			break;
769ffba82a9SKazutaka YOKOTA 		}
770ffba82a9SKazutaka YOKOTA 	} else if (kbd->kb_type == KB_101) {
771ffba82a9SKazutaka YOKOTA 		switch (keycode) {
772ffba82a9SKazutaka YOKOTA 		case 0x5c:	/* print screen */
773ffba82a9SKazutaka YOKOTA 			if (state->ks_flags & ALTS)
774ffba82a9SKazutaka YOKOTA 				keycode = 0x54;	/* sysrq */
775ffba82a9SKazutaka YOKOTA 			break;
776ffba82a9SKazutaka YOKOTA 		case 0x68:	/* pause/break */
777ffba82a9SKazutaka YOKOTA 			if (state->ks_flags & CTLS)
778ffba82a9SKazutaka YOKOTA 				keycode = 0x6c;	/* break */
779ffba82a9SKazutaka YOKOTA 			break;
780ffba82a9SKazutaka YOKOTA 		}
781ffba82a9SKazutaka YOKOTA 	}
782ffba82a9SKazutaka YOKOTA 
783617b9080SKazutaka YOKOTA 	/* return the key code in the K_CODE mode */
784617b9080SKazutaka YOKOTA 	if (state->ks_mode == K_CODE)
785617b9080SKazutaka YOKOTA 		return (keycode | (scancode & 0x80));
786617b9080SKazutaka YOKOTA 
787617b9080SKazutaka YOKOTA 	/* compose a character code */
788617b9080SKazutaka YOKOTA 	if (state->ks_flags & COMPOSE) {
78983fc7c6cSKazutaka YOKOTA 		switch (keycode | (scancode & 0x80)) {
790617b9080SKazutaka YOKOTA 		/* key pressed, process it */
791617b9080SKazutaka YOKOTA 		case 0x47: case 0x48: case 0x49:	/* keypad 7,8,9 */
792617b9080SKazutaka YOKOTA 			state->ks_composed_char *= 10;
793194da42dSKazutaka YOKOTA 			state->ks_composed_char += keycode - 0x40;
794617b9080SKazutaka YOKOTA 			if (state->ks_composed_char > UCHAR_MAX)
795617b9080SKazutaka YOKOTA 				return ERRKEY;
796617b9080SKazutaka YOKOTA 			goto next_code;
797617b9080SKazutaka YOKOTA 		case 0x4B: case 0x4C: case 0x4D:	/* keypad 4,5,6 */
798617b9080SKazutaka YOKOTA 			state->ks_composed_char *= 10;
799194da42dSKazutaka YOKOTA 			state->ks_composed_char += keycode - 0x47;
800617b9080SKazutaka YOKOTA 			if (state->ks_composed_char > UCHAR_MAX)
801617b9080SKazutaka YOKOTA 				return ERRKEY;
802617b9080SKazutaka YOKOTA 			goto next_code;
803617b9080SKazutaka YOKOTA 		case 0x4F: case 0x50: case 0x51:	/* keypad 1,2,3 */
804617b9080SKazutaka YOKOTA 			state->ks_composed_char *= 10;
805194da42dSKazutaka YOKOTA 			state->ks_composed_char += keycode - 0x4E;
806617b9080SKazutaka YOKOTA 			if (state->ks_composed_char > UCHAR_MAX)
807617b9080SKazutaka YOKOTA 				return ERRKEY;
808617b9080SKazutaka YOKOTA 			goto next_code;
809617b9080SKazutaka YOKOTA 		case 0x52:				/* keypad 0 */
810617b9080SKazutaka YOKOTA 			state->ks_composed_char *= 10;
811617b9080SKazutaka YOKOTA 			if (state->ks_composed_char > UCHAR_MAX)
812617b9080SKazutaka YOKOTA 				return ERRKEY;
813617b9080SKazutaka YOKOTA 			goto next_code;
814617b9080SKazutaka YOKOTA 
815617b9080SKazutaka YOKOTA 		/* key released, no interest here */
816617b9080SKazutaka YOKOTA 		case 0xC7: case 0xC8: case 0xC9:	/* keypad 7,8,9 */
817617b9080SKazutaka YOKOTA 		case 0xCB: case 0xCC: case 0xCD:	/* keypad 4,5,6 */
818617b9080SKazutaka YOKOTA 		case 0xCF: case 0xD0: case 0xD1:	/* keypad 1,2,3 */
819617b9080SKazutaka YOKOTA 		case 0xD2:				/* keypad 0 */
820617b9080SKazutaka YOKOTA 			goto next_code;
821617b9080SKazutaka YOKOTA 
822617b9080SKazutaka YOKOTA 		case 0x38:				/* left alt key */
823617b9080SKazutaka YOKOTA 			break;
824617b9080SKazutaka YOKOTA 
825617b9080SKazutaka YOKOTA 		default:
826617b9080SKazutaka YOKOTA 			if (state->ks_composed_char > 0) {
827617b9080SKazutaka YOKOTA 				state->ks_flags &= ~COMPOSE;
828617b9080SKazutaka YOKOTA 				state->ks_composed_char = 0;
829617b9080SKazutaka YOKOTA 				return ERRKEY;
830617b9080SKazutaka YOKOTA 			}
831617b9080SKazutaka YOKOTA 			break;
832617b9080SKazutaka YOKOTA 		}
833617b9080SKazutaka YOKOTA 	}
834617b9080SKazutaka YOKOTA 
835617b9080SKazutaka YOKOTA 	/* keycode to key action */
836617b9080SKazutaka YOKOTA 	action = genkbd_keyaction(kbd, keycode, scancode & 0x80,
837617b9080SKazutaka YOKOTA 				  &state->ks_state, &state->ks_accents);
838617b9080SKazutaka YOKOTA 	if (action == NOKEY)
839617b9080SKazutaka YOKOTA 		goto next_code;
840617b9080SKazutaka YOKOTA 	else
841617b9080SKazutaka YOKOTA 		return action;
842617b9080SKazutaka YOKOTA }
843617b9080SKazutaka YOKOTA 
844617b9080SKazutaka YOKOTA /* check if char is waiting */
845617b9080SKazutaka YOKOTA static int
846617b9080SKazutaka YOKOTA atkbd_check_char(keyboard_t *kbd)
847617b9080SKazutaka YOKOTA {
848617b9080SKazutaka YOKOTA 	atkbd_state_t *state;
849617b9080SKazutaka YOKOTA 
850617b9080SKazutaka YOKOTA 	if (!KBD_IS_ACTIVE(kbd))
851617b9080SKazutaka YOKOTA 		return FALSE;
852617b9080SKazutaka YOKOTA 	state = (atkbd_state_t *)kbd->kb_data;
853617b9080SKazutaka YOKOTA 	if (!(state->ks_flags & COMPOSE) && (state->ks_composed_char > 0))
854617b9080SKazutaka YOKOTA 		return TRUE;
855617b9080SKazutaka YOKOTA 	return kbdc_data_ready(state->kbdc);
856617b9080SKazutaka YOKOTA }
857617b9080SKazutaka YOKOTA 
858617b9080SKazutaka YOKOTA /* some useful control functions */
859617b9080SKazutaka YOKOTA static int
860617b9080SKazutaka YOKOTA atkbd_ioctl(keyboard_t *kbd, u_long cmd, caddr_t arg)
861617b9080SKazutaka YOKOTA {
862617b9080SKazutaka YOKOTA 	/* trasnlate LED_XXX bits into the device specific bits */
863617b9080SKazutaka YOKOTA 	static u_char ledmap[8] = {
864617b9080SKazutaka YOKOTA 		0, 4, 2, 6, 1, 5, 3, 7,
865617b9080SKazutaka YOKOTA 	};
866617b9080SKazutaka YOKOTA 	atkbd_state_t *state = kbd->kb_data;
867617b9080SKazutaka YOKOTA 	int error;
868617b9080SKazutaka YOKOTA 	int s;
869617b9080SKazutaka YOKOTA 	int i;
870617b9080SKazutaka YOKOTA 
871617b9080SKazutaka YOKOTA 	s = spltty();
872617b9080SKazutaka YOKOTA 	switch (cmd) {
873617b9080SKazutaka YOKOTA 
874617b9080SKazutaka YOKOTA 	case KDGKBMODE:		/* get keyboard mode */
875617b9080SKazutaka YOKOTA 		*(int *)arg = state->ks_mode;
876617b9080SKazutaka YOKOTA 		break;
877617b9080SKazutaka YOKOTA 	case KDSKBMODE:		/* set keyboard mode */
878617b9080SKazutaka YOKOTA 		switch (*(int *)arg) {
879617b9080SKazutaka YOKOTA 		case K_XLATE:
880617b9080SKazutaka YOKOTA 			if (state->ks_mode != K_XLATE) {
881617b9080SKazutaka YOKOTA 				/* make lock key state and LED state match */
882617b9080SKazutaka YOKOTA 				state->ks_state &= ~LOCK_MASK;
883617b9080SKazutaka YOKOTA 				state->ks_state |= KBD_LED_VAL(kbd);
884617b9080SKazutaka YOKOTA 			}
885617b9080SKazutaka YOKOTA 			/* FALL THROUGH */
886617b9080SKazutaka YOKOTA 		case K_RAW:
887617b9080SKazutaka YOKOTA 		case K_CODE:
888617b9080SKazutaka YOKOTA 			if (state->ks_mode != *(int *)arg) {
889617b9080SKazutaka YOKOTA 				atkbd_clear_state(kbd);
890617b9080SKazutaka YOKOTA 				state->ks_mode = *(int *)arg;
891617b9080SKazutaka YOKOTA 			}
892617b9080SKazutaka YOKOTA 			break;
893617b9080SKazutaka YOKOTA 		default:
894617b9080SKazutaka YOKOTA 			splx(s);
895617b9080SKazutaka YOKOTA 			return EINVAL;
896617b9080SKazutaka YOKOTA 		}
897617b9080SKazutaka YOKOTA 		break;
898617b9080SKazutaka YOKOTA 
899617b9080SKazutaka YOKOTA 	case KDGETLED:		/* get keyboard LED */
900617b9080SKazutaka YOKOTA 		*(int *)arg = KBD_LED_VAL(kbd);
901617b9080SKazutaka YOKOTA 		break;
902617b9080SKazutaka YOKOTA 	case KDSETLED:		/* set keyboard LED */
903617b9080SKazutaka YOKOTA 		/* NOTE: lock key state in ks_state won't be changed */
904617b9080SKazutaka YOKOTA 		if (*(int *)arg & ~LOCK_MASK) {
905617b9080SKazutaka YOKOTA 			splx(s);
906617b9080SKazutaka YOKOTA 			return EINVAL;
907617b9080SKazutaka YOKOTA 		}
908617b9080SKazutaka YOKOTA 		i = *(int *)arg;
909617b9080SKazutaka YOKOTA 		/* replace CAPS LED with ALTGR LED for ALTGR keyboards */
910617b9080SKazutaka YOKOTA 		if (kbd->kb_keymap->n_keys > ALTGR_OFFSET) {
911617b9080SKazutaka YOKOTA 			if (i & ALKED)
912617b9080SKazutaka YOKOTA 				i |= CLKED;
913617b9080SKazutaka YOKOTA 			else
914617b9080SKazutaka YOKOTA 				i &= ~CLKED;
915617b9080SKazutaka YOKOTA 		}
916617b9080SKazutaka YOKOTA 		if (KBD_HAS_DEVICE(kbd)) {
917617b9080SKazutaka YOKOTA 			error = write_kbd(state->kbdc, KBDC_SET_LEDS,
918617b9080SKazutaka YOKOTA 					  ledmap[i & LED_MASK]);
919617b9080SKazutaka YOKOTA 			if (error) {
920617b9080SKazutaka YOKOTA 				splx(s);
921617b9080SKazutaka YOKOTA 				return error;
922617b9080SKazutaka YOKOTA 			}
923617b9080SKazutaka YOKOTA 		}
924617b9080SKazutaka YOKOTA 		KBD_LED_VAL(kbd) = *(int *)arg;
925617b9080SKazutaka YOKOTA 		break;
926617b9080SKazutaka YOKOTA 
927617b9080SKazutaka YOKOTA 	case KDGKBSTATE:	/* get lock key state */
928617b9080SKazutaka YOKOTA 		*(int *)arg = state->ks_state & LOCK_MASK;
929617b9080SKazutaka YOKOTA 		break;
930617b9080SKazutaka YOKOTA 	case KDSKBSTATE:	/* set lock key state */
931617b9080SKazutaka YOKOTA 		if (*(int *)arg & ~LOCK_MASK) {
932617b9080SKazutaka YOKOTA 			splx(s);
933617b9080SKazutaka YOKOTA 			return EINVAL;
934617b9080SKazutaka YOKOTA 		}
935617b9080SKazutaka YOKOTA 		state->ks_state &= ~LOCK_MASK;
936617b9080SKazutaka YOKOTA 		state->ks_state |= *(int *)arg;
937617b9080SKazutaka YOKOTA 		splx(s);
938617b9080SKazutaka YOKOTA 		/* set LEDs and quit */
939617b9080SKazutaka YOKOTA 		return atkbd_ioctl(kbd, KDSETLED, arg);
940617b9080SKazutaka YOKOTA 
941e9deda23SKazutaka YOKOTA 	case KDSETREPEAT:	/* set keyboard repeat rate (new interface) */
942617b9080SKazutaka YOKOTA 		splx(s);
943617b9080SKazutaka YOKOTA 		if (!KBD_HAS_DEVICE(kbd))
944617b9080SKazutaka YOKOTA 			return 0;
945e9deda23SKazutaka YOKOTA 		i = typematic(((int *)arg)[0], ((int *)arg)[1]);
946e9deda23SKazutaka YOKOTA 		return write_kbd(state->kbdc, KBDC_SET_TYPEMATIC, i);
947e9deda23SKazutaka YOKOTA 
948e9deda23SKazutaka YOKOTA 	case KDSETRAD:		/* set keyboard repeat rate (old interface) */
949e9deda23SKazutaka YOKOTA 		splx(s);
950e9deda23SKazutaka YOKOTA 		if (!KBD_HAS_DEVICE(kbd))
951e9deda23SKazutaka YOKOTA 			return 0;
952e9deda23SKazutaka YOKOTA 		return write_kbd(state->kbdc, KBDC_SET_TYPEMATIC, *(int *)arg);
953617b9080SKazutaka YOKOTA 
954617b9080SKazutaka YOKOTA 	case PIO_KEYMAP:	/* set keyboard translation table */
955617b9080SKazutaka YOKOTA 	case PIO_KEYMAPENT:	/* set keyboard translation table entry */
956617b9080SKazutaka YOKOTA 	case PIO_DEADKEYMAP:	/* set accent key translation table */
957617b9080SKazutaka YOKOTA 		state->ks_accents = 0;
958617b9080SKazutaka YOKOTA 		/* FALL THROUGH */
959617b9080SKazutaka YOKOTA 	default:
960617b9080SKazutaka YOKOTA 		splx(s);
961617b9080SKazutaka YOKOTA 		return genkbd_commonioctl(kbd, cmd, arg);
962617b9080SKazutaka YOKOTA 	}
963617b9080SKazutaka YOKOTA 
964617b9080SKazutaka YOKOTA 	splx(s);
965617b9080SKazutaka YOKOTA 	return 0;
966617b9080SKazutaka YOKOTA }
967617b9080SKazutaka YOKOTA 
968617b9080SKazutaka YOKOTA /* lock the access to the keyboard */
969617b9080SKazutaka YOKOTA static int
970617b9080SKazutaka YOKOTA atkbd_lock(keyboard_t *kbd, int lock)
971617b9080SKazutaka YOKOTA {
972617b9080SKazutaka YOKOTA 	return kbdc_lock(((atkbd_state_t *)kbd->kb_data)->kbdc, lock);
973617b9080SKazutaka YOKOTA }
974617b9080SKazutaka YOKOTA 
975617b9080SKazutaka YOKOTA /* clear the internal state of the keyboard */
976617b9080SKazutaka YOKOTA static void
977617b9080SKazutaka YOKOTA atkbd_clear_state(keyboard_t *kbd)
978617b9080SKazutaka YOKOTA {
979617b9080SKazutaka YOKOTA 	atkbd_state_t *state;
980617b9080SKazutaka YOKOTA 
981617b9080SKazutaka YOKOTA 	state = (atkbd_state_t *)kbd->kb_data;
982617b9080SKazutaka YOKOTA 	state->ks_flags = 0;
983e9deda23SKazutaka YOKOTA 	state->ks_polling = 0;
984617b9080SKazutaka YOKOTA 	state->ks_state &= LOCK_MASK;	/* preserve locking key state */
985617b9080SKazutaka YOKOTA 	state->ks_accents = 0;
986617b9080SKazutaka YOKOTA 	state->ks_composed_char = 0;
987617b9080SKazutaka YOKOTA #if 0
988617b9080SKazutaka YOKOTA 	state->ks_prefix = 0; /* XXX */
989617b9080SKazutaka YOKOTA #endif
990617b9080SKazutaka YOKOTA }
991617b9080SKazutaka YOKOTA 
992617b9080SKazutaka YOKOTA /* save the internal state */
993617b9080SKazutaka YOKOTA static int
994617b9080SKazutaka YOKOTA atkbd_get_state(keyboard_t *kbd, void *buf, size_t len)
995617b9080SKazutaka YOKOTA {
996617b9080SKazutaka YOKOTA 	if (len == 0)
997617b9080SKazutaka YOKOTA 		return sizeof(atkbd_state_t);
998617b9080SKazutaka YOKOTA 	if (len < sizeof(atkbd_state_t))
999617b9080SKazutaka YOKOTA 		return -1;
1000617b9080SKazutaka YOKOTA 	bcopy(kbd->kb_data, buf, sizeof(atkbd_state_t));
1001617b9080SKazutaka YOKOTA 	return 0;
1002617b9080SKazutaka YOKOTA }
1003617b9080SKazutaka YOKOTA 
1004617b9080SKazutaka YOKOTA /* set the internal state */
1005617b9080SKazutaka YOKOTA static int
1006617b9080SKazutaka YOKOTA atkbd_set_state(keyboard_t *kbd, void *buf, size_t len)
1007617b9080SKazutaka YOKOTA {
1008617b9080SKazutaka YOKOTA 	if (len < sizeof(atkbd_state_t))
1009617b9080SKazutaka YOKOTA 		return ENOMEM;
1010617b9080SKazutaka YOKOTA 	if (((atkbd_state_t *)kbd->kb_data)->kbdc
1011617b9080SKazutaka YOKOTA 		!= ((atkbd_state_t *)buf)->kbdc)
1012617b9080SKazutaka YOKOTA 		return ENOMEM;
1013617b9080SKazutaka YOKOTA 	bcopy(buf, kbd->kb_data, sizeof(atkbd_state_t));
1014617b9080SKazutaka YOKOTA 	return 0;
1015617b9080SKazutaka YOKOTA }
1016617b9080SKazutaka YOKOTA 
1017e9deda23SKazutaka YOKOTA static int
1018e9deda23SKazutaka YOKOTA atkbd_poll(keyboard_t *kbd, int on)
1019e9deda23SKazutaka YOKOTA {
1020e9deda23SKazutaka YOKOTA 	atkbd_state_t *state;
1021e9deda23SKazutaka YOKOTA 	int s;
1022e9deda23SKazutaka YOKOTA 
1023e9deda23SKazutaka YOKOTA 	state = (atkbd_state_t *)kbd->kb_data;
1024e9deda23SKazutaka YOKOTA 	s = spltty();
1025e9deda23SKazutaka YOKOTA 	if (on)
1026e9deda23SKazutaka YOKOTA 		++state->ks_polling;
1027e9deda23SKazutaka YOKOTA 	else
1028e9deda23SKazutaka YOKOTA 		--state->ks_polling;
1029e9deda23SKazutaka YOKOTA 	splx(s);
1030e9deda23SKazutaka YOKOTA 	return 0;
1031e9deda23SKazutaka YOKOTA }
1032e9deda23SKazutaka YOKOTA 
1033617b9080SKazutaka YOKOTA /* local functions */
1034617b9080SKazutaka YOKOTA 
1035617b9080SKazutaka YOKOTA static int
1036617b9080SKazutaka YOKOTA setup_kbd_port(KBDC kbdc, int port, int intr)
1037617b9080SKazutaka YOKOTA {
1038617b9080SKazutaka YOKOTA 	if (!set_controller_command_byte(kbdc,
1039617b9080SKazutaka YOKOTA 		KBD_KBD_CONTROL_BITS,
1040617b9080SKazutaka YOKOTA 		((port) ? KBD_ENABLE_KBD_PORT : KBD_DISABLE_KBD_PORT)
1041617b9080SKazutaka YOKOTA 		    | ((intr) ? KBD_ENABLE_KBD_INT : KBD_DISABLE_KBD_INT)))
1042617b9080SKazutaka YOKOTA 		return 1;
1043617b9080SKazutaka YOKOTA 	return 0;
1044617b9080SKazutaka YOKOTA }
1045617b9080SKazutaka YOKOTA 
1046617b9080SKazutaka YOKOTA static int
1047617b9080SKazutaka YOKOTA get_kbd_echo(KBDC kbdc)
1048617b9080SKazutaka YOKOTA {
1049617b9080SKazutaka YOKOTA 	/* enable the keyboard port, but disable the keyboard intr. */
1050617b9080SKazutaka YOKOTA 	if (setup_kbd_port(kbdc, TRUE, FALSE))
1051617b9080SKazutaka YOKOTA 		/* CONTROLLER ERROR: there is very little we can do... */
1052617b9080SKazutaka YOKOTA 		return ENXIO;
1053617b9080SKazutaka YOKOTA 
1054617b9080SKazutaka YOKOTA 	/* see if something is present */
1055617b9080SKazutaka YOKOTA 	write_kbd_command(kbdc, KBDC_ECHO);
1056617b9080SKazutaka YOKOTA 	if (read_kbd_data(kbdc) != KBD_ECHO) {
1057617b9080SKazutaka YOKOTA 		empty_both_buffers(kbdc, 10);
1058617b9080SKazutaka YOKOTA 		test_controller(kbdc);
1059617b9080SKazutaka YOKOTA 		test_kbd_port(kbdc);
1060617b9080SKazutaka YOKOTA 		return ENXIO;
1061617b9080SKazutaka YOKOTA 	}
1062617b9080SKazutaka YOKOTA 
1063617b9080SKazutaka YOKOTA 	/* enable the keyboard port and intr. */
1064617b9080SKazutaka YOKOTA 	if (setup_kbd_port(kbdc, TRUE, TRUE)) {
1065617b9080SKazutaka YOKOTA 		/*
1066617b9080SKazutaka YOKOTA 		 * CONTROLLER ERROR
1067617b9080SKazutaka YOKOTA 		 * This is serious; the keyboard intr is left disabled!
1068617b9080SKazutaka YOKOTA 		 */
1069617b9080SKazutaka YOKOTA 		return ENXIO;
1070617b9080SKazutaka YOKOTA 	}
1071617b9080SKazutaka YOKOTA 
1072617b9080SKazutaka YOKOTA 	return 0;
1073617b9080SKazutaka YOKOTA }
1074617b9080SKazutaka YOKOTA 
1075617b9080SKazutaka YOKOTA static int
1076617b9080SKazutaka YOKOTA probe_keyboard(KBDC kbdc, int flags)
1077617b9080SKazutaka YOKOTA {
1078617b9080SKazutaka YOKOTA 	/*
1079617b9080SKazutaka YOKOTA 	 * Don't try to print anything in this function.  The low-level
1080617b9080SKazutaka YOKOTA 	 * console may not have been initialized yet...
1081617b9080SKazutaka YOKOTA 	 */
1082617b9080SKazutaka YOKOTA 	int err;
1083617b9080SKazutaka YOKOTA 	int c;
1084617b9080SKazutaka YOKOTA 	int m;
1085617b9080SKazutaka YOKOTA 
1086617b9080SKazutaka YOKOTA 	if (!kbdc_lock(kbdc, TRUE)) {
1087617b9080SKazutaka YOKOTA 		/* driver error? */
1088617b9080SKazutaka YOKOTA 		return ENXIO;
1089617b9080SKazutaka YOKOTA 	}
1090617b9080SKazutaka YOKOTA 
1091617b9080SKazutaka YOKOTA 	/* flush any noise in the buffer */
1092617b9080SKazutaka YOKOTA 	empty_both_buffers(kbdc, 10);
1093617b9080SKazutaka YOKOTA 
1094617b9080SKazutaka YOKOTA 	/* save the current keyboard controller command byte */
1095617b9080SKazutaka YOKOTA 	m = kbdc_get_device_mask(kbdc) & ~KBD_KBD_CONTROL_BITS;
1096617b9080SKazutaka YOKOTA 	c = get_controller_command_byte(kbdc);
1097617b9080SKazutaka YOKOTA 	if (c == -1) {
1098617b9080SKazutaka YOKOTA 		/* CONTROLLER ERROR */
1099617b9080SKazutaka YOKOTA 		kbdc_set_device_mask(kbdc, m);
1100617b9080SKazutaka YOKOTA 		kbdc_lock(kbdc, FALSE);
1101617b9080SKazutaka YOKOTA 		return ENXIO;
1102617b9080SKazutaka YOKOTA 	}
1103617b9080SKazutaka YOKOTA 
1104617b9080SKazutaka YOKOTA 	/*
1105617b9080SKazutaka YOKOTA 	 * The keyboard may have been screwed up by the boot block.
1106617b9080SKazutaka YOKOTA 	 * We may just be able to recover from error by testing the controller
1107617b9080SKazutaka YOKOTA 	 * and the keyboard port. The controller command byte needs to be
1108617b9080SKazutaka YOKOTA 	 * saved before this recovery operation, as some controllers seem
1109617b9080SKazutaka YOKOTA 	 * to set the command byte to particular values.
1110617b9080SKazutaka YOKOTA 	 */
1111617b9080SKazutaka YOKOTA 	test_controller(kbdc);
1112617b9080SKazutaka YOKOTA 	test_kbd_port(kbdc);
1113617b9080SKazutaka YOKOTA 
1114617b9080SKazutaka YOKOTA 	err = get_kbd_echo(kbdc);
1115617b9080SKazutaka YOKOTA 	if (err == 0) {
1116617b9080SKazutaka YOKOTA 		kbdc_set_device_mask(kbdc, m | KBD_KBD_CONTROL_BITS);
1117617b9080SKazutaka YOKOTA 	} else {
1118617b9080SKazutaka YOKOTA 		if (c != -1)
1119617b9080SKazutaka YOKOTA 			/* try to restore the command byte as before */
1120617b9080SKazutaka YOKOTA 			set_controller_command_byte(kbdc, 0xff, c);
1121617b9080SKazutaka YOKOTA 		kbdc_set_device_mask(kbdc, m);
1122617b9080SKazutaka YOKOTA 	}
1123617b9080SKazutaka YOKOTA 
1124617b9080SKazutaka YOKOTA 	kbdc_lock(kbdc, FALSE);
1125617b9080SKazutaka YOKOTA 	return err;
1126617b9080SKazutaka YOKOTA }
1127617b9080SKazutaka YOKOTA 
1128617b9080SKazutaka YOKOTA static int
1129617b9080SKazutaka YOKOTA init_keyboard(KBDC kbdc, int *type, int flags)
1130617b9080SKazutaka YOKOTA {
1131617b9080SKazutaka YOKOTA 	int codeset;
1132617b9080SKazutaka YOKOTA 	int id;
1133617b9080SKazutaka YOKOTA 	int c;
1134617b9080SKazutaka YOKOTA 
1135617b9080SKazutaka YOKOTA 	if (!kbdc_lock(kbdc, TRUE)) {
1136617b9080SKazutaka YOKOTA 		/* driver error? */
1137617b9080SKazutaka YOKOTA 		return EIO;
1138617b9080SKazutaka YOKOTA 	}
1139617b9080SKazutaka YOKOTA 
1140617b9080SKazutaka YOKOTA 	/* save the current controller command byte */
1141617b9080SKazutaka YOKOTA 	empty_both_buffers(kbdc, 10);
1142617b9080SKazutaka YOKOTA 	c = get_controller_command_byte(kbdc);
1143617b9080SKazutaka YOKOTA 	if (c == -1) {
1144617b9080SKazutaka YOKOTA 		/* CONTROLLER ERROR */
1145617b9080SKazutaka YOKOTA 		kbdc_lock(kbdc, FALSE);
1146617b9080SKazutaka YOKOTA 		printf("atkbd: unable to get the current command byte value.\n");
1147617b9080SKazutaka YOKOTA 		return EIO;
1148617b9080SKazutaka YOKOTA 	}
1149617b9080SKazutaka YOKOTA 	if (bootverbose)
1150617b9080SKazutaka YOKOTA 		printf("atkbd: the current kbd controller command byte %04x\n",
1151617b9080SKazutaka YOKOTA 		       c);
1152617b9080SKazutaka YOKOTA #if 0
1153617b9080SKazutaka YOKOTA 	/* override the keyboard lock switch */
1154617b9080SKazutaka YOKOTA 	c |= KBD_OVERRIDE_KBD_LOCK;
1155617b9080SKazutaka YOKOTA #endif
1156617b9080SKazutaka YOKOTA 
1157617b9080SKazutaka YOKOTA 	/* enable the keyboard port, but disable the keyboard intr. */
1158617b9080SKazutaka YOKOTA 	if (setup_kbd_port(kbdc, TRUE, FALSE)) {
1159617b9080SKazutaka YOKOTA 		/* CONTROLLER ERROR: there is very little we can do... */
1160617b9080SKazutaka YOKOTA 		printf("atkbd: unable to set the command byte.\n");
1161617b9080SKazutaka YOKOTA 		kbdc_lock(kbdc, FALSE);
1162617b9080SKazutaka YOKOTA 		return EIO;
1163617b9080SKazutaka YOKOTA 	}
1164617b9080SKazutaka YOKOTA 
1165617b9080SKazutaka YOKOTA 	/*
1166617b9080SKazutaka YOKOTA 	 * Check if we have an XT keyboard before we attempt to reset it.
1167617b9080SKazutaka YOKOTA 	 * The procedure assumes that the keyboard and the controller have
1168617b9080SKazutaka YOKOTA 	 * been set up properly by BIOS and have not been messed up
1169617b9080SKazutaka YOKOTA 	 * during the boot process.
1170617b9080SKazutaka YOKOTA 	 */
1171617b9080SKazutaka YOKOTA 	codeset = -1;
1172617b9080SKazutaka YOKOTA 	if (flags & KB_CONF_ALT_SCANCODESET)
1173617b9080SKazutaka YOKOTA 		/* the user says there is a XT keyboard */
1174617b9080SKazutaka YOKOTA 		codeset = 1;
1175617b9080SKazutaka YOKOTA #ifdef KBD_DETECT_XT_KEYBOARD
1176617b9080SKazutaka YOKOTA 	else if ((c & KBD_TRANSLATION) == 0) {
1177617b9080SKazutaka YOKOTA 		/* SET_SCANCODE_SET is not always supported; ignore error */
1178617b9080SKazutaka YOKOTA 		if (send_kbd_command_and_data(kbdc, KBDC_SET_SCANCODE_SET, 0)
1179617b9080SKazutaka YOKOTA 			== KBD_ACK)
1180617b9080SKazutaka YOKOTA 			codeset = read_kbd_data(kbdc);
1181617b9080SKazutaka YOKOTA 	}
1182617b9080SKazutaka YOKOTA 	if (bootverbose)
1183617b9080SKazutaka YOKOTA 		printf("atkbd: scancode set %d\n", codeset);
1184617b9080SKazutaka YOKOTA #endif /* KBD_DETECT_XT_KEYBOARD */
1185617b9080SKazutaka YOKOTA 
1186617b9080SKazutaka YOKOTA 	*type = KB_OTHER;
1187617b9080SKazutaka YOKOTA 	id = get_kbd_id(kbdc);
1188617b9080SKazutaka YOKOTA 	switch(id) {
1189617b9080SKazutaka YOKOTA 	case 0x41ab:
1190617b9080SKazutaka YOKOTA 	case 0x83ab:
1191617b9080SKazutaka YOKOTA 		*type = KB_101;
1192617b9080SKazutaka YOKOTA 		break;
1193617b9080SKazutaka YOKOTA 	case -1:	/* AT 84 keyboard doesn't return ID */
1194617b9080SKazutaka YOKOTA 		*type = KB_84;
1195617b9080SKazutaka YOKOTA 		break;
1196617b9080SKazutaka YOKOTA 	default:
1197617b9080SKazutaka YOKOTA 		break;
1198617b9080SKazutaka YOKOTA 	}
1199617b9080SKazutaka YOKOTA 	if (bootverbose)
1200617b9080SKazutaka YOKOTA 		printf("atkbd: keyboard ID 0x%x (%d)\n", id, *type);
1201617b9080SKazutaka YOKOTA 
1202617b9080SKazutaka YOKOTA 	/* reset keyboard hardware */
1203617b9080SKazutaka YOKOTA 	if (!(flags & KB_CONF_NO_RESET) && !reset_kbd(kbdc)) {
1204617b9080SKazutaka YOKOTA 		/*
1205617b9080SKazutaka YOKOTA 		 * KEYBOARD ERROR
1206617b9080SKazutaka YOKOTA 		 * Keyboard reset may fail either because the keyboard
1207617b9080SKazutaka YOKOTA 		 * doen't exist, or because the keyboard doesn't pass
1208617b9080SKazutaka YOKOTA 		 * the self-test, or the keyboard controller on the
1209617b9080SKazutaka YOKOTA 		 * motherboard and the keyboard somehow fail to shake hands.
1210617b9080SKazutaka YOKOTA 		 * It is just possible, particularly in the last case,
1211617b9080SKazutaka YOKOTA 		 * that the keyoard controller may be left in a hung state.
1212617b9080SKazutaka YOKOTA 		 * test_controller() and test_kbd_port() appear to bring
1213617b9080SKazutaka YOKOTA 		 * the keyboard controller back (I don't know why and how,
1214617b9080SKazutaka YOKOTA 		 * though.)
1215617b9080SKazutaka YOKOTA 		 */
1216617b9080SKazutaka YOKOTA 		empty_both_buffers(kbdc, 10);
1217617b9080SKazutaka YOKOTA 		test_controller(kbdc);
1218617b9080SKazutaka YOKOTA 		test_kbd_port(kbdc);
1219617b9080SKazutaka YOKOTA 		/*
1220617b9080SKazutaka YOKOTA 		 * We could disable the keyboard port and interrupt... but,
1221617b9080SKazutaka YOKOTA 		 * the keyboard may still exist (see above).
1222617b9080SKazutaka YOKOTA 		 */
1223617b9080SKazutaka YOKOTA 		set_controller_command_byte(kbdc, 0xff, c);
1224617b9080SKazutaka YOKOTA 		kbdc_lock(kbdc, FALSE);
1225617b9080SKazutaka YOKOTA 		if (bootverbose)
1226617b9080SKazutaka YOKOTA 			printf("atkbd: failed to reset the keyboard.\n");
1227617b9080SKazutaka YOKOTA 		return EIO;
1228617b9080SKazutaka YOKOTA 	}
1229617b9080SKazutaka YOKOTA 
1230617b9080SKazutaka YOKOTA 	/*
1231617b9080SKazutaka YOKOTA 	 * Allow us to set the XT_KEYBD flag in UserConfig so that keyboards
1232617b9080SKazutaka YOKOTA 	 * such as those on the IBM ThinkPad laptop computers can be used
1233617b9080SKazutaka YOKOTA 	 * with the standard console driver.
1234617b9080SKazutaka YOKOTA 	 */
1235617b9080SKazutaka YOKOTA 	if (codeset == 1) {
1236617b9080SKazutaka YOKOTA 		if (send_kbd_command_and_data(kbdc,
1237617b9080SKazutaka YOKOTA 			KBDC_SET_SCANCODE_SET, codeset) == KBD_ACK) {
1238617b9080SKazutaka YOKOTA 			/* XT kbd doesn't need scan code translation */
1239617b9080SKazutaka YOKOTA 			c &= ~KBD_TRANSLATION;
1240617b9080SKazutaka YOKOTA 		} else {
1241617b9080SKazutaka YOKOTA 			/*
1242617b9080SKazutaka YOKOTA 			 * KEYBOARD ERROR
1243617b9080SKazutaka YOKOTA 			 * The XT kbd isn't usable unless the proper scan
1244617b9080SKazutaka YOKOTA 			 * code set is selected.
1245617b9080SKazutaka YOKOTA 			 */
1246617b9080SKazutaka YOKOTA 			set_controller_command_byte(kbdc, 0xff, c);
1247617b9080SKazutaka YOKOTA 			kbdc_lock(kbdc, FALSE);
1248617b9080SKazutaka YOKOTA 			printf("atkbd: unable to set the XT keyboard mode.\n");
1249617b9080SKazutaka YOKOTA 			return EIO;
1250617b9080SKazutaka YOKOTA 		}
1251617b9080SKazutaka YOKOTA 	}
1252617b9080SKazutaka YOKOTA 
1253f359876fSKazutaka YOKOTA #ifdef __alpha__
1254f359876fSKazutaka YOKOTA 	if (send_kbd_command_and_data(
1255f359876fSKazutaka YOKOTA 		kbdc, KBDC_SET_SCANCODE_SET, 2) != KBD_ACK) {
1256f359876fSKazutaka YOKOTA 		printf("atkbd: can't set translation.\n");
1257f359876fSKazutaka YOKOTA 
1258f359876fSKazutaka YOKOTA 	}
1259f359876fSKazutaka YOKOTA 	c |= KBD_TRANSLATION;
1260f359876fSKazutaka YOKOTA #endif
1261f359876fSKazutaka YOKOTA 
1262617b9080SKazutaka YOKOTA 	/* enable the keyboard port and intr. */
1263617b9080SKazutaka YOKOTA 	if (!set_controller_command_byte(kbdc,
1264617b9080SKazutaka YOKOTA 		KBD_KBD_CONTROL_BITS | KBD_TRANSLATION | KBD_OVERRIDE_KBD_LOCK,
1265617b9080SKazutaka YOKOTA 		(c & (KBD_TRANSLATION | KBD_OVERRIDE_KBD_LOCK))
1266617b9080SKazutaka YOKOTA 		    | KBD_ENABLE_KBD_PORT | KBD_ENABLE_KBD_INT)) {
1267617b9080SKazutaka YOKOTA 		/*
1268617b9080SKazutaka YOKOTA 		 * CONTROLLER ERROR
1269617b9080SKazutaka YOKOTA 		 * This is serious; we are left with the disabled
1270617b9080SKazutaka YOKOTA 		 * keyboard intr.
1271617b9080SKazutaka YOKOTA 		 */
1272617b9080SKazutaka YOKOTA 		set_controller_command_byte(kbdc, 0xff, c);
1273617b9080SKazutaka YOKOTA 		kbdc_lock(kbdc, FALSE);
1274617b9080SKazutaka YOKOTA 		printf("atkbd: unable to enable the keyboard port and intr.\n");
1275617b9080SKazutaka YOKOTA 		return EIO;
1276617b9080SKazutaka YOKOTA 	}
1277617b9080SKazutaka YOKOTA 
1278617b9080SKazutaka YOKOTA 	kbdc_lock(kbdc, FALSE);
1279617b9080SKazutaka YOKOTA 	return 0;
1280617b9080SKazutaka YOKOTA }
1281617b9080SKazutaka YOKOTA 
1282617b9080SKazutaka YOKOTA static int
1283617b9080SKazutaka YOKOTA write_kbd(KBDC kbdc, int command, int data)
1284617b9080SKazutaka YOKOTA {
1285617b9080SKazutaka YOKOTA     int s;
1286617b9080SKazutaka YOKOTA 
1287617b9080SKazutaka YOKOTA     /* prevent the timeout routine from polling the keyboard */
1288617b9080SKazutaka YOKOTA     if (!kbdc_lock(kbdc, TRUE))
1289617b9080SKazutaka YOKOTA 	return EBUSY;
1290617b9080SKazutaka YOKOTA 
1291617b9080SKazutaka YOKOTA     /* disable the keyboard and mouse interrupt */
1292617b9080SKazutaka YOKOTA     s = spltty();
1293617b9080SKazutaka YOKOTA #if 0
1294617b9080SKazutaka YOKOTA     c = get_controller_command_byte(kbdc);
1295617b9080SKazutaka YOKOTA     if ((c == -1)
1296617b9080SKazutaka YOKOTA 	|| !set_controller_command_byte(kbdc,
1297617b9080SKazutaka YOKOTA             kbdc_get_device_mask(kbdc),
1298617b9080SKazutaka YOKOTA             KBD_DISABLE_KBD_PORT | KBD_DISABLE_KBD_INT
1299617b9080SKazutaka YOKOTA                 | KBD_DISABLE_AUX_PORT | KBD_DISABLE_AUX_INT)) {
1300617b9080SKazutaka YOKOTA 	/* CONTROLLER ERROR */
1301617b9080SKazutaka YOKOTA         kbdc_lock(kbdc, FALSE);
1302617b9080SKazutaka YOKOTA 	splx(s);
1303617b9080SKazutaka YOKOTA 	return EIO;
1304617b9080SKazutaka YOKOTA     }
1305617b9080SKazutaka YOKOTA     /*
1306617b9080SKazutaka YOKOTA      * Now that the keyboard controller is told not to generate
1307617b9080SKazutaka YOKOTA      * the keyboard and mouse interrupts, call `splx()' to allow
1308617b9080SKazutaka YOKOTA      * the other tty interrupts. The clock interrupt may also occur,
1309617b9080SKazutaka YOKOTA      * but the timeout routine (`scrn_timer()') will be blocked
1310617b9080SKazutaka YOKOTA      * by the lock flag set via `kbdc_lock()'
1311617b9080SKazutaka YOKOTA      */
1312617b9080SKazutaka YOKOTA     splx(s);
1313617b9080SKazutaka YOKOTA #endif
1314617b9080SKazutaka YOKOTA 
1315617b9080SKazutaka YOKOTA     if (send_kbd_command_and_data(kbdc, command, data) != KBD_ACK)
1316617b9080SKazutaka YOKOTA         send_kbd_command(kbdc, KBDC_ENABLE_KBD);
1317617b9080SKazutaka YOKOTA 
1318617b9080SKazutaka YOKOTA #if 0
1319617b9080SKazutaka YOKOTA     /* restore the interrupts */
1320617b9080SKazutaka YOKOTA     if (!set_controller_command_byte(kbdc,
1321617b9080SKazutaka YOKOTA             kbdc_get_device_mask(kbdc),
1322617b9080SKazutaka YOKOTA 	    c & (KBD_KBD_CONTROL_BITS | KBD_AUX_CONTROL_BITS))) {
1323617b9080SKazutaka YOKOTA 	/* CONTROLLER ERROR */
1324617b9080SKazutaka YOKOTA     }
1325617b9080SKazutaka YOKOTA #else
1326617b9080SKazutaka YOKOTA     splx(s);
1327617b9080SKazutaka YOKOTA #endif
1328617b9080SKazutaka YOKOTA     kbdc_lock(kbdc, FALSE);
1329617b9080SKazutaka YOKOTA 
1330617b9080SKazutaka YOKOTA     return 0;
1331617b9080SKazutaka YOKOTA }
1332617b9080SKazutaka YOKOTA 
1333617b9080SKazutaka YOKOTA static int
1334617b9080SKazutaka YOKOTA get_kbd_id(KBDC kbdc)
1335617b9080SKazutaka YOKOTA {
1336617b9080SKazutaka YOKOTA 	int id1, id2;
1337617b9080SKazutaka YOKOTA 
1338617b9080SKazutaka YOKOTA 	empty_both_buffers(kbdc, 10);
1339617b9080SKazutaka YOKOTA 	id1 = id2 = -1;
1340617b9080SKazutaka YOKOTA 	if (send_kbd_command(kbdc, KBDC_SEND_DEV_ID) != KBD_ACK)
1341617b9080SKazutaka YOKOTA 		return -1;
1342617b9080SKazutaka YOKOTA 
1343617b9080SKazutaka YOKOTA 	DELAY(10000); 	/* 10 msec delay */
1344617b9080SKazutaka YOKOTA 	id1 = read_kbd_data(kbdc);
1345617b9080SKazutaka YOKOTA 	if (id1 != -1)
1346617b9080SKazutaka YOKOTA 		id2 = read_kbd_data(kbdc);
1347617b9080SKazutaka YOKOTA 
1348617b9080SKazutaka YOKOTA 	if ((id1 == -1) || (id2 == -1)) {
1349617b9080SKazutaka YOKOTA 		empty_both_buffers(kbdc, 10);
1350617b9080SKazutaka YOKOTA 		test_controller(kbdc);
1351617b9080SKazutaka YOKOTA 		test_kbd_port(kbdc);
1352617b9080SKazutaka YOKOTA 		return -1;
1353617b9080SKazutaka YOKOTA 	}
1354617b9080SKazutaka YOKOTA 	return ((id2 << 8) | id1);
1355617b9080SKazutaka YOKOTA }
1356617b9080SKazutaka YOKOTA 
1357e9deda23SKazutaka YOKOTA static int
1358e9deda23SKazutaka YOKOTA typematic(int delay, int rate)
1359e9deda23SKazutaka YOKOTA {
1360e9deda23SKazutaka YOKOTA 	static int delays[] = { 250, 500, 750, 1000 };
1361e9deda23SKazutaka YOKOTA 	static int rates[] = {  34,  38,  42,  46,  50,  55,  59,  63,
1362e9deda23SKazutaka YOKOTA 				68,  76,  84,  92, 100, 110, 118, 126,
1363e9deda23SKazutaka YOKOTA 			       136, 152, 168, 184, 200, 220, 236, 252,
1364e9deda23SKazutaka YOKOTA 			       272, 304, 336, 368, 400, 440, 472, 504 };
1365e9deda23SKazutaka YOKOTA 	int value;
1366e9deda23SKazutaka YOKOTA 	int i;
1367e9deda23SKazutaka YOKOTA 
1368e9deda23SKazutaka YOKOTA 	for (i = sizeof(delays)/sizeof(delays[0]) - 1; i > 0; --i) {
1369e9deda23SKazutaka YOKOTA 		if (delay >= delays[i])
1370e9deda23SKazutaka YOKOTA 			break;
1371e9deda23SKazutaka YOKOTA 	}
1372e9deda23SKazutaka YOKOTA 	value = i << 5;
1373e9deda23SKazutaka YOKOTA 	for (i = sizeof(rates)/sizeof(rates[0]) - 1; i > 0; --i) {
1374e9deda23SKazutaka YOKOTA 		if (rate >= rates[i])
1375e9deda23SKazutaka YOKOTA 			break;
1376e9deda23SKazutaka YOKOTA 	}
1377e9deda23SKazutaka YOKOTA 	value |= i;
1378e9deda23SKazutaka YOKOTA 	return value;
1379e9deda23SKazutaka YOKOTA }
1380e9deda23SKazutaka YOKOTA 
1381617b9080SKazutaka YOKOTA #endif /* NATKBD > 0 */
1382