xref: /titanic_52/usr/src/uts/common/io/kb8042/kb8042.c (revision ea8dc4b6d2251b437950c0056bc626b311c73c27)
1 /*
2  * CDDL HEADER START
3  *
4  * The contents of this file are subject to the terms of the
5  * Common Development and Distribution License, Version 1.0 only
6  * (the "License").  You may not use this file except in compliance
7  * with the License.
8  *
9  * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
10  * or http://www.opensolaris.org/os/licensing.
11  * See the License for the specific language governing permissions
12  * and limitations under the License.
13  *
14  * When distributing Covered Code, include this CDDL HEADER in each
15  * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
16  * If applicable, add the following below this CDDL HEADER, with the
17  * fields enclosed by brackets "[]" replaced with your own identifying
18  * information: Portions Copyright [yyyy] [name of copyright owner]
19  *
20  * CDDL HEADER END
21  */
22 /*	Copyright (c) 1990, 1991 UNIX System Laboratories, Inc.	*/
23 /*	Copyright (c) 1984, 1986, 1987, 1988, 1989, 1990 AT&T	*/
24 /*	  All Rights Reserved  	*/
25 
26 /*
27  * Copyright 2005 Sun Microsystems, Inc.  All rights reserved.
28  * Use is subject to license terms.
29  */
30 
31 #pragma ident	"%Z%%M%	%I%	%E% SMI"
32 
33 #include <sys/types.h>
34 #include <sys/errno.h>
35 #include <sys/inline.h>
36 #include <sys/termio.h>
37 #include <sys/stropts.h>
38 #include <sys/termios.h>
39 #include <sys/stream.h>
40 #include <sys/strtty.h>
41 #include <sys/strsubr.h>
42 #include <sys/strsun.h>
43 #include <sys/ddi.h>
44 #include <sys/sunddi.h>
45 #include <sys/note.h>
46 #include "sys/consdev.h"
47 #include <sys/kbd.h>
48 #include <sys/kbtrans.h>
49 #include "kb8042.h"
50 
51 #include <sys/i8042.h>
52 
53 #include "sys/kbio.h"		/* for KIOCSLAYOUT */
54 #include "sys/stat.h"
55 #include "sys/reboot.h"
56 #include <sys/promif.h>
57 #include <sys/beep.h>
58 
59 /*
60  * For any keyboard, there is a unique code describing the position
61  * of the key on a keyboard. We refer to the code as "station number".
62  * The following table is used to map the station numbers from ps2
63  * AT/XT keyboards to that of a USB one.
64  *
65  * A mapping was added for entry K8042_STOP, to map to USB key code 120 (which
66  * maps to the STOP key) when in KB_USB mode, and maps to a HOLE entry
67  * when in KB_PC mode.  Note that this does not need to be made conditional
68  * on the architecture for which this module is complied because there are no
69  * keys that map to K8042_STOP on non-SPARC platforms.
70  */
71 static kbtrans_key_t keytab_pc2usb[KBTRANS_KEYNUMS_MAX] = {
72 /*  0 */	0,	53,	30,	31,	32,	33,	34,	35,
73 /*  8 */	36,	37,	38,	39,	45,	46,	137,	42,
74 /* 16 */	43,	20,	26,	8,	21,	23,	28,	24,
75 /* 24 */	12,	18,	19,	47,	48,	49,	57,	4,
76 /* 32 */	22,	7,	9,	10,	11,	13,	14,	15,
77 /* 40 */	51,	52,	50,	40,	225,	100,	29,	27,
78 /* 48 */	6,	25,	5,	17,	16,	54,	55,	56,
79 /* 56 */	135,	229,	224,	227,	226,	44,	230,	231,
80 /* 64 */	228,	101,	0,	0,	0,	0,	0,	0,
81 /* 72 */	0,	0,	0,	73,	76,	0,	0,	80,
82 /* 80 */	74,	77,	0,	82,	81,	75,	78,	0,
83 /* 88 */	0,	79,	83,	95,	92,	89,	0,	84,
84 /* 96 */	96,	93,	90,	98,	85,	97,	94,	91,
85 /* 104 */	99,	86,	87,	133,	88,	0,	41,	0,
86 /* 112 */	58,	59,	60,	61,	62,	63,	64,	65,
87 /* 120 */	66,	67,	68,	69,	70,	71,	72,	0,
88 /* 128 */	0,	0,	0,	139,	138,	136,	0,	0,
89 /* 136 */	0,	0,	0,	0,	0,	0,	0,	0,
90 /* 144 */	0,	0,	0,	0,	0,	0,	0,	0,
91 /* 152 */	0,	0,	0,	0,	0,	0,	0,	0,
92 /* 160 */	120,	0,	0,	0,	0,	0,	0,	0,
93 /* 168 */	0,	0,	0,	0,	0,	0,	0,	0,
94 /* 176 */	0,	0,	0,	0,	0,	0,	0,	0,
95 /* 184 */	0,	0,	0,	0,	0,	0,	0,	0,
96 /* 192 */	0,	0,	0,	0,	0,	0,	0,	0,
97 /* 200 */	0,	0,	0,	0,	0,	0,	0,	0,
98 /* 208 */	0,	0,	0,	0,	0,	0,	0,	0,
99 /* 216 */	0,	0,	0,	0,	0,	0,	0,	0,
100 /* 224 */	0,	0,	0,	0,	0,	0,	0,	0,
101 /* 232 */	0,	0,	0,	0,	0,	0,	0,	0,
102 /* 240 */	0,	0,	0,	0,	0,	0,	0,	0,
103 /* 248 */	0,	0,	0,	0
104 };
105 
106 /*
107  * DEBUG (or KD_DEBUG for just this module) turns on a flag called
108  * kb8042_enable_debug_hotkey.  If kb8042_enable_debug_hotkey is true,
109  * then the following hotkeys are enabled:
110  *    F10 - turn on debugging "normal" translations
111  *    F9  - turn on debugging "getchar" translations
112  *    F8  - turn on "low level" debugging
113  *    F7  - turn on terse press/release debugging
114  *    F1  - turn off all debugging
115  * The default value for kb8042_enable_debug_hotkey is false, disabling
116  * these hotkeys.
117  */
118 
119 #if	defined(DEBUG) || defined(lint)
120 #define	KD_DEBUG
121 #endif
122 
123 #ifdef	KD_DEBUG
124 boolean_t	kb8042_enable_debug_hotkey = B_FALSE;
125 boolean_t	kb8042_debug = B_FALSE;
126 boolean_t	kb8042_getchar_debug = B_FALSE;
127 boolean_t	kb8042_low_level_debug = B_FALSE;
128 boolean_t	kb8042_pressrelease_debug = B_FALSE;
129 static void kb8042_debug_hotkey(int scancode);
130 #endif
131 
132 #ifdef __sparc
133 #define	USECS_PER_WAIT 100
134 #define	MAX_WAIT_USECS 100000 /* in usecs = 100 ms */
135 #define	MIN_DELAY_USECS USECS_PER_WAIT
136 
137 boolean_t kb8042_warn_unknown_scanset = B_TRUE;
138 int kb8042_default_scanset = 2;
139 
140 #endif
141 
142 enum state_return { STATE_NORMAL, STATE_INTERNAL };
143 
144 static void kb8042_init(struct kb8042 *kb8042, boolean_t from_resume);
145 static uint_t kb8042_intr(caddr_t arg);
146 static void kb8042_wait_poweron(struct kb8042 *kb8042);
147 static void kb8042_start_state_machine(struct kb8042 *, boolean_t);
148 static enum state_return kb8042_state_machine(struct kb8042 *, int, boolean_t);
149 static void kb8042_send_to_keyboard(struct kb8042 *, int, boolean_t);
150 static int kb8042_xlate_leds(int);
151 static void kb8042_setled(struct kb8042 *, int led_state, boolean_t polled);
152 static void kb8042_streams_setled(struct kbtrans_hardware *hw, int led_state);
153 static void kb8042_polled_setled(struct kbtrans_hardware *hw, int led_state);
154 static boolean_t kb8042_polled_keycheck(
155 			struct kbtrans_hardware *hw, int *key,
156 			enum keystate *state);
157 static void kb8042_get_initial_leds(struct kb8042 *, int *, int *);
158 static boolean_t kb8042_autorepeat_detect(struct kb8042 *kb8042, int key_pos,
159 			enum keystate state);
160 static void kb8042_type4_cmd(struct kb8042 *kb8042, int cmd);
161 static void kb8042_ioctlmsg(struct kb8042 *kb8042, queue_t *, mblk_t *);
162 static void kb8042_iocdatamsg(queue_t *, mblk_t *);
163 static void kb8042_process_key(struct kb8042 *, kbtrans_key_t, enum keystate);
164 static int kb8042_polled_ischar(struct cons_polledio_arg *arg);
165 static int kb8042_polled_getchar(struct cons_polledio_arg *arg);
166 static void kb8042_cleanup(struct kb8042 *kb8042);
167 
168 static struct kbtrans_callbacks kb8042_callbacks = {
169 	kb8042_streams_setled,
170 	kb8042_polled_setled,
171 	kb8042_polled_keycheck,
172 };
173 
174 extern struct keyboard keyindex_pc;
175 
176 #define	DRIVER_NAME(dip) ddi_driver_name(dip)
177 
178 static	char	module_name[] = "kb8042";
179 
180 static int kb8042_open(queue_t *qp, dev_t *devp, int flag, int sflag,
181 			cred_t *credp);
182 static int kb8042_close(queue_t *qp, int flag, cred_t *credp);
183 static int kb8042_wsrv();
184 
185 struct module_info kb8042_sinfo = {
186 	42,		/* Module ID */
187 	module_name,
188 	0, 32,		/* Minimum and maximum packet sizes */
189 	256, 128	/* High and low water marks */
190 };
191 
192 static struct qinit kb8042_rinit = {
193 	NULL, NULL, kb8042_open, kb8042_close, NULL, &kb8042_sinfo, NULL
194 };
195 
196 static struct qinit kb8042_winit = {
197 	putq, kb8042_wsrv, kb8042_open, kb8042_close, NULL, &kb8042_sinfo, NULL
198 };
199 
200 struct streamtab
201 	kb8042_str_info = { &kb8042_rinit, &kb8042_winit, NULL, NULL };
202 
203 struct kb8042	Kdws = {0};
204 static dev_info_t *kb8042_dip = NULL;
205 
206 static int kb8042_getinfo(dev_info_t *dip, ddi_info_cmd_t infocmd, void *arg,
207 		void **result);
208 static int kb8042_attach(dev_info_t *, ddi_attach_cmd_t);
209 static int kb8042_detach(dev_info_t *, ddi_detach_cmd_t);
210 
211 static 	struct cb_ops cb_kb8042_ops = {
212 	nulldev,		/* cb_open */
213 	nulldev,		/* cb_close */
214 	nodev,			/* cb_strategy */
215 	nodev,			/* cb_print */
216 	nodev,			/* cb_dump */
217 	nodev,			/* cb_read */
218 	nodev,			/* cb_write */
219 	nodev,			/* cb_ioctl */
220 	nodev,			/* cb_devmap */
221 	nodev,			/* cb_mmap */
222 	nodev,			/* cb_segmap */
223 	nochpoll,		/* cb_chpoll */
224 	ddi_prop_op,		/* cb_prop_op */
225 	&kb8042_str_info,	/* cb_stream */
226 	D_MP
227 };
228 
229 struct dev_ops kb8042_ops = {
230 	DEVO_REV,		/* devo_rev */
231 	0,			/* devo_refcnt */
232 	kb8042_getinfo,		/* devo_getinfo */
233 	nulldev,		/* devo_identify */
234 	nulldev,		/* devo_probe */
235 	kb8042_attach,		/* devo_attach */
236 	kb8042_detach,		/* devo_detach */
237 	nodev,			/* devo_reset */
238 	&cb_kb8042_ops,		/* devo_cb_ops */
239 	(struct bus_ops *)NULL	/* devo_bus_ops */
240 };
241 
242 
243 /*
244  * This is the loadable module wrapper.
245  */
246 #include <sys/modctl.h>
247 
248 /*
249  * Module linkage information for the kernel.
250  */
251 static struct modldrv modldrv = {
252 	&mod_driverops, /* Type of module.  This one is a driver */
253 	"PS/2 Keyboard %I%, %E%",
254 	&kb8042_ops,	/* driver ops */
255 };
256 
257 static struct modlinkage modlinkage = {
258 	MODREV_1,
259 	(void *) &modldrv,
260 	NULL
261 };
262 
263 int
264 _init(void)
265 {
266 	int	rv;
267 
268 	rv = mod_install(&modlinkage);
269 	return (rv);
270 }
271 
272 
273 int
274 _fini(void)
275 {
276 	return (mod_remove(&modlinkage));
277 }
278 
279 int
280 _info(struct modinfo *modinfop)
281 {
282 	return (mod_info(&modlinkage, modinfop));
283 }
284 
285 #ifdef __sparc
286 static boolean_t
287 kb8042_is_input_avail(struct kb8042 *kb8042, int timeout_usec, boolean_t polled)
288 {
289 	int i;
290 	int port = (polled == B_TRUE) ? I8042_POLL_INPUT_AVAIL :
291 	    I8042_INT_INPUT_AVAIL;
292 	int reps = timeout_usec / USECS_PER_WAIT;
293 
294 	for (i = 0; i < reps; i++) {
295 		if (ddi_get8(kb8042->handle, kb8042->addr + port) != 0)
296 			return (B_TRUE);
297 
298 		if (i < (reps - 1))
299 			drv_usecwait(USECS_PER_WAIT);
300 	}
301 	return (B_FALSE);
302 }
303 
304 static void
305 kb8042_clear_input_buffer(struct kb8042 *kb8042, boolean_t polled)
306 {
307 	int port = (polled == B_TRUE) ? I8042_POLL_INPUT_DATA :
308 	    I8042_INT_INPUT_DATA;
309 
310 	while (kb8042_is_input_avail(kb8042, MIN_DELAY_USECS, polled)) {
311 		(void) ddi_get8(kb8042->handle, kb8042->addr + port);
312 	}
313 }
314 
315 static boolean_t
316 kb8042_send_and_expect(struct kb8042 *kb8042, uint8_t send, uint8_t expect,
317     boolean_t polled, int timeout, int *error, uint8_t *got)
318 {
319 	int port = (polled == B_TRUE) ? I8042_POLL_INPUT_DATA :
320 	    I8042_INT_INPUT_DATA;
321 	uint8_t datab;
322 	int err;
323 	boolean_t rval;
324 
325 	kb8042_send_to_keyboard(kb8042, send, polled);
326 
327 	if (kb8042_is_input_avail(kb8042, timeout, polled)) {
328 		err = 0;
329 		datab = ddi_get8(kb8042->handle, kb8042->addr + port);
330 		rval = ((datab == expect) ? B_TRUE : B_FALSE);
331 	} else {
332 		err = EAGAIN;
333 		rval = B_FALSE;
334 	}
335 
336 	if (error != NULL)
337 		*error = err;
338 	if (got != NULL)
339 		*got = datab;
340 	return (rval);
341 }
342 
343 static const char *
344 kb8042_error_string(int errcode)
345 {
346 	switch (errcode) {
347 	case EAGAIN:
348 		return ("Timed out");
349 	default:
350 		return ("Unknown error");
351 	}
352 }
353 
354 static int
355 kb8042_read_scanset(struct kb8042 *kb8042, boolean_t polled)
356 {
357 	int scanset = -1;
358 	int port = (polled == B_TRUE) ? I8042_POLL_INPUT_DATA :
359 	    I8042_INT_INPUT_DATA;
360 	int err;
361 	uint8_t got;
362 
363 	kb8042_clear_input_buffer(kb8042, B_TRUE);
364 
365 	/*
366 	 * Send a "change scan code set" command to the keyboard.
367 	 * It should respond with an ACK.
368 	 */
369 	if (kb8042_send_and_expect(kb8042, KB_SET_SCAN, KB_ACK, polled,
370 	    MAX_WAIT_USECS, &err, &got) != B_TRUE) {
371 		goto fail_read_scanset;
372 	}
373 
374 	/*
375 	 * Send a 0.  The keyboard should ACK the 0, then it send the scan code
376 	 * set in use.
377 	 */
378 	if (kb8042_send_and_expect(kb8042, 0, KB_ACK, polled,
379 	    MAX_WAIT_USECS, &err, &got) != B_TRUE) {
380 		goto fail_read_scanset;
381 	}
382 
383 	/*
384 	 * The next input byte from the keyboard should be the scan code
385 	 * set in use, though some keyboards like to send a few more acks
386 	 * just for fun, so blow past those to get the keyboard scan code.
387 	 */
388 	while (kb8042_is_input_avail(kb8042, MAX_WAIT_USECS, B_TRUE) &&
389 		(scanset = ddi_get8(kb8042->handle, kb8042->addr + port))
390 		    == KB_ACK)
391 		;
392 
393 #ifdef KD_DEBUG
394 	cmn_err(CE_NOTE, "!Scan code set from keyboard is `%d'.",
395 	    scanset);
396 #endif
397 
398 	return (scanset);
399 
400 fail_read_scanset:
401 #ifdef KD_DEBUG
402 	if (err == 0)
403 		cmn_err(CE_NOTE, "Could not read current scan set from "
404 		    "keyboard: %s. (Expected 0x%x, but got 0x%x).",
405 		    kb8042_error_string(err), KB_ACK, got);
406 	else
407 		cmn_err(CE_NOTE, "Could not read current scan set from "
408 		    "keyboard: %s.", kb8042_error_string(err));
409 #endif
410 	return (-1);
411 }
412 #endif
413 
414 static int
415 kb8042_attach(dev_info_t *devi, ddi_attach_cmd_t cmd)
416 {
417 	int	rc;
418 	int	scanset;
419 	int	leds;
420 
421 	struct kb8042	*kb8042 = &Kdws;
422 	static ddi_device_acc_attr_t attr = {
423 		DDI_DEVICE_ATTR_V0,
424 		DDI_NEVERSWAP_ACC,
425 		DDI_STRICTORDER_ACC,
426 	};
427 
428 	switch (cmd) {
429 	case DDI_RESUME:
430 		leds = kb8042->leds.commanded;
431 		kb8042->w_init = 0;
432 		kb8042_init(kb8042, B_TRUE);
433 		kb8042_setled(kb8042, leds, B_FALSE);
434 		return (DDI_SUCCESS);
435 
436 	case DDI_ATTACH:
437 		if (kb8042_dip != NULL)
438 			return (DDI_FAILURE);
439 		/* The rest of the function is for attach */
440 		break;
441 
442 	default:
443 		return (DDI_FAILURE);
444 	}
445 
446 	kb8042->debugger.mod1 = 58;	/* Left Ctrl */
447 	kb8042->debugger.mod2 = 60;	/* Left Alt */
448 	kb8042->debugger.trigger = 33;	/* D */
449 	kb8042->debugger.mod1_down = B_FALSE;
450 	kb8042->debugger.mod2_down = B_FALSE;
451 	kb8042->debugger.enabled = B_FALSE;
452 
453 	kb8042_dip = devi;
454 	kb8042->init_state = KB8042_UNINITIALIZED;
455 
456 	kb8042->polled_synthetic_release_pending = B_FALSE;
457 
458 	if (ddi_create_minor_node(devi, module_name, S_IFCHR, 0,
459 		    DDI_NT_KEYBOARD, 0) == DDI_FAILURE) {
460 		goto failure;
461 	}
462 
463 	kb8042->init_state |= KB8042_MINOR_NODE_CREATED;
464 
465 	rc = ddi_regs_map_setup(devi, 0, (caddr_t *)&kb8042->addr,
466 		(offset_t)0, (offset_t)0, &attr, &kb8042->handle);
467 	if (rc != DDI_SUCCESS) {
468 #if	defined(KD_DEBUG)
469 		cmn_err(CE_WARN, "kb8042_attach:  can't map registers");
470 #endif
471 		goto failure;
472 	}
473 
474 	kb8042->init_state |= KB8042_REGS_MAPPED;
475 
476 	if (ddi_get_iblock_cookie(devi, 0, &kb8042->w_iblock) !=
477 		DDI_SUCCESS) {
478 		cmn_err(CE_WARN, "kb8042_attach:  Can't get iblock cookie");
479 		goto failure;
480 	}
481 
482 	mutex_init(&kb8042->w_hw_mutex, NULL, MUTEX_DRIVER, kb8042->w_iblock);
483 
484 	kb8042->init_state |= KB8042_HW_MUTEX_INITTED;
485 
486 	kb8042_init(kb8042, B_FALSE);
487 
488 #ifdef __sparc
489 	/* Detect the scan code set currently in use */
490 	scanset = kb8042_read_scanset(kb8042, B_TRUE);
491 
492 	if (scanset < 0 && kb8042_warn_unknown_scanset) {
493 
494 		cmn_err(CE_WARN, "Cannot determine keyboard scan code set ");
495 		cmn_err(CE_CONT, "(is the keyboard plugged in?). ");
496 		cmn_err(CE_CONT, "Defaulting to scan code set %d.  If the "
497 		    "keyboard does not ", kb8042_default_scanset);
498 		cmn_err(CE_CONT, "work properly, add "
499 		    "`set kb8042:kb8042_default_scanset=%d' to /etc/system ",
500 		    (kb8042_default_scanset == 1) ? 2 : 1);
501 		cmn_err(CE_CONT, "(via network or with a USB keyboard) and "
502 		    "restart the system.  If you ");
503 		cmn_err(CE_CONT, "do not want to see this message in the "
504 		    "future, add ");
505 		cmn_err(CE_CONT, "`set kb8042:kb8042_warn_unknown_scanset=0' "
506 		    "to /etc/system.\n");
507 
508 		/* Use the default scan code set. */
509 		scanset = kb8042_default_scanset;
510 	}
511 #else
512 	/* x86 systems use scan code set 1 -- no detection required */
513 	scanset = 1;
514 #endif
515 	if (KeyboardConvertScan_init(kb8042, scanset) != DDI_SUCCESS) {
516 		cmn_err(CE_WARN, "Cannot initialize keyboard scan converter: "
517 		    "Unknown scan code set `%d'.", scanset);
518 		/* Scan code set is not supported */
519 		goto failure;
520 	}
521 
522 	/*
523 	 * Turn on interrupts...
524 	 */
525 	if (ddi_add_intr(devi, 0,
526 		&kb8042->w_iblock, (ddi_idevice_cookie_t *)NULL,
527 		kb8042_intr, (caddr_t)kb8042) != DDI_SUCCESS) {
528 		cmn_err(CE_WARN, "kb8042_attach: cannot add interrupt");
529 		goto failure;
530 	}
531 
532 	kb8042->init_state |= KB8042_INTR_ADDED;
533 
534 	ddi_report_dev(devi);
535 
536 #ifdef	KD_DEBUG
537 	cmn_err(CE_CONT, "?%s #%d: version %s\n",
538 	    DRIVER_NAME(devi), ddi_get_instance(devi), "%I% (%E%)");
539 #endif
540 
541 	return (DDI_SUCCESS);
542 
543 failure:
544 	kb8042_cleanup(kb8042);
545 	return (DDI_FAILURE);
546 }
547 
548 static int
549 kb8042_detach(dev_info_t *dip, ddi_detach_cmd_t cmd)
550 {
551 	struct kb8042 *kb8042 = &Kdws;
552 
553 	switch (cmd) {
554 	case DDI_SUSPEND:
555 		return (DDI_SUCCESS);
556 
557 	case DDI_DETACH:
558 		/* If someone has a stream open, fail to detach */
559 		if (kb8042->w_qp != NULL)
560 			return (DDI_FAILURE);
561 
562 		ASSERT(kb8042_dip == dip);
563 
564 		kb8042_cleanup(kb8042);
565 
566 		return (DDI_SUCCESS);
567 
568 	default:
569 		return (DDI_FAILURE);
570 	}
571 }
572 
573 
574 /*ARGSUSED*/
575 static int
576 kb8042_getinfo(
577     dev_info_t *dip,
578     ddi_info_cmd_t infocmd,
579     void *arg,
580     void **result)
581 {
582 	register int error;
583 
584 	switch (infocmd) {
585 	case DDI_INFO_DEVT2DEVINFO:
586 		if (kb8042_dip == NULL) {
587 			error = DDI_FAILURE;
588 		} else {
589 			*result = (void *) kb8042_dip;
590 			error = DDI_SUCCESS;
591 		}
592 		break;
593 	case DDI_INFO_DEVT2INSTANCE:
594 		*result = (void *)0;
595 		error = DDI_SUCCESS;
596 		break;
597 	default:
598 		error = DDI_FAILURE;
599 		break;
600 	}
601 	return (error);
602 }
603 
604 static void
605 kb8042_cleanup(struct kb8042 *kb8042)
606 {
607 	ASSERT(kb8042_dip != NULL);
608 
609 	if (kb8042->init_state & KB8042_HW_MUTEX_INITTED)
610 		mutex_destroy(&kb8042->w_hw_mutex);
611 
612 	if (kb8042->init_state & KB8042_INTR_ADDED)
613 		ddi_remove_intr(kb8042_dip, 0, kb8042->w_iblock);
614 
615 	if (kb8042->init_state & KB8042_REGS_MAPPED)
616 		ddi_regs_map_free(&kb8042->handle);
617 
618 	if (kb8042->init_state & KB8042_MINOR_NODE_CREATED)
619 		ddi_remove_minor_node(kb8042_dip, NULL);
620 
621 	kb8042->init_state = KB8042_UNINITIALIZED;
622 	kb8042_dip = NULL;
623 }
624 
625 static void
626 kb8042_init(struct kb8042 *kb8042, boolean_t from_resume)
627 {
628 	if (kb8042->w_init)
629 		return;
630 
631 	if (!from_resume) {
632 		kb8042->w_kblayout = 0;	/* Default to US */
633 		kb8042->w_qp = (queue_t *)NULL;
634 		kb8042->simulated_kbd_type = KB_PC;
635 		kb8042->leds.commanded = -1;	/* Unknown initial state */
636 		kb8042->leds.desired = -1;	/* Unknown initial state */
637 	}
638 
639 	kb8042_wait_poweron(kb8042);
640 
641 	kb8042->kb_old_key_pos = 0;
642 
643 	/* Set up the command state machine and start it running. */
644 	kb8042->command_state = KB_COMMAND_STATE_WAIT;
645 	kb8042_send_to_keyboard(kb8042, KB_ENABLE, B_FALSE);
646 
647 	kb8042->w_init++;
648 
649 	(void) drv_setparm(SYSRINT, 1);	/* reset keyboard interrupts */
650 }
651 
652 /*ARGSUSED2*/
653 static int
654 kb8042_open(queue_t *qp, dev_t *devp, int flag, int sflag, cred_t *credp)
655 {
656 	struct kb8042	*kb8042;
657 	int err;
658 	int initial_leds;
659 	int initial_led_mask;
660 
661 	kb8042 = &Kdws;
662 
663 	kb8042->w_dev = *devp;
664 
665 	if (qp->q_ptr) {
666 		return (0);
667 	}
668 	qp->q_ptr = (caddr_t)kb8042;
669 	WR(qp)->q_ptr = qp->q_ptr;
670 	if (!kb8042->w_qp)
671 		kb8042->w_qp = qp;
672 
673 	kb8042_get_initial_leds(kb8042, &initial_leds, &initial_led_mask);
674 	err = kbtrans_streams_init(qp, sflag, credp,
675 		(struct kbtrans_hardware *)kb8042, &kb8042_callbacks,
676 		&kb8042->hw_kbtrans,
677 		initial_leds, initial_led_mask);
678 	if (err != 0)
679 		return (err);
680 
681 	kbtrans_streams_set_keyboard(kb8042->hw_kbtrans, KB_PC, &keyindex_pc);
682 
683 	kb8042->polledio.cons_polledio_version = CONSPOLLEDIO_V1;
684 	kb8042->polledio.cons_polledio_argument =
685 		(struct cons_polledio_arg *)kb8042;
686 	kb8042->polledio.cons_polledio_putchar = NULL;
687 	kb8042->polledio.cons_polledio_getchar =
688 		(int (*)(struct cons_polledio_arg *))kb8042_polled_getchar;
689 	kb8042->polledio.cons_polledio_ischar =
690 		(boolean_t (*)(struct cons_polledio_arg *))kb8042_polled_ischar;
691 	kb8042->polledio.cons_polledio_enter = NULL;
692 	kb8042->polledio.cons_polledio_exit = NULL;
693 	kb8042->polledio.cons_polledio_setled =
694 		(void (*)(struct cons_polledio_arg *, int))kb8042_polled_setled;
695 	kb8042->polledio.cons_polledio_keycheck =
696 		(boolean_t (*)(struct cons_polledio_arg *, int *,
697 		enum keystate *))kb8042_polled_keycheck;
698 
699 	qprocson(qp);
700 
701 	kbtrans_streams_enable(kb8042->hw_kbtrans);
702 
703 	return (0);
704 }
705 
706 /*ARGSUSED1*/
707 static int
708 kb8042_close(queue_t *qp, int flag, cred_t *credp)
709 {
710 	struct kb8042	*kb8042;
711 
712 	kb8042 = (struct kb8042 *)qp->q_ptr;
713 
714 	(void) kbtrans_streams_fini(kb8042->hw_kbtrans);
715 
716 	kb8042->w_qp = (queue_t *)NULL;
717 	qprocsoff(qp);
718 
719 	return (0);
720 }
721 
722 static int
723 kb8042_wsrv(queue_t *qp)
724 {
725 	struct kb8042 *kb8042;
726 
727 	mblk_t	*mp;
728 
729 	kb8042 = (struct kb8042 *)qp->q_ptr;
730 
731 	while ((mp = getq(qp))) {
732 		switch (kbtrans_streams_message(kb8042->hw_kbtrans, mp)) {
733 		case KBTRANS_MESSAGE_HANDLED:
734 			continue;
735 		case KBTRANS_MESSAGE_NOT_HANDLED:
736 			break;
737 		}
738 		switch (mp->b_datap->db_type) {
739 		case M_IOCTL:
740 			kb8042_ioctlmsg(kb8042, qp, mp);
741 			continue;
742 		case M_IOCDATA:
743 			kb8042_iocdatamsg(qp, mp);
744 			continue;
745 		case M_DELAY:
746 		case M_STARTI:
747 		case M_STOPI:
748 		case M_READ:	/* ignore, no buffered data */
749 			freemsg(mp);
750 			continue;
751 		case M_FLUSH:
752 			*mp->b_rptr &= ~FLUSHW;
753 			if (*mp->b_rptr & FLUSHR)
754 				qreply(qp, mp);
755 			else
756 				freemsg(mp);
757 			continue;
758 		default:
759 			cmn_err(CE_NOTE, "kb8042_wsrv: bad msg %x",
760 						mp->b_datap->db_type);
761 			freemsg(mp);
762 			continue;
763 		}
764 	}
765 	return (0);
766 }
767 
768 static void
769 kb8042_ioctlmsg(struct kb8042 *kb8042, queue_t *qp, mblk_t *mp)
770 {
771 	struct iocblk	*iocp;
772 	mblk_t		*datap;
773 	int		error;
774 	int		tmp;
775 
776 	iocp = (struct iocblk *)mp->b_rptr;
777 
778 	switch (iocp->ioc_cmd) {
779 
780 	case CONSOPENPOLLEDIO:
781 		error = miocpullup(mp, sizeof (struct cons_polledio *));
782 		if (error != 0) {
783 			miocnak(qp, mp, 0, error);
784 			return;
785 		}
786 
787 		/*
788 		 * We are given an appropriate-sized data block,
789 		 * and return a pointer to our structure in it.
790 		 */
791 		*(struct cons_polledio **)mp->b_cont->b_rptr =
792 		    &kb8042->polledio;
793 		mp->b_datap->db_type = M_IOCACK;
794 		iocp->ioc_error = 0;
795 		qreply(qp, mp);
796 		break;
797 
798 	case CONSCLOSEPOLLEDIO:
799 		miocack(qp, mp, 0, 0);
800 		break;
801 
802 	case CONSSETABORTENABLE:
803 		if (iocp->ioc_count != TRANSPARENT) {
804 			miocnak(qp, mp, 0, EINVAL);
805 			return;
806 		}
807 
808 		kb8042->debugger.enabled = *(intptr_t *)mp->b_cont->b_rptr;
809 		miocack(qp, mp, 0, 0);
810 		break;
811 
812 	/*
813 	 * Valid only in TR_UNTRANS_MODE mode.
814 	 */
815 	case CONSSETKBDTYPE:
816 		error = miocpullup(mp, sizeof (int));
817 		if (error != 0) {
818 			miocnak(qp, mp, 0, error);
819 			return;
820 		}
821 		tmp =  *(int *)mp->b_cont->b_rptr;
822 		if (tmp != KB_PC && tmp != KB_USB) {
823 			miocnak(qp, mp, 0, EINVAL);
824 			break;
825 		}
826 		kb8042->simulated_kbd_type = tmp;
827 		miocack(qp, mp, 0, 0);
828 		break;
829 
830 	case KIOCLAYOUT:
831 		if (kb8042->w_kblayout == -1) {
832 			miocnak(qp, mp, 0, EINVAL);
833 			return;
834 		}
835 
836 		if ((datap = allocb(sizeof (int), BPRI_HI)) == NULL) {
837 			miocnak(qp, mp, 0, ENOMEM);
838 			return;
839 		}
840 
841 		if (kb8042->simulated_kbd_type == KB_USB)
842 			*(int *)datap->b_wptr = KBTRANS_USBKB_DEFAULT_LAYOUT;
843 		else
844 			*(int *)datap->b_wptr = kb8042->w_kblayout;
845 
846 		datap->b_wptr += sizeof (int);
847 		if (mp->b_cont)
848 			freemsg(mp->b_cont);
849 		mp->b_cont = datap;
850 		iocp->ioc_count = sizeof (int);
851 		mp->b_datap->db_type = M_IOCACK;
852 		iocp->ioc_error = 0;
853 		qreply(qp, mp);
854 		break;
855 
856 	case KIOCSLAYOUT:
857 		if (iocp->ioc_count != TRANSPARENT) {
858 			miocnak(qp, mp, 0, EINVAL);
859 			return;
860 		}
861 
862 		kb8042->w_kblayout = *(intptr_t *)mp->b_cont->b_rptr;
863 		miocack(qp, mp, 0, 0);
864 		break;
865 
866 	case KIOCCMD:
867 		error = miocpullup(mp, sizeof (int));
868 		if (error != 0) {
869 			miocnak(qp, mp, 0, error);
870 			return;
871 		}
872 
873 		kb8042_type4_cmd(kb8042, *(int *)mp->b_cont->b_rptr);
874 		miocack(qp, mp, 0, 0);
875 		break;
876 
877 	default:
878 #ifdef DEBUG1
879 		cmn_err(CE_NOTE, "!kb8042_ioctlmsg %x", iocp->ioc_cmd);
880 #endif
881 		miocnak(qp, mp, 0, EINVAL);
882 		return;
883 	}
884 }
885 
886 /*
887  * Process a byte received from the keyboard
888  */
889 static void
890 kb8042_received_byte(
891 	struct kb8042	*kb8042,
892 	int		scancode)	/* raw scan code */
893 {
894 	boolean_t	legit;		/* is this a legit key pos'n? */
895 	int		key_pos = -1;
896 	enum keystate	state;
897 	boolean_t	synthetic_release_needed;
898 
899 #ifdef	KD_DEBUG
900 	kb8042_debug_hotkey(scancode);
901 #endif
902 
903 	if (!kb8042->w_init)	/* can't do anything anyway */
904 		return;
905 
906 	legit = KeyboardConvertScan(kb8042, scancode, &key_pos, &state,
907 		&synthetic_release_needed);
908 
909 	if (legit == 0) {
910 		/* Eaten by translation */
911 #ifdef	KD_DEBUG
912 		if (kb8042_debug)
913 			prom_printf("kb8042_intr: 0x%x -> ignored\n", scancode);
914 #endif
915 		return;
916 	}
917 
918 #ifdef	KD_DEBUG
919 	if (kb8042_debug) {
920 		prom_printf("kb8042_intr:  0x%x -> %s %d",
921 			scancode,
922 			state == KEY_RELEASED ? "released" : "pressed",
923 			key_pos);
924 	}
925 #endif
926 
927 	/*
928 	 * Don't know if we want this permanently, but it seems interesting
929 	 * for the moment.
930 	 */
931 	if (key_pos == kb8042->debugger.mod1) {
932 #ifdef	KD_DEBUG
933 		if (kb8042_debug)
934 			prom_printf(" -> debug mod1");
935 #endif
936 		kb8042->debugger.mod1_down = (state == KEY_PRESSED);
937 	}
938 	if (key_pos == kb8042->debugger.mod2) {
939 #ifdef	KD_DEBUG
940 		if (kb8042_debug)
941 			prom_printf(" -> debug mod2");
942 #endif
943 		kb8042->debugger.mod2_down = (state == KEY_PRESSED);
944 	}
945 	if (kb8042->debugger.enabled &&
946 	    key_pos == kb8042->debugger.trigger &&
947 	    kb8042->debugger.mod1_down &&
948 	    kb8042->debugger.mod2_down) {
949 #ifdef	KD_DEBUG
950 		if (kb8042_debug)
951 			prom_printf(" -> debugger\n");
952 #endif
953 		/*
954 		 * Require new presses of the modifiers.
955 		 */
956 		kb8042->debugger.mod1_down = B_FALSE;
957 		kb8042->debugger.mod2_down = B_FALSE;
958 		abort_sequence_enter(NULL);
959 		return;
960 	}
961 
962 	/*
963 	 * If there's no queue above us - as can happen if we've been
964 	 * attached but not opened - drop the keystroke.
965 	 * Note that we do this here instead of above so that
966 	 * Ctrl-Alt-D still works.
967 	 */
968 	if (kb8042->w_qp == NULL) {
969 #ifdef	KD_DEBUG
970 		if (kb8042_debug)
971 			prom_printf(" -> nobody home\n");
972 #endif
973 		return;
974 	}
975 
976 	/*
977 	 * This is to filter out auto repeat since it can't be
978 	 * turned off at the hardware.  (Yeah, yeah, PS/2 keyboards
979 	 * can.  Don't know whether they've taken over the world.
980 	 * Don't think so.)
981 	 */
982 	if (kb8042_autorepeat_detect(kb8042, key_pos, state)) {
983 #ifdef	KD_DEBUG
984 		if (kb8042_debug)
985 			prom_printf(" -> autorepeat ignored\n");
986 #endif
987 		return;
988 	}
989 
990 #ifdef	KD_DEBUG
991 	if (kb8042_debug)
992 		prom_printf(" -> OK\n");
993 #endif
994 
995 #if	defined(KD_DEBUG)
996 	if (kb8042_pressrelease_debug) {
997 		prom_printf(" %s%d ",
998 			state == KEY_PRESSED ? "+" : "-",
999 			key_pos);
1000 	}
1001 #endif
1002 
1003 		kb8042_process_key(kb8042, key_pos, state);
1004 
1005 	/*
1006 	 * This is a total hack.  For some stupid reason, the two additional
1007 	 * keys on Korean keyboards (Hangul and Hangul/Hanja) report press
1008 	 * only.  We synthesize a release immediately.
1009 	 */
1010 	if (synthetic_release_needed) {
1011 #if	defined(KD_DEBUG)
1012 		if (kb8042_debug)
1013 			prom_printf("synthetic release %d\n", key_pos);
1014 		if (kb8042_pressrelease_debug)
1015 			prom_printf(" -%d(s) ", key_pos);
1016 #endif
1017 		(void) kb8042_autorepeat_detect(kb8042, key_pos, KEY_RELEASED);
1018 		kb8042_process_key(kb8042, key_pos, state);
1019 	}
1020 }
1021 
1022 
1023 static void
1024 kb8042_process_key(struct kb8042 *kb8042, kbtrans_key_t key_pos,
1025     enum keystate state)
1026 {
1027 	kbtrans_key_t key;
1028 
1029 	ASSERT(key_pos >= 0 && key_pos <= 255);
1030 	if (kb8042->simulated_kbd_type == KB_PC) {
1031 		kbtrans_streams_key(kb8042->hw_kbtrans, key_pos, state);
1032 	} else if (kb8042->simulated_kbd_type == KB_USB) {
1033 		key = keytab_pc2usb[key_pos];
1034 		if (key != 0) {
1035 			kbtrans_streams_key(kb8042->hw_kbtrans, key, state);
1036 		}
1037 	}
1038 }
1039 
1040 /*
1041  * Called from interrupt handler when keyboard interrupt occurs.
1042  */
1043 static uint_t
1044 kb8042_intr(caddr_t arg)
1045 {
1046 	uchar_t scancode;	/* raw scan code */
1047 	int rc;
1048 	struct kb8042 *kb8042 = (struct kb8042 *)arg;
1049 
1050 	rc = DDI_INTR_UNCLAIMED;
1051 
1052 	if (kb8042->init_state == KB8042_UNINITIALIZED)
1053 		return (DDI_INTR_UNCLAIMED);
1054 
1055 	/* don't care if drv_setparm succeeds */
1056 	(void) drv_setparm(SYSRINT, 1);
1057 
1058 	while (ddi_get8(kb8042->handle, kb8042->addr + I8042_INT_INPUT_AVAIL)
1059 	    != 0) {
1060 		rc = DDI_INTR_CLAIMED;
1061 
1062 		scancode = ddi_get8(kb8042->handle,
1063 			kb8042->addr + I8042_INT_INPUT_DATA);
1064 
1065 #if	defined(KD_DEBUG)
1066 		if (kb8042_low_level_debug)
1067 			prom_printf(" <K:%x ", scancode);
1068 #endif
1069 
1070 		mutex_enter(&kb8042->w_hw_mutex);
1071 
1072 		if (kb8042_state_machine(kb8042, scancode, B_FALSE) !=
1073 		    STATE_NORMAL) {
1074 			mutex_exit(&kb8042->w_hw_mutex);
1075 			continue;
1076 		}
1077 
1078 
1079 		mutex_exit(&kb8042->w_hw_mutex);
1080 
1081 		kb8042_received_byte(kb8042, scancode);
1082 	}
1083 
1084 	return (rc);
1085 }
1086 
1087 static void
1088 kb8042_iocdatamsg(queue_t *qp, mblk_t *mp)
1089 {
1090 	struct copyresp	*csp;
1091 
1092 	csp = (struct copyresp *)mp->b_rptr;
1093 	if (csp->cp_rval) {
1094 		freemsg(mp);
1095 		return;
1096 	}
1097 
1098 	switch (csp->cp_cmd) {
1099 	default:
1100 		miocack(qp, mp, 0, 0);
1101 		break;
1102 	}
1103 }
1104 
1105 static boolean_t
1106 kb8042_polled_keycheck(
1107     struct kbtrans_hardware *hw,
1108     int *key,
1109     enum keystate *state)
1110 {
1111 	struct kb8042 *kb8042 = (struct kb8042 *)hw;
1112 	int	scancode;
1113 	boolean_t	legit;
1114 	boolean_t	synthetic_release_needed;
1115 
1116 	if (kb8042->polled_synthetic_release_pending) {
1117 		*key = kb8042->polled_synthetic_release_key;
1118 		*state = KEY_RELEASED;
1119 		kb8042->polled_synthetic_release_pending = B_FALSE;
1120 #if	defined(KD_DEBUG)
1121 		if (kb8042_getchar_debug)
1122 			prom_printf("synthetic release 0x%x\n", *key);
1123 #endif
1124 		(void) kb8042_autorepeat_detect(kb8042, *key, *state);
1125 		return (B_TRUE);
1126 	}
1127 
1128 	for (;;) {
1129 		if (ddi_get8(kb8042->handle,
1130 		    kb8042->addr + I8042_POLL_INPUT_AVAIL) == 0) {
1131 			return (B_FALSE);
1132 		}
1133 
1134 		scancode = ddi_get8(kb8042->handle,
1135 				kb8042->addr + I8042_POLL_INPUT_DATA);
1136 
1137 #if	defined(KD_DEBUG)
1138 		if (kb8042_low_level_debug)
1139 			prom_printf(" g<%x ", scancode);
1140 #endif
1141 
1142 		if (kb8042_state_machine(kb8042, scancode, B_FALSE) !=
1143 		    STATE_NORMAL) {
1144 			continue;
1145 		}
1146 
1147 #ifdef	KD_DEBUG
1148 		kb8042_debug_hotkey(scancode);
1149 		if (kb8042_getchar_debug)
1150 			prom_printf("polled 0x%x", scancode);
1151 #endif
1152 
1153 		legit = KeyboardConvertScan(kb8042, scancode, key, state,
1154 			&synthetic_release_needed);
1155 		if (!legit) {
1156 #ifdef	KD_DEBUG
1157 			if (kb8042_getchar_debug)
1158 				prom_printf(" -> ignored\n");
1159 #endif
1160 			continue;
1161 		}
1162 #ifdef	KD_DEBUG
1163 		if (kb8042_getchar_debug) {
1164 			prom_printf(" -> %s %d\n",
1165 				*state == KEY_PRESSED ? "pressed" : "released",
1166 				*key);
1167 		}
1168 #endif
1169 		/*
1170 		 * For the moment at least, we rely on hardware autorepeat
1171 		 * for polled I/O autorepeat.  However, for coordination
1172 		 * with the interrupt-driven code, maintain the last key
1173 		 * pressed.
1174 		 */
1175 		(void) kb8042_autorepeat_detect(kb8042, *key, *state);
1176 
1177 		/*
1178 		 * This is a total hack to support two additional keys
1179 		 * on Korean keyboards.  They report only on press, and
1180 		 * so we synthesize a release.  Most likely this will
1181 		 * never be important to polled  I/O, but if I do it
1182 		 * "right" the first time it _won't_ be an issue.
1183 		 */
1184 		if (synthetic_release_needed) {
1185 			kb8042->polled_synthetic_release_pending = B_TRUE;
1186 			kb8042->polled_synthetic_release_key = *key;
1187 		}
1188 
1189 		if (kb8042->simulated_kbd_type == KB_USB) {
1190 			*key = keytab_pc2usb[*key];
1191 		}
1192 		return (B_TRUE);
1193 	}
1194 }
1195 
1196 static void
1197 kb8042_setled(struct kb8042 *kb8042, int led_state, boolean_t polled)
1198 {
1199 	kb8042->leds.desired = led_state;
1200 
1201 	if (!polled)
1202 		mutex_enter(&kb8042->w_hw_mutex);
1203 
1204 	kb8042_start_state_machine(kb8042, polled);
1205 
1206 	if (!polled)
1207 		mutex_exit(&kb8042->w_hw_mutex);
1208 }
1209 
1210 static void
1211 kb8042_polled_setled(struct kbtrans_hardware *hw, int led_state)
1212 {
1213 	struct kb8042 *kb8042 = (struct kb8042 *)hw;
1214 	kb8042_setled(kb8042, led_state, B_TRUE);
1215 }
1216 
1217 static void
1218 kb8042_streams_setled(struct kbtrans_hardware *hw, int led_state)
1219 {
1220 	struct kb8042 *kb8042 = (struct kb8042 *)hw;
1221 	kb8042_setled(kb8042, led_state, B_FALSE);
1222 }
1223 
1224 static void
1225 kb8042_send_to_keyboard(struct kb8042 *kb8042, int byte, boolean_t polled)
1226 {
1227 	if (polled) {
1228 		ddi_put8(kb8042->handle,
1229 		    kb8042->addr + I8042_POLL_OUTPUT_DATA, byte);
1230 	} else {
1231 		ddi_put8(kb8042->handle,
1232 		    kb8042->addr + I8042_INT_OUTPUT_DATA, byte);
1233 	}
1234 
1235 #if	defined(KD_DEBUG)
1236 	if (kb8042_low_level_debug)
1237 		prom_printf(" >K:%x ", byte);
1238 #endif
1239 }
1240 
1241 /*
1242  * Wait until the keyboard is fully up, maybe.
1243  * We may be the first person to talk to the keyboard, in which case
1244  * it's patiently waiting to say "AA" to us to tell us it's up.
1245  * In theory it sends the AA in 300ms < n < 9s, but it's a pretty
1246  * good bet that we've already spent that long getting to that point,
1247  * so we'll only wait long enough for the communications electronics to
1248  * run.
1249  */
1250 static void
1251 kb8042_wait_poweron(struct kb8042 *kb8042)
1252 {
1253 	int cnt;
1254 	int ready;
1255 	unsigned char byt;
1256 
1257 	/* wait for up to 250 ms for a response */
1258 	for (cnt = 0; cnt < 250; cnt++) {
1259 		ready = ddi_get8(kb8042->handle,
1260 			kb8042->addr + I8042_INT_INPUT_AVAIL);
1261 		if (ready != 0)
1262 			break;
1263 		drv_usecwait(1000);
1264 	}
1265 
1266 	/*
1267 	 * If there's something pending, read and discard it.  If not,
1268 	 * assume things are OK anyway - maybe somebody else ate it
1269 	 * already.  (On a PC, the BIOS almost certainly did.)
1270 	 */
1271 	if (ready != 0) {
1272 		byt = ddi_get8(kb8042->handle,
1273 			kb8042->addr + I8042_INT_INPUT_DATA);
1274 #if	defined(KD_DEBUG)
1275 		if (kb8042_low_level_debug)
1276 			prom_printf(" <K:%x ", byt);
1277 #endif
1278 	}
1279 }
1280 
1281 static void
1282 kb8042_start_state_machine(struct kb8042 *kb8042, boolean_t polled)
1283 {
1284 	if (kb8042->command_state == KB_COMMAND_STATE_IDLE) {
1285 		if (kb8042->leds.desired != kb8042->leds.commanded) {
1286 			kb8042_send_to_keyboard(kb8042, KB_SET_LED, polled);
1287 			kb8042->command_state = KB_COMMAND_STATE_LED;
1288 		}
1289 	}
1290 }
1291 
1292 enum state_return
1293 kb8042_state_machine(struct kb8042 *kb8042, int scancode, boolean_t polled)
1294 {
1295 	switch (kb8042->command_state) {
1296 	case KB_COMMAND_STATE_IDLE:
1297 		break;
1298 
1299 	case KB_COMMAND_STATE_LED:
1300 		if (scancode == KB_ACK) {
1301 			kb8042_send_to_keyboard(kb8042,
1302 				kb8042_xlate_leds(kb8042->leds.desired),
1303 				polled);
1304 			kb8042->leds.commanded = kb8042->leds.desired;
1305 			kb8042->command_state = KB_COMMAND_STATE_WAIT;
1306 			return (STATE_INTERNAL);
1307 		}
1308 		/* Drop normal scan codes through. */
1309 		break;
1310 
1311 	case KB_COMMAND_STATE_WAIT:
1312 		if (scancode == KB_ACK) {
1313 			kb8042->command_state = KB_COMMAND_STATE_IDLE;
1314 			kb8042_start_state_machine(kb8042, polled);
1315 			return (STATE_INTERNAL);
1316 		}
1317 		/* Drop normal scan codes through. */
1318 		break;
1319 	}
1320 	return (STATE_NORMAL);
1321 }
1322 
1323 static int
1324 kb8042_xlate_leds(int led)
1325 {
1326 	int res;
1327 
1328 	res = 0;
1329 
1330 	if (led & LED_NUM_LOCK)
1331 		res |= LED_NUM;
1332 	if (led & LED_SCROLL_LOCK)
1333 		res |= LED_SCR;
1334 	if (led & LED_CAPS_LOCK)
1335 		res |= LED_CAP;
1336 
1337 	return (res);
1338 }
1339 
1340 /*ARGSUSED*/
1341 static void
1342 kb8042_get_initial_leds(
1343     struct kb8042 *kb8042,
1344     int *initial_leds,
1345     int *initial_led_mask)
1346 {
1347 #if	defined(i86pc)
1348 	extern caddr_t	p0_va;
1349 	uint8_t		bios_kb_flag;
1350 
1351 	bios_kb_flag = p0_va[BIOS_KB_FLAG];
1352 
1353 	*initial_led_mask = LED_CAPS_LOCK | LED_NUM_LOCK | LED_SCROLL_LOCK;
1354 	*initial_leds = 0;
1355 	if (bios_kb_flag & BIOS_CAPS_STATE)
1356 		*initial_leds |= LED_CAPS_LOCK;
1357 	if (bios_kb_flag & BIOS_NUM_STATE)
1358 		*initial_leds |= LED_NUM_LOCK;
1359 	if (bios_kb_flag & BIOS_SCROLL_STATE)
1360 		*initial_leds |= LED_SCROLL_LOCK;
1361 #else
1362 	*initial_leds = 0;
1363 	*initial_led_mask = 0;
1364 #endif
1365 }
1366 
1367 #if	defined(KD_DEBUG)
1368 static void
1369 kb8042_debug_hotkey(int scancode)
1370 {
1371 	if (!kb8042_enable_debug_hotkey)
1372 		return;
1373 
1374 	switch (scancode) {
1375 	case 0x44:	/* F10 in Scan Set 1 code.  (Set 2 code is 0x09)  */
1376 		if (!kb8042_debug) {
1377 			prom_printf("\nKeyboard:  normal debugging on\n");
1378 			kb8042_debug = B_TRUE;
1379 		}
1380 		break;
1381 	case 0x43:	/* F9 in Scan Set 1 code.  (Set 2 code is 0x01) */
1382 		if (!kb8042_getchar_debug) {
1383 			prom_printf("\nKeyboard:  getchar debugging on\n");
1384 			kb8042_getchar_debug = B_TRUE;
1385 		}
1386 		break;
1387 	case 0x42:	/* F8 in Scan Set 1 code.  (Set 2 code is 0x0a) */
1388 		if (!kb8042_low_level_debug) {
1389 			prom_printf("\nKeyboard:  low-level debugging on\n");
1390 			kb8042_low_level_debug = B_TRUE;
1391 		}
1392 		break;
1393 	case 0x41:	/* F7 in Scan Set 1 code.  (Set 2 code is 0x83) */
1394 		if (!kb8042_pressrelease_debug) {
1395 			prom_printf(
1396 			    "\nKeyboard:  press/release debugging on\n");
1397 			kb8042_pressrelease_debug = B_TRUE;
1398 		}
1399 		break;
1400 	case 0x3b:	/* F1 in Scan Set 1 code.  (Set 2 code is 0x05) */
1401 		if (kb8042_debug ||
1402 		    kb8042_getchar_debug ||
1403 		    kb8042_low_level_debug ||
1404 		    kb8042_pressrelease_debug) {
1405 			prom_printf("\nKeyboard:  all debugging off\n");
1406 			kb8042_debug = B_FALSE;
1407 			kb8042_getchar_debug = B_FALSE;
1408 			kb8042_low_level_debug = B_FALSE;
1409 			kb8042_pressrelease_debug = B_FALSE;
1410 		}
1411 		break;
1412 	}
1413 }
1414 #endif
1415 
1416 static boolean_t
1417 kb8042_autorepeat_detect(
1418     struct kb8042 *kb8042,
1419     int key_pos,
1420     enum keystate state)
1421 {
1422 	if (state == KEY_RELEASED) {
1423 		if (kb8042->kb_old_key_pos == key_pos)
1424 			kb8042->kb_old_key_pos = 0;
1425 	} else {
1426 		if (kb8042->kb_old_key_pos == key_pos) {
1427 			return (B_TRUE);
1428 		}
1429 		kb8042->kb_old_key_pos = key_pos;
1430 	}
1431 	return (B_FALSE);
1432 }
1433 
1434 /* ARGSUSED */
1435 static void
1436 kb8042_type4_cmd(struct kb8042 *kb8042, int cmd)
1437 {
1438 	switch (cmd) {
1439 	case KBD_CMD_BELL:
1440 		beeper_on(BEEP_TYPE4);
1441 		break;
1442 	case KBD_CMD_NOBELL:
1443 		beeper_off();
1444 		break;
1445 	}
1446 }
1447 
1448 
1449 /*
1450  * This is a pass-thru routine to get a character at poll time.
1451  */
1452 static int
1453 kb8042_polled_getchar(struct cons_polledio_arg *arg)
1454 {
1455 	struct kb8042	*kb8042;
1456 
1457 	kb8042 = (struct kb8042 *)arg;
1458 
1459 	return (kbtrans_getchar(kb8042->hw_kbtrans));
1460 }
1461 
1462 /*
1463  * This is a pass-thru routine to get a character at poll time.
1464  */
1465 static int
1466 kb8042_polled_ischar(struct cons_polledio_arg *arg)
1467 {
1468 	struct kb8042	*kb8042;
1469 
1470 	kb8042 = (struct kb8042 *)arg;
1471 
1472 	return (kbtrans_ischar(kb8042->hw_kbtrans));
1473 }
1474