xref: /illumos-gate/usr/src/uts/common/io/kb8042/kb8042.c (revision 15bfc6b75fa0acab2947977e84e0a9f492aca328)
17c478bd9Sstevel@tonic-gate /*
27c478bd9Sstevel@tonic-gate  * CDDL HEADER START
37c478bd9Sstevel@tonic-gate  *
47c478bd9Sstevel@tonic-gate  * The contents of this file are subject to the terms of the
5281f0747Slt200341  * Common Development and Distribution License (the "License").
6281f0747Slt200341  * You may not use this file except in compliance with the License.
77c478bd9Sstevel@tonic-gate  *
87c478bd9Sstevel@tonic-gate  * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
97c478bd9Sstevel@tonic-gate  * or http://www.opensolaris.org/os/licensing.
107c478bd9Sstevel@tonic-gate  * See the License for the specific language governing permissions
117c478bd9Sstevel@tonic-gate  * and limitations under the License.
127c478bd9Sstevel@tonic-gate  *
137c478bd9Sstevel@tonic-gate  * When distributing Covered Code, include this CDDL HEADER in each
147c478bd9Sstevel@tonic-gate  * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
157c478bd9Sstevel@tonic-gate  * If applicable, add the following below this CDDL HEADER, with the
167c478bd9Sstevel@tonic-gate  * fields enclosed by brackets "[]" replaced with your own identifying
177c478bd9Sstevel@tonic-gate  * information: Portions Copyright [yyyy] [name of copyright owner]
187c478bd9Sstevel@tonic-gate  *
197c478bd9Sstevel@tonic-gate  * CDDL HEADER END
207c478bd9Sstevel@tonic-gate  */
217c478bd9Sstevel@tonic-gate /*	Copyright (c) 1990, 1991 UNIX System Laboratories, Inc.	*/
227c478bd9Sstevel@tonic-gate /*	Copyright (c) 1984, 1986, 1987, 1988, 1989, 1990 AT&T	*/
237c478bd9Sstevel@tonic-gate /*	  All Rights Reserved  	*/
247c478bd9Sstevel@tonic-gate 
257c478bd9Sstevel@tonic-gate /*
2648633f18SJan Setje-Eilers  * Copyright 2009 Sun Microsystems, Inc.  All rights reserved.
277c478bd9Sstevel@tonic-gate  * Use is subject to license terms.
287c478bd9Sstevel@tonic-gate  */
297c478bd9Sstevel@tonic-gate 
30e8ed0869SJohn Beck #define	KEYMAP_SIZE_VARIABLE
31e8ed0869SJohn Beck 
327c478bd9Sstevel@tonic-gate #include <sys/types.h>
337c478bd9Sstevel@tonic-gate #include <sys/errno.h>
347c478bd9Sstevel@tonic-gate #include <sys/inline.h>
357c478bd9Sstevel@tonic-gate #include <sys/termio.h>
367c478bd9Sstevel@tonic-gate #include <sys/stropts.h>
377c478bd9Sstevel@tonic-gate #include <sys/termios.h>
387c478bd9Sstevel@tonic-gate #include <sys/stream.h>
397c478bd9Sstevel@tonic-gate #include <sys/strtty.h>
407c478bd9Sstevel@tonic-gate #include <sys/strsubr.h>
417c478bd9Sstevel@tonic-gate #include <sys/strsun.h>
427c478bd9Sstevel@tonic-gate #include <sys/ddi.h>
437c478bd9Sstevel@tonic-gate #include <sys/sunddi.h>
447c478bd9Sstevel@tonic-gate #include <sys/note.h>
457c478bd9Sstevel@tonic-gate #include "sys/consdev.h"
467c478bd9Sstevel@tonic-gate #include <sys/kbd.h>
477c478bd9Sstevel@tonic-gate #include <sys/kbtrans.h>
487c478bd9Sstevel@tonic-gate #include "kb8042.h"
497c478bd9Sstevel@tonic-gate 
507c478bd9Sstevel@tonic-gate #include <sys/i8042.h>
517c478bd9Sstevel@tonic-gate 
527c478bd9Sstevel@tonic-gate #include "sys/kbio.h"		/* for KIOCSLAYOUT */
537c478bd9Sstevel@tonic-gate #include "sys/stat.h"
547c478bd9Sstevel@tonic-gate #include "sys/reboot.h"
557c478bd9Sstevel@tonic-gate #include <sys/promif.h>
567c478bd9Sstevel@tonic-gate #include <sys/beep.h>
57c35aa225Smarx #include <sys/inttypes.h>
587c478bd9Sstevel@tonic-gate 
597c478bd9Sstevel@tonic-gate /*
607c478bd9Sstevel@tonic-gate  * For any keyboard, there is a unique code describing the position
617c478bd9Sstevel@tonic-gate  * of the key on a keyboard. We refer to the code as "station number".
627c478bd9Sstevel@tonic-gate  * The following table is used to map the station numbers from ps2
637c478bd9Sstevel@tonic-gate  * AT/XT keyboards to that of a USB one.
64fd9cb95cSsethg  *
65fd9cb95cSsethg  * A mapping was added for entry K8042_STOP, to map to USB key code 120 (which
66fd9cb95cSsethg  * maps to the STOP key) when in KB_USB mode, and maps to a HOLE entry
67fd9cb95cSsethg  * when in KB_PC mode.  Note that this does not need to be made conditional
68fd9cb95cSsethg  * on the architecture for which this module is complied because there are no
69fd9cb95cSsethg  * keys that map to K8042_STOP on non-SPARC platforms.
707c478bd9Sstevel@tonic-gate  */
717c478bd9Sstevel@tonic-gate static kbtrans_key_t keytab_pc2usb[KBTRANS_KEYNUMS_MAX] = {
727c478bd9Sstevel@tonic-gate /*  0 */	0,	53,	30,	31,	32,	33,	34,	35,
737c478bd9Sstevel@tonic-gate /*  8 */	36,	37,	38,	39,	45,	46,	137,	42,
747c478bd9Sstevel@tonic-gate /* 16 */	43,	20,	26,	8,	21,	23,	28,	24,
757c478bd9Sstevel@tonic-gate /* 24 */	12,	18,	19,	47,	48,	49,	57,	4,
767c478bd9Sstevel@tonic-gate /* 32 */	22,	7,	9,	10,	11,	13,	14,	15,
777c478bd9Sstevel@tonic-gate /* 40 */	51,	52,	50,	40,	225,	100,	29,	27,
787c478bd9Sstevel@tonic-gate /* 48 */	6,	25,	5,	17,	16,	54,	55,	56,
797c478bd9Sstevel@tonic-gate /* 56 */	135,	229,	224,	227,	226,	44,	230,	231,
807c478bd9Sstevel@tonic-gate /* 64 */	228,	101,	0,	0,	0,	0,	0,	0,
817c478bd9Sstevel@tonic-gate /* 72 */	0,	0,	0,	73,	76,	0,	0,	80,
827c478bd9Sstevel@tonic-gate /* 80 */	74,	77,	0,	82,	81,	75,	78,	0,
837c478bd9Sstevel@tonic-gate /* 88 */	0,	79,	83,	95,	92,	89,	0,	84,
847c478bd9Sstevel@tonic-gate /* 96 */	96,	93,	90,	98,	85,	97,	94,	91,
857c478bd9Sstevel@tonic-gate /* 104 */	99,	86,	87,	133,	88,	0,	41,	0,
867c478bd9Sstevel@tonic-gate /* 112 */	58,	59,	60,	61,	62,	63,	64,	65,
877c478bd9Sstevel@tonic-gate /* 120 */	66,	67,	68,	69,	70,	71,	72,	0,
887c478bd9Sstevel@tonic-gate /* 128 */	0,	0,	0,	139,	138,	136,	0,	0,
897c478bd9Sstevel@tonic-gate /* 136 */	0,	0,	0,	0,	0,	0,	0,	0,
907c478bd9Sstevel@tonic-gate /* 144 */	0,	0,	0,	0,	0,	0,	0,	0,
917c478bd9Sstevel@tonic-gate /* 152 */	0,	0,	0,	0,	0,	0,	0,	0,
92fd9cb95cSsethg /* 160 */	120,	0,	0,	0,	0,	0,	0,	0,
937c478bd9Sstevel@tonic-gate /* 168 */	0,	0,	0,	0,	0,	0,	0,	0,
947c478bd9Sstevel@tonic-gate /* 176 */	0,	0,	0,	0,	0,	0,	0,	0,
957c478bd9Sstevel@tonic-gate /* 184 */	0,	0,	0,	0,	0,	0,	0,	0,
967c478bd9Sstevel@tonic-gate /* 192 */	0,	0,	0,	0,	0,	0,	0,	0,
977c478bd9Sstevel@tonic-gate /* 200 */	0,	0,	0,	0,	0,	0,	0,	0,
987c478bd9Sstevel@tonic-gate /* 208 */	0,	0,	0,	0,	0,	0,	0,	0,
997c478bd9Sstevel@tonic-gate /* 216 */	0,	0,	0,	0,	0,	0,	0,	0,
1007c478bd9Sstevel@tonic-gate /* 224 */	0,	0,	0,	0,	0,	0,	0,	0,
1011841b879SSeth Goldberg /* 232 */	0,	128,	129,	127,	0,	0,	0,	0,
1027c478bd9Sstevel@tonic-gate /* 240 */	0,	0,	0,	0,	0,	0,	0,	0,
1037c478bd9Sstevel@tonic-gate /* 248 */	0,	0,	0,	0
1047c478bd9Sstevel@tonic-gate };
1057c478bd9Sstevel@tonic-gate 
106fd9cb95cSsethg #ifdef __sparc
107fd9cb95cSsethg #define	USECS_PER_WAIT 100
108fd9cb95cSsethg #define	MAX_WAIT_USECS 100000 /* in usecs = 100 ms */
109fd9cb95cSsethg #define	MIN_DELAY_USECS USECS_PER_WAIT
110fd9cb95cSsethg 
111fd9cb95cSsethg boolean_t kb8042_warn_unknown_scanset = B_TRUE;
112fd9cb95cSsethg int kb8042_default_scanset = 2;
113fd9cb95cSsethg 
114fd9cb95cSsethg #endif
115fd9cb95cSsethg 
116*15bfc6b7SSeth Goldberg #define	MAX_KB8042_WAIT_MAX_MS	500		/* 500ms total */
117*15bfc6b7SSeth Goldberg #define	MAX_KB8042_RETRIES	5
118*15bfc6b7SSeth Goldberg 
1197c478bd9Sstevel@tonic-gate enum state_return { STATE_NORMAL, STATE_INTERNAL };
1207c478bd9Sstevel@tonic-gate 
121fd9cb95cSsethg static void kb8042_init(struct kb8042 *kb8042, boolean_t from_resume);
1227c478bd9Sstevel@tonic-gate static uint_t kb8042_intr(caddr_t arg);
1237c478bd9Sstevel@tonic-gate static void kb8042_wait_poweron(struct kb8042 *kb8042);
1247c478bd9Sstevel@tonic-gate static void kb8042_send_to_keyboard(struct kb8042 *, int, boolean_t);
1257c478bd9Sstevel@tonic-gate static int kb8042_xlate_leds(int);
126fd9cb95cSsethg static void kb8042_setled(struct kb8042 *, int led_state, boolean_t polled);
1277c478bd9Sstevel@tonic-gate static void kb8042_streams_setled(struct kbtrans_hardware *hw, int led_state);
1287c478bd9Sstevel@tonic-gate static void kb8042_polled_setled(struct kbtrans_hardware *hw, int led_state);
1297c478bd9Sstevel@tonic-gate static boolean_t kb8042_polled_keycheck(
1307c478bd9Sstevel@tonic-gate 			struct kbtrans_hardware *hw, int *key,
1317c478bd9Sstevel@tonic-gate 			enum keystate *state);
1327c478bd9Sstevel@tonic-gate static void kb8042_get_initial_leds(struct kb8042 *, int *, int *);
1337c478bd9Sstevel@tonic-gate static boolean_t kb8042_autorepeat_detect(struct kb8042 *kb8042, int key_pos,
1347c478bd9Sstevel@tonic-gate 			enum keystate state);
1357c478bd9Sstevel@tonic-gate static void kb8042_type4_cmd(struct kb8042 *kb8042, int cmd);
1367c478bd9Sstevel@tonic-gate static void kb8042_ioctlmsg(struct kb8042 *kb8042, queue_t *, mblk_t *);
1377c478bd9Sstevel@tonic-gate static void kb8042_iocdatamsg(queue_t *, mblk_t *);
1387c478bd9Sstevel@tonic-gate static void kb8042_process_key(struct kb8042 *, kbtrans_key_t, enum keystate);
139281f0747Slt200341 static int kb8042_polled_ischar(cons_polledio_arg_t arg);
140281f0747Slt200341 static int kb8042_polled_getchar(cons_polledio_arg_t arg);
141fd9cb95cSsethg static void kb8042_cleanup(struct kb8042 *kb8042);
1427c478bd9Sstevel@tonic-gate 
1437c478bd9Sstevel@tonic-gate static struct kbtrans_callbacks kb8042_callbacks = {
1447c478bd9Sstevel@tonic-gate 	kb8042_streams_setled,
1457c478bd9Sstevel@tonic-gate 	kb8042_polled_setled,
1467c478bd9Sstevel@tonic-gate 	kb8042_polled_keycheck,
1477c478bd9Sstevel@tonic-gate };
1487c478bd9Sstevel@tonic-gate 
1497c478bd9Sstevel@tonic-gate extern struct keyboard keyindex_pc;
1507c478bd9Sstevel@tonic-gate 
1517c478bd9Sstevel@tonic-gate #define	DRIVER_NAME(dip) ddi_driver_name(dip)
1527c478bd9Sstevel@tonic-gate 
1537c478bd9Sstevel@tonic-gate static	char	module_name[] = "kb8042";
1547c478bd9Sstevel@tonic-gate 
1557c478bd9Sstevel@tonic-gate static int kb8042_open(queue_t *qp, dev_t *devp, int flag, int sflag,
1567c478bd9Sstevel@tonic-gate 			cred_t *credp);
1577c478bd9Sstevel@tonic-gate static int kb8042_close(queue_t *qp, int flag, cred_t *credp);
1587c478bd9Sstevel@tonic-gate static int kb8042_wsrv();
1597c478bd9Sstevel@tonic-gate 
1607c478bd9Sstevel@tonic-gate struct module_info kb8042_sinfo = {
1617c478bd9Sstevel@tonic-gate 	42,		/* Module ID */
1627c478bd9Sstevel@tonic-gate 	module_name,
1637c478bd9Sstevel@tonic-gate 	0, 32,		/* Minimum and maximum packet sizes */
1647c478bd9Sstevel@tonic-gate 	256, 128	/* High and low water marks */
1657c478bd9Sstevel@tonic-gate };
1667c478bd9Sstevel@tonic-gate 
1677c478bd9Sstevel@tonic-gate static struct qinit kb8042_rinit = {
1687c478bd9Sstevel@tonic-gate 	NULL, NULL, kb8042_open, kb8042_close, NULL, &kb8042_sinfo, NULL
1697c478bd9Sstevel@tonic-gate };
1707c478bd9Sstevel@tonic-gate 
1717c478bd9Sstevel@tonic-gate static struct qinit kb8042_winit = {
1727c478bd9Sstevel@tonic-gate 	putq, kb8042_wsrv, kb8042_open, kb8042_close, NULL, &kb8042_sinfo, NULL
1737c478bd9Sstevel@tonic-gate };
1747c478bd9Sstevel@tonic-gate 
1757c478bd9Sstevel@tonic-gate struct streamtab
1767c478bd9Sstevel@tonic-gate 	kb8042_str_info = { &kb8042_rinit, &kb8042_winit, NULL, NULL };
1777c478bd9Sstevel@tonic-gate 
1787c478bd9Sstevel@tonic-gate struct kb8042	Kdws = {0};
179fd9cb95cSsethg static dev_info_t *kb8042_dip = NULL;
1807c478bd9Sstevel@tonic-gate 
1817c478bd9Sstevel@tonic-gate static int kb8042_getinfo(dev_info_t *dip, ddi_info_cmd_t infocmd, void *arg,
1827c478bd9Sstevel@tonic-gate 		void **result);
1837c478bd9Sstevel@tonic-gate static int kb8042_attach(dev_info_t *, ddi_attach_cmd_t);
184fd9cb95cSsethg static int kb8042_detach(dev_info_t *, ddi_detach_cmd_t);
1857c478bd9Sstevel@tonic-gate 
1867c478bd9Sstevel@tonic-gate static 	struct cb_ops cb_kb8042_ops = {
1877c478bd9Sstevel@tonic-gate 	nulldev,		/* cb_open */
1887c478bd9Sstevel@tonic-gate 	nulldev,		/* cb_close */
1897c478bd9Sstevel@tonic-gate 	nodev,			/* cb_strategy */
1907c478bd9Sstevel@tonic-gate 	nodev,			/* cb_print */
1917c478bd9Sstevel@tonic-gate 	nodev,			/* cb_dump */
1927c478bd9Sstevel@tonic-gate 	nodev,			/* cb_read */
1937c478bd9Sstevel@tonic-gate 	nodev,			/* cb_write */
1947c478bd9Sstevel@tonic-gate 	nodev,			/* cb_ioctl */
1957c478bd9Sstevel@tonic-gate 	nodev,			/* cb_devmap */
1967c478bd9Sstevel@tonic-gate 	nodev,			/* cb_mmap */
1977c478bd9Sstevel@tonic-gate 	nodev,			/* cb_segmap */
1987c478bd9Sstevel@tonic-gate 	nochpoll,		/* cb_chpoll */
1997c478bd9Sstevel@tonic-gate 	ddi_prop_op,		/* cb_prop_op */
2007c478bd9Sstevel@tonic-gate 	&kb8042_str_info,	/* cb_stream */
2017c478bd9Sstevel@tonic-gate 	D_MP
2027c478bd9Sstevel@tonic-gate };
2037c478bd9Sstevel@tonic-gate 
2047c478bd9Sstevel@tonic-gate struct dev_ops kb8042_ops = {
2057c478bd9Sstevel@tonic-gate 	DEVO_REV,		/* devo_rev */
2067c478bd9Sstevel@tonic-gate 	0,			/* devo_refcnt */
2077c478bd9Sstevel@tonic-gate 	kb8042_getinfo,		/* devo_getinfo */
2087c478bd9Sstevel@tonic-gate 	nulldev,		/* devo_identify */
2097c478bd9Sstevel@tonic-gate 	nulldev,		/* devo_probe */
2107c478bd9Sstevel@tonic-gate 	kb8042_attach,		/* devo_attach */
211fd9cb95cSsethg 	kb8042_detach,		/* devo_detach */
2127c478bd9Sstevel@tonic-gate 	nodev,			/* devo_reset */
2137c478bd9Sstevel@tonic-gate 	&cb_kb8042_ops,		/* devo_cb_ops */
21419397407SSherry Moore 	(struct bus_ops *)NULL,	/* devo_bus_ops */
21519397407SSherry Moore 	NULL,			/* devo_power */
21619397407SSherry Moore 	ddi_quiesce_not_needed,	/* devo_quiesce */
2177c478bd9Sstevel@tonic-gate };
2187c478bd9Sstevel@tonic-gate 
2197c478bd9Sstevel@tonic-gate 
2207c478bd9Sstevel@tonic-gate /*
2217c478bd9Sstevel@tonic-gate  * This is the loadable module wrapper.
2227c478bd9Sstevel@tonic-gate  */
2237c478bd9Sstevel@tonic-gate #include <sys/modctl.h>
2247c478bd9Sstevel@tonic-gate 
2257c478bd9Sstevel@tonic-gate /*
2267c478bd9Sstevel@tonic-gate  * Module linkage information for the kernel.
2277c478bd9Sstevel@tonic-gate  */
2287c478bd9Sstevel@tonic-gate static struct modldrv modldrv = {
2297c478bd9Sstevel@tonic-gate 	&mod_driverops, /* Type of module.  This one is a driver */
230bb2d7d5eSSeth Goldberg 	"PS/2 keyboard driver",
2317c478bd9Sstevel@tonic-gate 	&kb8042_ops,	/* driver ops */
2327c478bd9Sstevel@tonic-gate };
2337c478bd9Sstevel@tonic-gate 
2347c478bd9Sstevel@tonic-gate static struct modlinkage modlinkage = {
2357c478bd9Sstevel@tonic-gate 	MODREV_1,
2367c478bd9Sstevel@tonic-gate 	(void *) &modldrv,
2377c478bd9Sstevel@tonic-gate 	NULL
2387c478bd9Sstevel@tonic-gate };
2397c478bd9Sstevel@tonic-gate 
2407c478bd9Sstevel@tonic-gate int
2417c478bd9Sstevel@tonic-gate _init(void)
2427c478bd9Sstevel@tonic-gate {
2437c478bd9Sstevel@tonic-gate 	int	rv;
2447c478bd9Sstevel@tonic-gate 
2457c478bd9Sstevel@tonic-gate 	rv = mod_install(&modlinkage);
2467c478bd9Sstevel@tonic-gate 	return (rv);
2477c478bd9Sstevel@tonic-gate }
2487c478bd9Sstevel@tonic-gate 
2497c478bd9Sstevel@tonic-gate 
2507c478bd9Sstevel@tonic-gate int
2517c478bd9Sstevel@tonic-gate _fini(void)
2527c478bd9Sstevel@tonic-gate {
2537c478bd9Sstevel@tonic-gate 	return (mod_remove(&modlinkage));
2547c478bd9Sstevel@tonic-gate }
2557c478bd9Sstevel@tonic-gate 
2567c478bd9Sstevel@tonic-gate int
2577c478bd9Sstevel@tonic-gate _info(struct modinfo *modinfop)
2587c478bd9Sstevel@tonic-gate {
2597c478bd9Sstevel@tonic-gate 	return (mod_info(&modlinkage, modinfop));
2607c478bd9Sstevel@tonic-gate }
2617c478bd9Sstevel@tonic-gate 
262fd9cb95cSsethg #ifdef __sparc
263fd9cb95cSsethg static boolean_t
264fd9cb95cSsethg kb8042_is_input_avail(struct kb8042 *kb8042, int timeout_usec, boolean_t polled)
265fd9cb95cSsethg {
266fd9cb95cSsethg 	int i;
267fd9cb95cSsethg 	int port = (polled == B_TRUE) ? I8042_POLL_INPUT_AVAIL :
268fd9cb95cSsethg 	    I8042_INT_INPUT_AVAIL;
269fd9cb95cSsethg 	int reps = timeout_usec / USECS_PER_WAIT;
270fd9cb95cSsethg 
271fd9cb95cSsethg 	for (i = 0; i < reps; i++) {
272fd9cb95cSsethg 		if (ddi_get8(kb8042->handle, kb8042->addr + port) != 0)
273fd9cb95cSsethg 			return (B_TRUE);
274fd9cb95cSsethg 
275fd9cb95cSsethg 		if (i < (reps - 1))
276fd9cb95cSsethg 			drv_usecwait(USECS_PER_WAIT);
277fd9cb95cSsethg 	}
278fd9cb95cSsethg 	return (B_FALSE);
279fd9cb95cSsethg }
280fd9cb95cSsethg 
281fd9cb95cSsethg static void
282fd9cb95cSsethg kb8042_clear_input_buffer(struct kb8042 *kb8042, boolean_t polled)
283fd9cb95cSsethg {
284fd9cb95cSsethg 	int port = (polled == B_TRUE) ? I8042_POLL_INPUT_DATA :
285fd9cb95cSsethg 	    I8042_INT_INPUT_DATA;
286fd9cb95cSsethg 
287fd9cb95cSsethg 	while (kb8042_is_input_avail(kb8042, MIN_DELAY_USECS, polled)) {
288fd9cb95cSsethg 		(void) ddi_get8(kb8042->handle, kb8042->addr + port);
289fd9cb95cSsethg 	}
290fd9cb95cSsethg }
291fd9cb95cSsethg 
292*15bfc6b7SSeth Goldberg /*
293*15bfc6b7SSeth Goldberg  * kb8042_send_and_expect does all its I/O via polling interfaces
294*15bfc6b7SSeth Goldberg  */
295fd9cb95cSsethg static boolean_t
296fd9cb95cSsethg kb8042_send_and_expect(struct kb8042 *kb8042, uint8_t send, uint8_t expect,
297*15bfc6b7SSeth Goldberg     int timeout, int *error, uint8_t *got)
298fd9cb95cSsethg {
299fd9cb95cSsethg 	uint8_t datab;
300fd9cb95cSsethg 	int err;
301fd9cb95cSsethg 	boolean_t rval;
302fd9cb95cSsethg 
303*15bfc6b7SSeth Goldberg 	ddi_put8(kb8042->handle,
304*15bfc6b7SSeth Goldberg 	    kb8042->addr + I8042_POLL_OUTPUT_DATA, send);
305fd9cb95cSsethg 
306*15bfc6b7SSeth Goldberg 	if (kb8042_is_input_avail(kb8042, timeout, B_TRUE)) {
307fd9cb95cSsethg 		err = 0;
308*15bfc6b7SSeth Goldberg 		datab = ddi_get8(kb8042->handle,
309*15bfc6b7SSeth Goldberg 		    kb8042->addr + I8042_POLL_INPUT_DATA);
310fd9cb95cSsethg 		rval = ((datab == expect) ? B_TRUE : B_FALSE);
311fd9cb95cSsethg 	} else {
312fd9cb95cSsethg 		err = EAGAIN;
313fd9cb95cSsethg 		rval = B_FALSE;
314fd9cb95cSsethg 	}
315fd9cb95cSsethg 
316fd9cb95cSsethg 	if (error != NULL)
317fd9cb95cSsethg 		*error = err;
318fd9cb95cSsethg 	if (got != NULL)
319fd9cb95cSsethg 		*got = datab;
320fd9cb95cSsethg 	return (rval);
321fd9cb95cSsethg }
322fd9cb95cSsethg 
323fd9cb95cSsethg static const char *
324fd9cb95cSsethg kb8042_error_string(int errcode)
325fd9cb95cSsethg {
326fd9cb95cSsethg 	switch (errcode) {
327fd9cb95cSsethg 	case EAGAIN:
328fd9cb95cSsethg 		return ("Timed out");
329fd9cb95cSsethg 	default:
330fd9cb95cSsethg 		return ("Unknown error");
331fd9cb95cSsethg 	}
332fd9cb95cSsethg }
333fd9cb95cSsethg 
334*15bfc6b7SSeth Goldberg /*
335*15bfc6b7SSeth Goldberg  * kb8042_read_scanset works properly because it is called before ddi_add_intr
336*15bfc6b7SSeth Goldberg  * (if it is called after ddi_add_intr, i8042_intr would call kb8042_intr
337*15bfc6b7SSeth Goldberg  * instead of just storing the data that comes in from the keyboard, which
338*15bfc6b7SSeth Goldberg  * would prevent the code here from getting it.)
339*15bfc6b7SSeth Goldberg  */
340fd9cb95cSsethg static int
341*15bfc6b7SSeth Goldberg kb8042_read_scanset(struct kb8042 *kb8042)
342fd9cb95cSsethg {
343fd9cb95cSsethg 	int scanset = -1;
344fd9cb95cSsethg 	int err;
345fd9cb95cSsethg 	uint8_t got;
346fd9cb95cSsethg 
347fd9cb95cSsethg 	kb8042_clear_input_buffer(kb8042, B_TRUE);
348fd9cb95cSsethg 
349fd9cb95cSsethg 	/*
350fd9cb95cSsethg 	 * Send a "change scan code set" command to the keyboard.
351fd9cb95cSsethg 	 * It should respond with an ACK.
352fd9cb95cSsethg 	 */
353*15bfc6b7SSeth Goldberg 	if (kb8042_send_and_expect(kb8042, KB_SET_SCAN, KB_ACK, MAX_WAIT_USECS,
354*15bfc6b7SSeth Goldberg 	    &err, &got) != B_TRUE) {
355fd9cb95cSsethg 		goto fail_read_scanset;
356fd9cb95cSsethg 	}
357fd9cb95cSsethg 
358fd9cb95cSsethg 	/*
359bb2d7d5eSSeth Goldberg 	 * Send a 0.  The keyboard should ACK the 0, then it should send the
360bb2d7d5eSSeth Goldberg 	 * scan code set in use.
361fd9cb95cSsethg 	 */
362*15bfc6b7SSeth Goldberg 	if (kb8042_send_and_expect(kb8042, 0, KB_ACK, MAX_WAIT_USECS, &err,
363*15bfc6b7SSeth Goldberg 	    &got) != B_TRUE) {
364fd9cb95cSsethg 		goto fail_read_scanset;
365fd9cb95cSsethg 	}
366fd9cb95cSsethg 
367fd9cb95cSsethg 	/*
368fd9cb95cSsethg 	 * The next input byte from the keyboard should be the scan code
369fd9cb95cSsethg 	 * set in use, though some keyboards like to send a few more acks
370fd9cb95cSsethg 	 * just for fun, so blow past those to get the keyboard scan code.
371fd9cb95cSsethg 	 */
372fd9cb95cSsethg 	while (kb8042_is_input_avail(kb8042, MAX_WAIT_USECS, B_TRUE) &&
373*15bfc6b7SSeth Goldberg 	    (scanset = ddi_get8(kb8042->handle,
374*15bfc6b7SSeth Goldberg 	    kb8042->addr + I8042_POLL_INPUT_DATA)) == KB_ACK)
375fd9cb95cSsethg 		;
376fd9cb95cSsethg 
377*15bfc6b7SSeth Goldberg #ifdef DEBUG
378fd9cb95cSsethg 	cmn_err(CE_NOTE, "!Scan code set from keyboard is `%d'.",
379fd9cb95cSsethg 	    scanset);
380fd9cb95cSsethg #endif
381fd9cb95cSsethg 
382fd9cb95cSsethg 	return (scanset);
383fd9cb95cSsethg 
384fd9cb95cSsethg fail_read_scanset:
385*15bfc6b7SSeth Goldberg #ifdef DEBUG
386fd9cb95cSsethg 	if (err == 0)
387fd9cb95cSsethg 		cmn_err(CE_NOTE, "Could not read current scan set from "
388fd9cb95cSsethg 		    "keyboard: %s. (Expected 0x%x, but got 0x%x).",
389fd9cb95cSsethg 		    kb8042_error_string(err), KB_ACK, got);
390fd9cb95cSsethg 	else
391fd9cb95cSsethg 		cmn_err(CE_NOTE, "Could not read current scan set from "
392fd9cb95cSsethg 		    "keyboard: %s.", kb8042_error_string(err));
393fd9cb95cSsethg #endif
394fd9cb95cSsethg 	return (-1);
395fd9cb95cSsethg }
396fd9cb95cSsethg #endif
397fd9cb95cSsethg 
3987c478bd9Sstevel@tonic-gate static int
3997c478bd9Sstevel@tonic-gate kb8042_attach(dev_info_t *devi, ddi_attach_cmd_t cmd)
4007c478bd9Sstevel@tonic-gate {
4017c478bd9Sstevel@tonic-gate 	int	rc;
402fd9cb95cSsethg 	int	scanset;
403fd9cb95cSsethg 	int	leds;
4047c478bd9Sstevel@tonic-gate 
405fd9cb95cSsethg 	struct kb8042	*kb8042 = &Kdws;
4067c478bd9Sstevel@tonic-gate 	static ddi_device_acc_attr_t attr = {
4077c478bd9Sstevel@tonic-gate 		DDI_DEVICE_ATTR_V0,
4087c478bd9Sstevel@tonic-gate 		DDI_NEVERSWAP_ACC,
4097c478bd9Sstevel@tonic-gate 		DDI_STRICTORDER_ACC,
4107c478bd9Sstevel@tonic-gate 	};
4117c478bd9Sstevel@tonic-gate 
412fd9cb95cSsethg 	switch (cmd) {
413fd9cb95cSsethg 	case DDI_RESUME:
414fd9cb95cSsethg 		leds = kb8042->leds.commanded;
415fd9cb95cSsethg 		kb8042->w_init = 0;
416fd9cb95cSsethg 		kb8042_init(kb8042, B_TRUE);
417fd9cb95cSsethg 		kb8042_setled(kb8042, leds, B_FALSE);
4182df1fe9cSrandyf 		mutex_enter(&kb8042->w_hw_mutex);
4192df1fe9cSrandyf 		kb8042->suspended = B_FALSE;
4202df1fe9cSrandyf 		if (kb8042->w_qp != NULL) {
4212df1fe9cSrandyf 			enableok(WR(kb8042->w_qp));
4222df1fe9cSrandyf 			qenable(WR(kb8042->w_qp));
4232df1fe9cSrandyf 		}
4242df1fe9cSrandyf 		cv_broadcast(&kb8042->suspend_cv);
4252df1fe9cSrandyf 		mutex_exit(&kb8042->w_hw_mutex);
426fd9cb95cSsethg 		return (DDI_SUCCESS);
427fd9cb95cSsethg 
428fd9cb95cSsethg 	case DDI_ATTACH:
429fd9cb95cSsethg 		if (kb8042_dip != NULL)
4307c478bd9Sstevel@tonic-gate 			return (DDI_FAILURE);
431fd9cb95cSsethg 		/* The rest of the function is for attach */
432fd9cb95cSsethg 		break;
4337c478bd9Sstevel@tonic-gate 
434fd9cb95cSsethg 	default:
435fd9cb95cSsethg 		return (DDI_FAILURE);
436fd9cb95cSsethg 	}
4377c478bd9Sstevel@tonic-gate 
4387c478bd9Sstevel@tonic-gate 	kb8042->debugger.mod1 = 58;	/* Left Ctrl */
4397c478bd9Sstevel@tonic-gate 	kb8042->debugger.mod2 = 60;	/* Left Alt */
4407c478bd9Sstevel@tonic-gate 	kb8042->debugger.trigger = 33;	/* D */
4417c478bd9Sstevel@tonic-gate 	kb8042->debugger.mod1_down = B_FALSE;
4427c478bd9Sstevel@tonic-gate 	kb8042->debugger.mod2_down = B_FALSE;
4437c478bd9Sstevel@tonic-gate 	kb8042->debugger.enabled = B_FALSE;
4447c478bd9Sstevel@tonic-gate 
445fd9cb95cSsethg 	kb8042_dip = devi;
446fd9cb95cSsethg 	kb8042->init_state = KB8042_UNINITIALIZED;
447fd9cb95cSsethg 
4487c478bd9Sstevel@tonic-gate 	kb8042->polled_synthetic_release_pending = B_FALSE;
4497c478bd9Sstevel@tonic-gate 
4507c478bd9Sstevel@tonic-gate 	if (ddi_create_minor_node(devi, module_name, S_IFCHR, 0,
4517c478bd9Sstevel@tonic-gate 	    DDI_NT_KEYBOARD, 0) == DDI_FAILURE) {
452fd9cb95cSsethg 		goto failure;
4537c478bd9Sstevel@tonic-gate 	}
454fd9cb95cSsethg 
455fd9cb95cSsethg 	kb8042->init_state |= KB8042_MINOR_NODE_CREATED;
4567c478bd9Sstevel@tonic-gate 
4577c478bd9Sstevel@tonic-gate 	rc = ddi_regs_map_setup(devi, 0, (caddr_t *)&kb8042->addr,
4587c478bd9Sstevel@tonic-gate 	    (offset_t)0, (offset_t)0, &attr, &kb8042->handle);
4597c478bd9Sstevel@tonic-gate 	if (rc != DDI_SUCCESS) {
460*15bfc6b7SSeth Goldberg #ifdef DEBUG
4617c478bd9Sstevel@tonic-gate 		cmn_err(CE_WARN, "kb8042_attach:  can't map registers");
4627c478bd9Sstevel@tonic-gate #endif
463fd9cb95cSsethg 		goto failure;
4647c478bd9Sstevel@tonic-gate 	}
4657c478bd9Sstevel@tonic-gate 
466fd9cb95cSsethg 	kb8042->init_state |= KB8042_REGS_MAPPED;
467fd9cb95cSsethg 
4687c478bd9Sstevel@tonic-gate 	if (ddi_get_iblock_cookie(devi, 0, &kb8042->w_iblock) !=
4697c478bd9Sstevel@tonic-gate 	    DDI_SUCCESS) {
4707c478bd9Sstevel@tonic-gate 		cmn_err(CE_WARN, "kb8042_attach:  Can't get iblock cookie");
471fd9cb95cSsethg 		goto failure;
4727c478bd9Sstevel@tonic-gate 	}
4737c478bd9Sstevel@tonic-gate 
4747c478bd9Sstevel@tonic-gate 	mutex_init(&kb8042->w_hw_mutex, NULL, MUTEX_DRIVER, kb8042->w_iblock);
4752df1fe9cSrandyf 	cv_init(&kb8042->ops_cv, NULL, CV_DRIVER, NULL);
4762df1fe9cSrandyf 	cv_init(&kb8042->suspend_cv, NULL, CV_DRIVER, NULL);
477*15bfc6b7SSeth Goldberg 	cv_init(&kb8042->cmd_cv, NULL, CV_DRIVER, NULL);
478fd9cb95cSsethg 	kb8042->init_state |= KB8042_HW_MUTEX_INITTED;
479fd9cb95cSsethg 
480fd9cb95cSsethg 	kb8042_init(kb8042, B_FALSE);
481fd9cb95cSsethg 
482fd9cb95cSsethg #ifdef __sparc
483fd9cb95cSsethg 	/* Detect the scan code set currently in use */
484*15bfc6b7SSeth Goldberg 	scanset = kb8042_read_scanset(kb8042);
485fd9cb95cSsethg 
486fd9cb95cSsethg 	if (scanset < 0 && kb8042_warn_unknown_scanset) {
487fd9cb95cSsethg 
488fd9cb95cSsethg 		cmn_err(CE_WARN, "Cannot determine keyboard scan code set ");
489fd9cb95cSsethg 		cmn_err(CE_CONT, "(is the keyboard plugged in?). ");
490fd9cb95cSsethg 		cmn_err(CE_CONT, "Defaulting to scan code set %d.  If the "
491fd9cb95cSsethg 		    "keyboard does not ", kb8042_default_scanset);
492fd9cb95cSsethg 		cmn_err(CE_CONT, "work properly, add "
493fd9cb95cSsethg 		    "`set kb8042:kb8042_default_scanset=%d' to /etc/system ",
494fd9cb95cSsethg 		    (kb8042_default_scanset == 1) ? 2 : 1);
495fd9cb95cSsethg 		cmn_err(CE_CONT, "(via network or with a USB keyboard) and "
496fd9cb95cSsethg 		    "restart the system.  If you ");
497fd9cb95cSsethg 		cmn_err(CE_CONT, "do not want to see this message in the "
498fd9cb95cSsethg 		    "future, add ");
499fd9cb95cSsethg 		cmn_err(CE_CONT, "`set kb8042:kb8042_warn_unknown_scanset=0' "
500fd9cb95cSsethg 		    "to /etc/system.\n");
501fd9cb95cSsethg 
502fd9cb95cSsethg 		/* Use the default scan code set. */
503fd9cb95cSsethg 		scanset = kb8042_default_scanset;
504fd9cb95cSsethg 	}
505fd9cb95cSsethg #else
506fd9cb95cSsethg 	/* x86 systems use scan code set 1 -- no detection required */
507fd9cb95cSsethg 	scanset = 1;
508fd9cb95cSsethg #endif
509fd9cb95cSsethg 	if (KeyboardConvertScan_init(kb8042, scanset) != DDI_SUCCESS) {
510fd9cb95cSsethg 		cmn_err(CE_WARN, "Cannot initialize keyboard scan converter: "
511fd9cb95cSsethg 		    "Unknown scan code set `%d'.", scanset);
512fd9cb95cSsethg 		/* Scan code set is not supported */
513fd9cb95cSsethg 		goto failure;
514fd9cb95cSsethg 	}
5157c478bd9Sstevel@tonic-gate 
5167c478bd9Sstevel@tonic-gate 	/*
5177c478bd9Sstevel@tonic-gate 	 * Turn on interrupts...
5187c478bd9Sstevel@tonic-gate 	 */
5197c478bd9Sstevel@tonic-gate 	if (ddi_add_intr(devi, 0,
5207c478bd9Sstevel@tonic-gate 	    &kb8042->w_iblock, (ddi_idevice_cookie_t *)NULL,
5217c478bd9Sstevel@tonic-gate 	    kb8042_intr, (caddr_t)kb8042) != DDI_SUCCESS) {
5227c478bd9Sstevel@tonic-gate 		cmn_err(CE_WARN, "kb8042_attach: cannot add interrupt");
523fd9cb95cSsethg 		goto failure;
5247c478bd9Sstevel@tonic-gate 	}
5257c478bd9Sstevel@tonic-gate 
526fd9cb95cSsethg 	kb8042->init_state |= KB8042_INTR_ADDED;
527fd9cb95cSsethg 
5287c478bd9Sstevel@tonic-gate 	ddi_report_dev(devi);
529fd9cb95cSsethg 
530*15bfc6b7SSeth Goldberg #ifdef DEBUG
531bb2d7d5eSSeth Goldberg 	cmn_err(CE_CONT, "?%s instance #%d READY\n",
53219397407SSherry Moore 	    DRIVER_NAME(devi), ddi_get_instance(devi));
5337c478bd9Sstevel@tonic-gate #endif
534fd9cb95cSsethg 
5357c478bd9Sstevel@tonic-gate 	return (DDI_SUCCESS);
536fd9cb95cSsethg 
537fd9cb95cSsethg failure:
538fd9cb95cSsethg 	kb8042_cleanup(kb8042);
539fd9cb95cSsethg 	return (DDI_FAILURE);
5407c478bd9Sstevel@tonic-gate }
5417c478bd9Sstevel@tonic-gate 
542fd9cb95cSsethg static int
543fd9cb95cSsethg kb8042_detach(dev_info_t *dip, ddi_detach_cmd_t cmd)
544fd9cb95cSsethg {
545fd9cb95cSsethg 	struct kb8042 *kb8042 = &Kdws;
546fd9cb95cSsethg 
547fd9cb95cSsethg 	switch (cmd) {
548fd9cb95cSsethg 	case DDI_SUSPEND:
5492df1fe9cSrandyf 		mutex_enter(&kb8042->w_hw_mutex);
5502df1fe9cSrandyf 		ASSERT(kb8042->ops >= 0);
5512df1fe9cSrandyf 		while (kb8042->ops > 0)
5522df1fe9cSrandyf 			cv_wait(&kb8042->ops_cv, &kb8042->w_hw_mutex);
5532df1fe9cSrandyf 		kb8042->suspended = B_TRUE;
5542df1fe9cSrandyf 		mutex_exit(&kb8042->w_hw_mutex);
555fd9cb95cSsethg 		return (DDI_SUCCESS);
556fd9cb95cSsethg 
557fd9cb95cSsethg 	case DDI_DETACH:
558fd9cb95cSsethg 		/* If someone has a stream open, fail to detach */
559fd9cb95cSsethg 		if (kb8042->w_qp != NULL)
560fd9cb95cSsethg 			return (DDI_FAILURE);
561fd9cb95cSsethg 
562fd9cb95cSsethg 		ASSERT(kb8042_dip == dip);
563fd9cb95cSsethg 
564fd9cb95cSsethg 		kb8042_cleanup(kb8042);
565fd9cb95cSsethg 
566fd9cb95cSsethg 		return (DDI_SUCCESS);
567fd9cb95cSsethg 
568fd9cb95cSsethg 	default:
569fd9cb95cSsethg 		return (DDI_FAILURE);
570fd9cb95cSsethg 	}
571fd9cb95cSsethg }
572fd9cb95cSsethg 
5737c478bd9Sstevel@tonic-gate /*ARGSUSED*/
5747c478bd9Sstevel@tonic-gate static int
5757c478bd9Sstevel@tonic-gate kb8042_getinfo(
5767c478bd9Sstevel@tonic-gate     dev_info_t *dip,
5777c478bd9Sstevel@tonic-gate     ddi_info_cmd_t infocmd,
5787c478bd9Sstevel@tonic-gate     void *arg,
5797c478bd9Sstevel@tonic-gate     void **result)
5807c478bd9Sstevel@tonic-gate {
5817c478bd9Sstevel@tonic-gate 	register int error;
5827c478bd9Sstevel@tonic-gate 
5837c478bd9Sstevel@tonic-gate 	switch (infocmd) {
5847c478bd9Sstevel@tonic-gate 	case DDI_INFO_DEVT2DEVINFO:
5857c478bd9Sstevel@tonic-gate 		if (kb8042_dip == NULL) {
5867c478bd9Sstevel@tonic-gate 			error = DDI_FAILURE;
5877c478bd9Sstevel@tonic-gate 		} else {
5887c478bd9Sstevel@tonic-gate 			*result = (void *) kb8042_dip;
5897c478bd9Sstevel@tonic-gate 			error = DDI_SUCCESS;
5907c478bd9Sstevel@tonic-gate 		}
5917c478bd9Sstevel@tonic-gate 		break;
5927c478bd9Sstevel@tonic-gate 	case DDI_INFO_DEVT2INSTANCE:
5937c478bd9Sstevel@tonic-gate 		*result = (void *)0;
5947c478bd9Sstevel@tonic-gate 		error = DDI_SUCCESS;
5957c478bd9Sstevel@tonic-gate 		break;
5967c478bd9Sstevel@tonic-gate 	default:
5977c478bd9Sstevel@tonic-gate 		error = DDI_FAILURE;
5987c478bd9Sstevel@tonic-gate 		break;
5997c478bd9Sstevel@tonic-gate 	}
6007c478bd9Sstevel@tonic-gate 	return (error);
6017c478bd9Sstevel@tonic-gate }
6027c478bd9Sstevel@tonic-gate 
6037c478bd9Sstevel@tonic-gate static void
604fd9cb95cSsethg kb8042_cleanup(struct kb8042 *kb8042)
605fd9cb95cSsethg {
6060eccbe1bSsethg 	ASSERT(kb8042_dip != NULL);
607fd9cb95cSsethg 
608*15bfc6b7SSeth Goldberg 	if (kb8042->init_state & KB8042_INTR_ADDED)
609*15bfc6b7SSeth Goldberg 		ddi_remove_intr(kb8042_dip, 0, kb8042->w_iblock);
610*15bfc6b7SSeth Goldberg 
6112df1fe9cSrandyf 	if (kb8042->init_state & KB8042_HW_MUTEX_INITTED) {
612*15bfc6b7SSeth Goldberg 		cv_destroy(&kb8042->cmd_cv);
6132df1fe9cSrandyf 		cv_destroy(&kb8042->suspend_cv);
6142df1fe9cSrandyf 		cv_destroy(&kb8042->ops_cv);
615fd9cb95cSsethg 		mutex_destroy(&kb8042->w_hw_mutex);
6162df1fe9cSrandyf 	}
617fd9cb95cSsethg 
618fd9cb95cSsethg 	if (kb8042->init_state & KB8042_REGS_MAPPED)
619fd9cb95cSsethg 		ddi_regs_map_free(&kb8042->handle);
620fd9cb95cSsethg 
621fd9cb95cSsethg 	if (kb8042->init_state & KB8042_MINOR_NODE_CREATED)
622fd9cb95cSsethg 		ddi_remove_minor_node(kb8042_dip, NULL);
623fd9cb95cSsethg 
624fd9cb95cSsethg 	kb8042->init_state = KB8042_UNINITIALIZED;
6250eccbe1bSsethg 	kb8042_dip = NULL;
626fd9cb95cSsethg }
627fd9cb95cSsethg 
628fd9cb95cSsethg static void
629fd9cb95cSsethg kb8042_init(struct kb8042 *kb8042, boolean_t from_resume)
6307c478bd9Sstevel@tonic-gate {
6317c478bd9Sstevel@tonic-gate 	if (kb8042->w_init)
6327c478bd9Sstevel@tonic-gate 		return;
6337c478bd9Sstevel@tonic-gate 
634fd9cb95cSsethg 	if (!from_resume) {
6357c478bd9Sstevel@tonic-gate 		kb8042->w_kblayout = 0;	/* Default to US */
6367c478bd9Sstevel@tonic-gate 		kb8042->w_qp = (queue_t *)NULL;
637fd9cb95cSsethg 		kb8042->simulated_kbd_type = KB_PC;
638fd9cb95cSsethg 		kb8042->leds.commanded = -1;	/* Unknown initial state */
639fd9cb95cSsethg 		kb8042->leds.desired = -1;	/* Unknown initial state */
640fd9cb95cSsethg 	}
6417c478bd9Sstevel@tonic-gate 
6427c478bd9Sstevel@tonic-gate 	kb8042_wait_poweron(kb8042);
6437c478bd9Sstevel@tonic-gate 
6447c478bd9Sstevel@tonic-gate 	kb8042->kb_old_key_pos = 0;
6457c478bd9Sstevel@tonic-gate 
646*15bfc6b7SSeth Goldberg 	/*
647*15bfc6b7SSeth Goldberg 	 * Explicitly grab and release the 8042 lock outside of
648*15bfc6b7SSeth Goldberg 	 * kb8042_send_to_keyboard, because this is the only situation
649*15bfc6b7SSeth Goldberg 	 * where a polling interface is used with locking required.
650*15bfc6b7SSeth Goldberg 	 */
651*15bfc6b7SSeth Goldberg 	(void) ddi_get8(kb8042->handle, kb8042->addr + I8042_LOCK);
6527c478bd9Sstevel@tonic-gate 	/* Set up the command state machine and start it running. */
653*15bfc6b7SSeth Goldberg 	kb8042_send_to_keyboard(kb8042, KB_ENABLE, B_TRUE);
654*15bfc6b7SSeth Goldberg 	(void) ddi_get8(kb8042->handle, kb8042->addr + I8042_UNLOCK);
6557c478bd9Sstevel@tonic-gate 
6567c478bd9Sstevel@tonic-gate 	kb8042->w_init++;
6577c478bd9Sstevel@tonic-gate 
6587c478bd9Sstevel@tonic-gate 	(void) drv_setparm(SYSRINT, 1);	/* reset keyboard interrupts */
6597c478bd9Sstevel@tonic-gate }
6607c478bd9Sstevel@tonic-gate 
6617c478bd9Sstevel@tonic-gate /*ARGSUSED2*/
6627c478bd9Sstevel@tonic-gate static int
6637c478bd9Sstevel@tonic-gate kb8042_open(queue_t *qp, dev_t *devp, int flag, int sflag, cred_t *credp)
6647c478bd9Sstevel@tonic-gate {
6657c478bd9Sstevel@tonic-gate 	struct kb8042	*kb8042;
6667c478bd9Sstevel@tonic-gate 	int err;
6677c478bd9Sstevel@tonic-gate 	int initial_leds;
6687c478bd9Sstevel@tonic-gate 	int initial_led_mask;
6697c478bd9Sstevel@tonic-gate 
6707c478bd9Sstevel@tonic-gate 	kb8042 = &Kdws;
6717c478bd9Sstevel@tonic-gate 
6722df1fe9cSrandyf 	mutex_enter(&kb8042->w_hw_mutex);
6732df1fe9cSrandyf 	while (kb8042->suspended) {
6742df1fe9cSrandyf 		if (cv_wait_sig(&kb8042->suspend_cv, &kb8042->w_hw_mutex) ==
6752df1fe9cSrandyf 		    0) {
6762df1fe9cSrandyf 			mutex_exit(&kb8042->w_hw_mutex);
6772df1fe9cSrandyf 			return (EINTR);
6782df1fe9cSrandyf 		}
6792df1fe9cSrandyf 	}
6802df1fe9cSrandyf 
6817c478bd9Sstevel@tonic-gate 	kb8042->w_dev = *devp;
6827c478bd9Sstevel@tonic-gate 
6837c478bd9Sstevel@tonic-gate 	if (qp->q_ptr) {
6842df1fe9cSrandyf 		mutex_exit(&kb8042->w_hw_mutex);
6857c478bd9Sstevel@tonic-gate 		return (0);
6867c478bd9Sstevel@tonic-gate 	}
6877c478bd9Sstevel@tonic-gate 	qp->q_ptr = (caddr_t)kb8042;
6887c478bd9Sstevel@tonic-gate 	WR(qp)->q_ptr = qp->q_ptr;
6897c478bd9Sstevel@tonic-gate 	if (!kb8042->w_qp)
6907c478bd9Sstevel@tonic-gate 		kb8042->w_qp = qp;
6917c478bd9Sstevel@tonic-gate 
6922df1fe9cSrandyf 	ASSERT(kb8042->ops >= 0);
6932df1fe9cSrandyf 	kb8042->ops++;
6942df1fe9cSrandyf 	mutex_exit(&kb8042->w_hw_mutex);
6952df1fe9cSrandyf 
6967c478bd9Sstevel@tonic-gate 	kb8042_get_initial_leds(kb8042, &initial_leds, &initial_led_mask);
6977c478bd9Sstevel@tonic-gate 	err = kbtrans_streams_init(qp, sflag, credp,
6987c478bd9Sstevel@tonic-gate 	    (struct kbtrans_hardware *)kb8042, &kb8042_callbacks,
6997c478bd9Sstevel@tonic-gate 	    &kb8042->hw_kbtrans,
7007c478bd9Sstevel@tonic-gate 	    initial_leds, initial_led_mask);
7017c478bd9Sstevel@tonic-gate 	if (err != 0)
7027c478bd9Sstevel@tonic-gate 		return (err);
7037c478bd9Sstevel@tonic-gate 
7047c478bd9Sstevel@tonic-gate 	kbtrans_streams_set_keyboard(kb8042->hw_kbtrans, KB_PC, &keyindex_pc);
7057c478bd9Sstevel@tonic-gate 
7067c478bd9Sstevel@tonic-gate 	kb8042->polledio.cons_polledio_version = CONSPOLLEDIO_V1;
7077c478bd9Sstevel@tonic-gate 	kb8042->polledio.cons_polledio_argument =
708281f0747Slt200341 	    (cons_polledio_arg_t)kb8042;
7097c478bd9Sstevel@tonic-gate 	kb8042->polledio.cons_polledio_putchar = NULL;
7107c478bd9Sstevel@tonic-gate 	kb8042->polledio.cons_polledio_getchar =
711281f0747Slt200341 	    (int (*)(cons_polledio_arg_t))kb8042_polled_getchar;
7127c478bd9Sstevel@tonic-gate 	kb8042->polledio.cons_polledio_ischar =
713281f0747Slt200341 	    (boolean_t (*)(cons_polledio_arg_t))kb8042_polled_ischar;
7147c478bd9Sstevel@tonic-gate 	kb8042->polledio.cons_polledio_enter = NULL;
7157c478bd9Sstevel@tonic-gate 	kb8042->polledio.cons_polledio_exit = NULL;
7167c478bd9Sstevel@tonic-gate 	kb8042->polledio.cons_polledio_setled =
717281f0747Slt200341 	    (void (*)(cons_polledio_arg_t, int))kb8042_polled_setled;
7187c478bd9Sstevel@tonic-gate 	kb8042->polledio.cons_polledio_keycheck =
719281f0747Slt200341 	    (boolean_t (*)(cons_polledio_arg_t, int *,
7207c478bd9Sstevel@tonic-gate 	    enum keystate *))kb8042_polled_keycheck;
7217c478bd9Sstevel@tonic-gate 
7227c478bd9Sstevel@tonic-gate 	qprocson(qp);
7237c478bd9Sstevel@tonic-gate 
7247c478bd9Sstevel@tonic-gate 	kbtrans_streams_enable(kb8042->hw_kbtrans);
7257c478bd9Sstevel@tonic-gate 
7262df1fe9cSrandyf 	mutex_enter(&kb8042->w_hw_mutex);
7272df1fe9cSrandyf 	ASSERT(kb8042->ops > 0);
7282df1fe9cSrandyf 	kb8042->ops--;
7292df1fe9cSrandyf 	if (kb8042->ops == 0)
7302df1fe9cSrandyf 		cv_broadcast(&kb8042->ops_cv);
7312df1fe9cSrandyf 	mutex_exit(&kb8042->w_hw_mutex);
7322df1fe9cSrandyf 
7337c478bd9Sstevel@tonic-gate 	return (0);
7347c478bd9Sstevel@tonic-gate }
7357c478bd9Sstevel@tonic-gate 
7367c478bd9Sstevel@tonic-gate /*ARGSUSED1*/
7377c478bd9Sstevel@tonic-gate static int
7387c478bd9Sstevel@tonic-gate kb8042_close(queue_t *qp, int flag, cred_t *credp)
7397c478bd9Sstevel@tonic-gate {
7407c478bd9Sstevel@tonic-gate 	struct kb8042	*kb8042;
7417c478bd9Sstevel@tonic-gate 
742c35aa225Smarx 	/* If a beep is in progress, stop that */
743c35aa225Smarx 	(void) beeper_off();
744c35aa225Smarx 
7457c478bd9Sstevel@tonic-gate 	kb8042 = (struct kb8042 *)qp->q_ptr;
7467c478bd9Sstevel@tonic-gate 
7472df1fe9cSrandyf 	mutex_enter(&kb8042->w_hw_mutex);
7482df1fe9cSrandyf 	while (kb8042->suspended) {
7492df1fe9cSrandyf 		if (cv_wait_sig(&kb8042->suspend_cv, &kb8042->w_hw_mutex) ==
7502df1fe9cSrandyf 		    0) {
7512df1fe9cSrandyf 			mutex_exit(&kb8042->w_hw_mutex);
7522df1fe9cSrandyf 			return (EINTR);
7532df1fe9cSrandyf 		}
7542df1fe9cSrandyf 	}
7552df1fe9cSrandyf 
7562df1fe9cSrandyf 	ASSERT(kb8042->ops >= 0);
7572df1fe9cSrandyf 	kb8042->ops++;
7582df1fe9cSrandyf 	mutex_exit(&kb8042->w_hw_mutex);
7592df1fe9cSrandyf 
760e1fec4f9Sry162471 	(void) kbtrans_streams_fini(kb8042->hw_kbtrans);
761e1fec4f9Sry162471 
7627c478bd9Sstevel@tonic-gate 	kb8042->w_qp = (queue_t *)NULL;
7637c478bd9Sstevel@tonic-gate 	qprocsoff(qp);
7647c478bd9Sstevel@tonic-gate 
7652df1fe9cSrandyf 	mutex_enter(&kb8042->w_hw_mutex);
7662df1fe9cSrandyf 	ASSERT(kb8042->ops > 0);
7672df1fe9cSrandyf 	kb8042->ops--;
7682df1fe9cSrandyf 	if (kb8042->ops == 0)
7692df1fe9cSrandyf 		cv_broadcast(&kb8042->ops_cv);
7702df1fe9cSrandyf 	mutex_exit(&kb8042->w_hw_mutex);
7712df1fe9cSrandyf 
7727c478bd9Sstevel@tonic-gate 	return (0);
7737c478bd9Sstevel@tonic-gate }
7747c478bd9Sstevel@tonic-gate 
7757c478bd9Sstevel@tonic-gate static int
7767c478bd9Sstevel@tonic-gate kb8042_wsrv(queue_t *qp)
7777c478bd9Sstevel@tonic-gate {
7787c478bd9Sstevel@tonic-gate 	struct kb8042 *kb8042;
7797c478bd9Sstevel@tonic-gate 
7807c478bd9Sstevel@tonic-gate 	mblk_t	*mp;
7812df1fe9cSrandyf 	boolean_t suspended;
7827c478bd9Sstevel@tonic-gate 
7837c478bd9Sstevel@tonic-gate 	kb8042 = (struct kb8042 *)qp->q_ptr;
7847c478bd9Sstevel@tonic-gate 
7852df1fe9cSrandyf 	mutex_enter(&kb8042->w_hw_mutex);
7862df1fe9cSrandyf 	suspended = kb8042->suspended;
7872df1fe9cSrandyf 	ASSERT(kb8042->ops >= 0);
7882df1fe9cSrandyf 	if (!suspended)
7892df1fe9cSrandyf 		kb8042->ops++;
7902df1fe9cSrandyf 	mutex_exit(&kb8042->w_hw_mutex);
7912df1fe9cSrandyf 
7922df1fe9cSrandyf #ifdef NO_KB_DEBUG
7932df1fe9cSrandyf 	while (!suspended && (mp = getq(qp)) != NULL) {
7942df1fe9cSrandyf #else
7952df1fe9cSrandyf 	/*
7962df1fe9cSrandyf 	 * Not taking keyboard input while suspending can make debugging
7972df1fe9cSrandyf 	 * difficult.  However, we still do the ops counting so that we
7982df1fe9cSrandyf 	 * don't suspend at a bad time.
7992df1fe9cSrandyf 	 */
8007c478bd9Sstevel@tonic-gate 	while ((mp = getq(qp))) {
8012df1fe9cSrandyf #endif
8027c478bd9Sstevel@tonic-gate 		switch (kbtrans_streams_message(kb8042->hw_kbtrans, mp)) {
8037c478bd9Sstevel@tonic-gate 		case KBTRANS_MESSAGE_HANDLED:
8047c478bd9Sstevel@tonic-gate 			continue;
8057c478bd9Sstevel@tonic-gate 		case KBTRANS_MESSAGE_NOT_HANDLED:
8067c478bd9Sstevel@tonic-gate 			break;
8077c478bd9Sstevel@tonic-gate 		}
8087c478bd9Sstevel@tonic-gate 		switch (mp->b_datap->db_type) {
8097c478bd9Sstevel@tonic-gate 		case M_IOCTL:
8107c478bd9Sstevel@tonic-gate 			kb8042_ioctlmsg(kb8042, qp, mp);
8117c478bd9Sstevel@tonic-gate 			continue;
8127c478bd9Sstevel@tonic-gate 		case M_IOCDATA:
8137c478bd9Sstevel@tonic-gate 			kb8042_iocdatamsg(qp, mp);
8147c478bd9Sstevel@tonic-gate 			continue;
8157c478bd9Sstevel@tonic-gate 		case M_DELAY:
8167c478bd9Sstevel@tonic-gate 		case M_STARTI:
8177c478bd9Sstevel@tonic-gate 		case M_STOPI:
8187c478bd9Sstevel@tonic-gate 		case M_READ:	/* ignore, no buffered data */
8197c478bd9Sstevel@tonic-gate 			freemsg(mp);
8207c478bd9Sstevel@tonic-gate 			continue;
8217c478bd9Sstevel@tonic-gate 		case M_FLUSH:
8227c478bd9Sstevel@tonic-gate 			*mp->b_rptr &= ~FLUSHW;
8237c478bd9Sstevel@tonic-gate 			if (*mp->b_rptr & FLUSHR)
8247c478bd9Sstevel@tonic-gate 				qreply(qp, mp);
8257c478bd9Sstevel@tonic-gate 			else
8267c478bd9Sstevel@tonic-gate 				freemsg(mp);
8277c478bd9Sstevel@tonic-gate 			continue;
8287c478bd9Sstevel@tonic-gate 		default:
8297c478bd9Sstevel@tonic-gate 			cmn_err(CE_NOTE, "kb8042_wsrv: bad msg %x",
8307c478bd9Sstevel@tonic-gate 			    mp->b_datap->db_type);
8317c478bd9Sstevel@tonic-gate 			freemsg(mp);
8327c478bd9Sstevel@tonic-gate 			continue;
8337c478bd9Sstevel@tonic-gate 		}
8347c478bd9Sstevel@tonic-gate 	}
8352df1fe9cSrandyf 
8362df1fe9cSrandyf 	mutex_enter(&kb8042->w_hw_mutex);
8372df1fe9cSrandyf 	if (!suspended) {
8382df1fe9cSrandyf 		ASSERT(kb8042->ops > 0);
8392df1fe9cSrandyf 		kb8042->ops--;
8402df1fe9cSrandyf 		if (kb8042->ops == 0)
8412df1fe9cSrandyf 			cv_broadcast(&kb8042->ops_cv);
8422df1fe9cSrandyf 	}
8432df1fe9cSrandyf 	mutex_exit(&kb8042->w_hw_mutex);
8442df1fe9cSrandyf 
8457c478bd9Sstevel@tonic-gate 	return (0);
8467c478bd9Sstevel@tonic-gate }
8477c478bd9Sstevel@tonic-gate 
8487c478bd9Sstevel@tonic-gate static void
8497c478bd9Sstevel@tonic-gate kb8042_ioctlmsg(struct kb8042 *kb8042, queue_t *qp, mblk_t *mp)
8507c478bd9Sstevel@tonic-gate {
8517c478bd9Sstevel@tonic-gate 	struct iocblk	*iocp;
8527c478bd9Sstevel@tonic-gate 	mblk_t		*datap;
8537c478bd9Sstevel@tonic-gate 	int		error;
8547c478bd9Sstevel@tonic-gate 	int		tmp;
855c35aa225Smarx 	int		cycles;
856c35aa225Smarx 	int		frequency;
857c35aa225Smarx 	int		msecs;
8587c478bd9Sstevel@tonic-gate 
8597c478bd9Sstevel@tonic-gate 	iocp = (struct iocblk *)mp->b_rptr;
8607c478bd9Sstevel@tonic-gate 
8617c478bd9Sstevel@tonic-gate 	switch (iocp->ioc_cmd) {
8627c478bd9Sstevel@tonic-gate 
8637c478bd9Sstevel@tonic-gate 	case CONSOPENPOLLEDIO:
8647c478bd9Sstevel@tonic-gate 		error = miocpullup(mp, sizeof (struct cons_polledio *));
8657c478bd9Sstevel@tonic-gate 		if (error != 0) {
8667c478bd9Sstevel@tonic-gate 			miocnak(qp, mp, 0, error);
8677c478bd9Sstevel@tonic-gate 			return;
8687c478bd9Sstevel@tonic-gate 		}
8697c478bd9Sstevel@tonic-gate 
8707c478bd9Sstevel@tonic-gate 		/*
8717c478bd9Sstevel@tonic-gate 		 * We are given an appropriate-sized data block,
8727c478bd9Sstevel@tonic-gate 		 * and return a pointer to our structure in it.
8737c478bd9Sstevel@tonic-gate 		 */
8747c478bd9Sstevel@tonic-gate 		*(struct cons_polledio **)mp->b_cont->b_rptr =
8757c478bd9Sstevel@tonic-gate 		    &kb8042->polledio;
8767c478bd9Sstevel@tonic-gate 		mp->b_datap->db_type = M_IOCACK;
8777c478bd9Sstevel@tonic-gate 		iocp->ioc_error = 0;
8787c478bd9Sstevel@tonic-gate 		qreply(qp, mp);
8797c478bd9Sstevel@tonic-gate 		break;
8807c478bd9Sstevel@tonic-gate 
8817c478bd9Sstevel@tonic-gate 	case CONSCLOSEPOLLEDIO:
8827c478bd9Sstevel@tonic-gate 		miocack(qp, mp, 0, 0);
8837c478bd9Sstevel@tonic-gate 		break;
8847c478bd9Sstevel@tonic-gate 
8857c478bd9Sstevel@tonic-gate 	case CONSSETABORTENABLE:
8867c478bd9Sstevel@tonic-gate 		if (iocp->ioc_count != TRANSPARENT) {
8877c478bd9Sstevel@tonic-gate 			miocnak(qp, mp, 0, EINVAL);
8887c478bd9Sstevel@tonic-gate 			return;
8897c478bd9Sstevel@tonic-gate 		}
8907c478bd9Sstevel@tonic-gate 
8917c478bd9Sstevel@tonic-gate 		kb8042->debugger.enabled = *(intptr_t *)mp->b_cont->b_rptr;
8927c478bd9Sstevel@tonic-gate 		miocack(qp, mp, 0, 0);
8937c478bd9Sstevel@tonic-gate 		break;
8947c478bd9Sstevel@tonic-gate 
8957c478bd9Sstevel@tonic-gate 	/*
8967c478bd9Sstevel@tonic-gate 	 * Valid only in TR_UNTRANS_MODE mode.
8977c478bd9Sstevel@tonic-gate 	 */
8987c478bd9Sstevel@tonic-gate 	case CONSSETKBDTYPE:
8997c478bd9Sstevel@tonic-gate 		error = miocpullup(mp, sizeof (int));
9007c478bd9Sstevel@tonic-gate 		if (error != 0) {
9017c478bd9Sstevel@tonic-gate 			miocnak(qp, mp, 0, error);
9027c478bd9Sstevel@tonic-gate 			return;
9037c478bd9Sstevel@tonic-gate 		}
9047c478bd9Sstevel@tonic-gate 		tmp =  *(int *)mp->b_cont->b_rptr;
9057c478bd9Sstevel@tonic-gate 		if (tmp != KB_PC && tmp != KB_USB) {
9067c478bd9Sstevel@tonic-gate 			miocnak(qp, mp, 0, EINVAL);
9077c478bd9Sstevel@tonic-gate 			break;
9087c478bd9Sstevel@tonic-gate 		}
9097c478bd9Sstevel@tonic-gate 		kb8042->simulated_kbd_type = tmp;
9107c478bd9Sstevel@tonic-gate 		miocack(qp, mp, 0, 0);
9117c478bd9Sstevel@tonic-gate 		break;
9127c478bd9Sstevel@tonic-gate 
9137c478bd9Sstevel@tonic-gate 	case KIOCLAYOUT:
9147c478bd9Sstevel@tonic-gate 		if (kb8042->w_kblayout == -1) {
9157c478bd9Sstevel@tonic-gate 			miocnak(qp, mp, 0, EINVAL);
9167c478bd9Sstevel@tonic-gate 			return;
9177c478bd9Sstevel@tonic-gate 		}
9187c478bd9Sstevel@tonic-gate 
9197c478bd9Sstevel@tonic-gate 		if ((datap = allocb(sizeof (int), BPRI_HI)) == NULL) {
9207c478bd9Sstevel@tonic-gate 			miocnak(qp, mp, 0, ENOMEM);
9217c478bd9Sstevel@tonic-gate 			return;
9227c478bd9Sstevel@tonic-gate 		}
9237c478bd9Sstevel@tonic-gate 
9247c478bd9Sstevel@tonic-gate 		if (kb8042->simulated_kbd_type == KB_USB)
9257c478bd9Sstevel@tonic-gate 			*(int *)datap->b_wptr = KBTRANS_USBKB_DEFAULT_LAYOUT;
9267c478bd9Sstevel@tonic-gate 		else
9277c478bd9Sstevel@tonic-gate 			*(int *)datap->b_wptr = kb8042->w_kblayout;
9287c478bd9Sstevel@tonic-gate 
9297c478bd9Sstevel@tonic-gate 		datap->b_wptr += sizeof (int);
9307c478bd9Sstevel@tonic-gate 		if (mp->b_cont)
9317c478bd9Sstevel@tonic-gate 			freemsg(mp->b_cont);
9327c478bd9Sstevel@tonic-gate 		mp->b_cont = datap;
9337c478bd9Sstevel@tonic-gate 		iocp->ioc_count = sizeof (int);
9347c478bd9Sstevel@tonic-gate 		mp->b_datap->db_type = M_IOCACK;
9357c478bd9Sstevel@tonic-gate 		iocp->ioc_error = 0;
9367c478bd9Sstevel@tonic-gate 		qreply(qp, mp);
9377c478bd9Sstevel@tonic-gate 		break;
9387c478bd9Sstevel@tonic-gate 
9397c478bd9Sstevel@tonic-gate 	case KIOCSLAYOUT:
9407c478bd9Sstevel@tonic-gate 		if (iocp->ioc_count != TRANSPARENT) {
9417c478bd9Sstevel@tonic-gate 			miocnak(qp, mp, 0, EINVAL);
9427c478bd9Sstevel@tonic-gate 			return;
9437c478bd9Sstevel@tonic-gate 		}
9447c478bd9Sstevel@tonic-gate 
9457c478bd9Sstevel@tonic-gate 		kb8042->w_kblayout = *(intptr_t *)mp->b_cont->b_rptr;
9467c478bd9Sstevel@tonic-gate 		miocack(qp, mp, 0, 0);
9477c478bd9Sstevel@tonic-gate 		break;
9487c478bd9Sstevel@tonic-gate 
9497c478bd9Sstevel@tonic-gate 	case KIOCCMD:
9507c478bd9Sstevel@tonic-gate 		error = miocpullup(mp, sizeof (int));
9517c478bd9Sstevel@tonic-gate 		if (error != 0) {
9527c478bd9Sstevel@tonic-gate 			miocnak(qp, mp, 0, error);
9537c478bd9Sstevel@tonic-gate 			return;
9547c478bd9Sstevel@tonic-gate 		}
9557c478bd9Sstevel@tonic-gate 
9567c478bd9Sstevel@tonic-gate 		kb8042_type4_cmd(kb8042, *(int *)mp->b_cont->b_rptr);
9577c478bd9Sstevel@tonic-gate 		miocack(qp, mp, 0, 0);
9587c478bd9Sstevel@tonic-gate 		break;
9597c478bd9Sstevel@tonic-gate 
960c35aa225Smarx 	case KIOCMKTONE:
961c35aa225Smarx 		if (iocp->ioc_count != TRANSPARENT) {
962c35aa225Smarx 			miocnak(qp, mp, 0, EINVAL);
963c35aa225Smarx 			return;
964c35aa225Smarx 		}
965c35aa225Smarx 
966c35aa225Smarx 		tmp = (int)(*(intptr_t *)mp->b_cont->b_rptr);
967c35aa225Smarx 		cycles = tmp & 0xffff;
968c35aa225Smarx 		msecs = (tmp >> 16) & 0xffff;
969c35aa225Smarx 
970c35aa225Smarx 		if (cycles == 0)
971c35aa225Smarx 			frequency = UINT16_MAX;
972c35aa225Smarx 		else if (cycles == UINT16_MAX)
973c35aa225Smarx 			frequency = 0;
974c35aa225Smarx 		else {
975c35aa225Smarx 			frequency = (PIT_HZ + cycles / 2) / cycles;
976c35aa225Smarx 			if (frequency > UINT16_MAX)
977c35aa225Smarx 				frequency = UINT16_MAX;
978c35aa225Smarx 		}
979c35aa225Smarx 
980c35aa225Smarx 		error = beep_mktone(frequency, msecs);
981c35aa225Smarx 		if (error != 0)
982c35aa225Smarx 			miocnak(qp, mp, 0, error);
983c35aa225Smarx 		else
984c35aa225Smarx 			miocack(qp, mp, 0, 0);
985c35aa225Smarx 		break;
986c35aa225Smarx 
9877c478bd9Sstevel@tonic-gate 	default:
9887c478bd9Sstevel@tonic-gate #ifdef DEBUG1
9897c478bd9Sstevel@tonic-gate 		cmn_err(CE_NOTE, "!kb8042_ioctlmsg %x", iocp->ioc_cmd);
9907c478bd9Sstevel@tonic-gate #endif
9917c478bd9Sstevel@tonic-gate 		miocnak(qp, mp, 0, EINVAL);
9927c478bd9Sstevel@tonic-gate 		return;
9937c478bd9Sstevel@tonic-gate 	}
9947c478bd9Sstevel@tonic-gate }
9957c478bd9Sstevel@tonic-gate 
9967c478bd9Sstevel@tonic-gate /*
9977c478bd9Sstevel@tonic-gate  * Process a byte received from the keyboard
9987c478bd9Sstevel@tonic-gate  */
9997c478bd9Sstevel@tonic-gate static void
10007c478bd9Sstevel@tonic-gate kb8042_received_byte(
10017c478bd9Sstevel@tonic-gate 	struct kb8042	*kb8042,
10027c478bd9Sstevel@tonic-gate 	int		scancode)	/* raw scan code */
10037c478bd9Sstevel@tonic-gate {
10047c478bd9Sstevel@tonic-gate 	boolean_t	legit;		/* is this a legit key pos'n? */
10057c478bd9Sstevel@tonic-gate 	int		key_pos = -1;
10067c478bd9Sstevel@tonic-gate 	enum keystate	state;
10077c478bd9Sstevel@tonic-gate 	boolean_t	synthetic_release_needed;
10087c478bd9Sstevel@tonic-gate 
1009*15bfc6b7SSeth Goldberg 	/*
1010*15bfc6b7SSeth Goldberg 	 * Intercept ACK and RESEND and signal the condition that
1011*15bfc6b7SSeth Goldberg 	 * kb8042_send_and_wait is waiting for.
1012*15bfc6b7SSeth Goldberg 	 */
1013*15bfc6b7SSeth Goldberg 	if (scancode == KB_ACK) {
1014*15bfc6b7SSeth Goldberg 		mutex_enter(&kb8042->w_hw_mutex);
1015*15bfc6b7SSeth Goldberg 		kb8042->acked = 1;
1016*15bfc6b7SSeth Goldberg 		cv_signal(&kb8042->cmd_cv);
1017*15bfc6b7SSeth Goldberg 		mutex_exit(&kb8042->w_hw_mutex);
1018*15bfc6b7SSeth Goldberg 		return;
1019*15bfc6b7SSeth Goldberg 	} else if (scancode == KB_RESEND) {
1020*15bfc6b7SSeth Goldberg 		mutex_enter(&kb8042->w_hw_mutex);
1021*15bfc6b7SSeth Goldberg 		kb8042->need_retry = 1;
1022*15bfc6b7SSeth Goldberg 		cv_signal(&kb8042->cmd_cv);
1023*15bfc6b7SSeth Goldberg 		mutex_exit(&kb8042->w_hw_mutex);
1024*15bfc6b7SSeth Goldberg 		return;
1025*15bfc6b7SSeth Goldberg 	}
10267c478bd9Sstevel@tonic-gate 
10277c478bd9Sstevel@tonic-gate 	if (!kb8042->w_init)	/* can't do anything anyway */
10287c478bd9Sstevel@tonic-gate 		return;
10297c478bd9Sstevel@tonic-gate 
10307c478bd9Sstevel@tonic-gate 	legit = KeyboardConvertScan(kb8042, scancode, &key_pos, &state,
10317c478bd9Sstevel@tonic-gate 	    &synthetic_release_needed);
10327c478bd9Sstevel@tonic-gate 
10337c478bd9Sstevel@tonic-gate 	if (legit == 0) {
10347c478bd9Sstevel@tonic-gate 		/* Eaten by translation */
10357c478bd9Sstevel@tonic-gate 		return;
10367c478bd9Sstevel@tonic-gate 	}
10377c478bd9Sstevel@tonic-gate 
10387c478bd9Sstevel@tonic-gate 	/*
10397c478bd9Sstevel@tonic-gate 	 * Don't know if we want this permanently, but it seems interesting
10407c478bd9Sstevel@tonic-gate 	 * for the moment.
10417c478bd9Sstevel@tonic-gate 	 */
10427c478bd9Sstevel@tonic-gate 	if (key_pos == kb8042->debugger.mod1) {
10437c478bd9Sstevel@tonic-gate 		kb8042->debugger.mod1_down = (state == KEY_PRESSED);
10447c478bd9Sstevel@tonic-gate 	}
10457c478bd9Sstevel@tonic-gate 	if (key_pos == kb8042->debugger.mod2) {
10467c478bd9Sstevel@tonic-gate 		kb8042->debugger.mod2_down = (state == KEY_PRESSED);
10477c478bd9Sstevel@tonic-gate 	}
10487c478bd9Sstevel@tonic-gate 	if (kb8042->debugger.enabled &&
10497c478bd9Sstevel@tonic-gate 	    key_pos == kb8042->debugger.trigger &&
10507c478bd9Sstevel@tonic-gate 	    kb8042->debugger.mod1_down &&
10517c478bd9Sstevel@tonic-gate 	    kb8042->debugger.mod2_down) {
10527c478bd9Sstevel@tonic-gate 		/*
10537c478bd9Sstevel@tonic-gate 		 * Require new presses of the modifiers.
10547c478bd9Sstevel@tonic-gate 		 */
10557c478bd9Sstevel@tonic-gate 		kb8042->debugger.mod1_down = B_FALSE;
10567c478bd9Sstevel@tonic-gate 		kb8042->debugger.mod2_down = B_FALSE;
10577c478bd9Sstevel@tonic-gate 		abort_sequence_enter(NULL);
10587c478bd9Sstevel@tonic-gate 		return;
10597c478bd9Sstevel@tonic-gate 	}
10607c478bd9Sstevel@tonic-gate 
10617c478bd9Sstevel@tonic-gate 	/*
10627c478bd9Sstevel@tonic-gate 	 * If there's no queue above us - as can happen if we've been
10637c478bd9Sstevel@tonic-gate 	 * attached but not opened - drop the keystroke.
10647c478bd9Sstevel@tonic-gate 	 * Note that we do this here instead of above so that
10657c478bd9Sstevel@tonic-gate 	 * Ctrl-Alt-D still works.
10667c478bd9Sstevel@tonic-gate 	 */
10677c478bd9Sstevel@tonic-gate 	if (kb8042->w_qp == NULL) {
10687c478bd9Sstevel@tonic-gate 		return;
10697c478bd9Sstevel@tonic-gate 	}
10707c478bd9Sstevel@tonic-gate 
10717c478bd9Sstevel@tonic-gate 	/*
10727c478bd9Sstevel@tonic-gate 	 * This is to filter out auto repeat since it can't be
10737c478bd9Sstevel@tonic-gate 	 * turned off at the hardware.  (Yeah, yeah, PS/2 keyboards
10747c478bd9Sstevel@tonic-gate 	 * can.  Don't know whether they've taken over the world.
10757c478bd9Sstevel@tonic-gate 	 * Don't think so.)
10767c478bd9Sstevel@tonic-gate 	 */
10777c478bd9Sstevel@tonic-gate 	if (kb8042_autorepeat_detect(kb8042, key_pos, state)) {
10787c478bd9Sstevel@tonic-gate 		return;
10797c478bd9Sstevel@tonic-gate 	}
10807c478bd9Sstevel@tonic-gate 
10817c478bd9Sstevel@tonic-gate 
10827c478bd9Sstevel@tonic-gate 	kb8042_process_key(kb8042, key_pos, state);
10837c478bd9Sstevel@tonic-gate 
10847c478bd9Sstevel@tonic-gate 	/*
10857c478bd9Sstevel@tonic-gate 	 * This is a total hack.  For some stupid reason, the two additional
10867c478bd9Sstevel@tonic-gate 	 * keys on Korean keyboards (Hangul and Hangul/Hanja) report press
10877c478bd9Sstevel@tonic-gate 	 * only.  We synthesize a release immediately.
10887c478bd9Sstevel@tonic-gate 	 */
10897c478bd9Sstevel@tonic-gate 	if (synthetic_release_needed) {
10907c478bd9Sstevel@tonic-gate 		(void) kb8042_autorepeat_detect(kb8042, key_pos, KEY_RELEASED);
10917c478bd9Sstevel@tonic-gate 		kb8042_process_key(kb8042, key_pos, state);
10927c478bd9Sstevel@tonic-gate 	}
10937c478bd9Sstevel@tonic-gate }
10947c478bd9Sstevel@tonic-gate 
10957c478bd9Sstevel@tonic-gate 
10967c478bd9Sstevel@tonic-gate static void
10977c478bd9Sstevel@tonic-gate kb8042_process_key(struct kb8042 *kb8042, kbtrans_key_t key_pos,
10987c478bd9Sstevel@tonic-gate     enum keystate state)
10997c478bd9Sstevel@tonic-gate {
11007c478bd9Sstevel@tonic-gate 	kbtrans_key_t key;
11017c478bd9Sstevel@tonic-gate 
11027c478bd9Sstevel@tonic-gate 	ASSERT(key_pos >= 0 && key_pos <= 255);
11037c478bd9Sstevel@tonic-gate 	if (kb8042->simulated_kbd_type == KB_PC) {
11047c478bd9Sstevel@tonic-gate 		kbtrans_streams_key(kb8042->hw_kbtrans, key_pos, state);
11057c478bd9Sstevel@tonic-gate 	} else if (kb8042->simulated_kbd_type == KB_USB) {
11067c478bd9Sstevel@tonic-gate 		key = keytab_pc2usb[key_pos];
11077c478bd9Sstevel@tonic-gate 		if (key != 0) {
11087c478bd9Sstevel@tonic-gate 			kbtrans_streams_key(kb8042->hw_kbtrans, key, state);
11097c478bd9Sstevel@tonic-gate 		}
11107c478bd9Sstevel@tonic-gate 	}
11117c478bd9Sstevel@tonic-gate }
11127c478bd9Sstevel@tonic-gate 
11137c478bd9Sstevel@tonic-gate /*
11147c478bd9Sstevel@tonic-gate  * Called from interrupt handler when keyboard interrupt occurs.
11157c478bd9Sstevel@tonic-gate  */
11167c478bd9Sstevel@tonic-gate static uint_t
11177c478bd9Sstevel@tonic-gate kb8042_intr(caddr_t arg)
11187c478bd9Sstevel@tonic-gate {
11197c478bd9Sstevel@tonic-gate 	uchar_t scancode;	/* raw scan code */
11207c478bd9Sstevel@tonic-gate 	int rc;
11217c478bd9Sstevel@tonic-gate 	struct kb8042 *kb8042 = (struct kb8042 *)arg;
11227c478bd9Sstevel@tonic-gate 
11237c478bd9Sstevel@tonic-gate 	rc = DDI_INTR_UNCLAIMED;
11247c478bd9Sstevel@tonic-gate 
1125fd9cb95cSsethg 	if (kb8042->init_state == KB8042_UNINITIALIZED)
1126fd9cb95cSsethg 		return (DDI_INTR_UNCLAIMED);
1127fd9cb95cSsethg 
11287c478bd9Sstevel@tonic-gate 	/* don't care if drv_setparm succeeds */
11297c478bd9Sstevel@tonic-gate 	(void) drv_setparm(SYSRINT, 1);
11307c478bd9Sstevel@tonic-gate 
11317c478bd9Sstevel@tonic-gate 	while (ddi_get8(kb8042->handle, kb8042->addr + I8042_INT_INPUT_AVAIL)
11327c478bd9Sstevel@tonic-gate 	    != 0) {
11337c478bd9Sstevel@tonic-gate 		rc = DDI_INTR_CLAIMED;
11347c478bd9Sstevel@tonic-gate 
11357c478bd9Sstevel@tonic-gate 		scancode = ddi_get8(kb8042->handle,
11367c478bd9Sstevel@tonic-gate 		    kb8042->addr + I8042_INT_INPUT_DATA);
11377c478bd9Sstevel@tonic-gate 
11387c478bd9Sstevel@tonic-gate 		kb8042_received_byte(kb8042, scancode);
11397c478bd9Sstevel@tonic-gate 	}
11407c478bd9Sstevel@tonic-gate 
11417c478bd9Sstevel@tonic-gate 	return (rc);
11427c478bd9Sstevel@tonic-gate }
11437c478bd9Sstevel@tonic-gate 
11447c478bd9Sstevel@tonic-gate static void
11457c478bd9Sstevel@tonic-gate kb8042_iocdatamsg(queue_t *qp, mblk_t *mp)
11467c478bd9Sstevel@tonic-gate {
11477c478bd9Sstevel@tonic-gate 	struct copyresp	*csp;
11487c478bd9Sstevel@tonic-gate 
11497c478bd9Sstevel@tonic-gate 	csp = (struct copyresp *)mp->b_rptr;
11507c478bd9Sstevel@tonic-gate 	if (csp->cp_rval) {
11517c478bd9Sstevel@tonic-gate 		freemsg(mp);
11527c478bd9Sstevel@tonic-gate 		return;
11537c478bd9Sstevel@tonic-gate 	}
11547c478bd9Sstevel@tonic-gate 
11557c478bd9Sstevel@tonic-gate 	switch (csp->cp_cmd) {
11567c478bd9Sstevel@tonic-gate 	default:
11577c478bd9Sstevel@tonic-gate 		miocack(qp, mp, 0, 0);
11587c478bd9Sstevel@tonic-gate 		break;
11597c478bd9Sstevel@tonic-gate 	}
11607c478bd9Sstevel@tonic-gate }
11617c478bd9Sstevel@tonic-gate 
11627c478bd9Sstevel@tonic-gate static boolean_t
11637c478bd9Sstevel@tonic-gate kb8042_polled_keycheck(
11647c478bd9Sstevel@tonic-gate     struct kbtrans_hardware *hw,
11657c478bd9Sstevel@tonic-gate     int *key,
11667c478bd9Sstevel@tonic-gate     enum keystate *state)
11677c478bd9Sstevel@tonic-gate {
11687c478bd9Sstevel@tonic-gate 	struct kb8042 *kb8042 = (struct kb8042 *)hw;
11697c478bd9Sstevel@tonic-gate 	int	scancode;
11707c478bd9Sstevel@tonic-gate 	boolean_t	legit;
11717c478bd9Sstevel@tonic-gate 	boolean_t	synthetic_release_needed;
11727c478bd9Sstevel@tonic-gate 
11737c478bd9Sstevel@tonic-gate 	if (kb8042->polled_synthetic_release_pending) {
11747c478bd9Sstevel@tonic-gate 		*key = kb8042->polled_synthetic_release_key;
11757c478bd9Sstevel@tonic-gate 		*state = KEY_RELEASED;
11767c478bd9Sstevel@tonic-gate 		kb8042->polled_synthetic_release_pending = B_FALSE;
11777c478bd9Sstevel@tonic-gate 		(void) kb8042_autorepeat_detect(kb8042, *key, *state);
11787c478bd9Sstevel@tonic-gate 		return (B_TRUE);
11797c478bd9Sstevel@tonic-gate 	}
11807c478bd9Sstevel@tonic-gate 
11817c478bd9Sstevel@tonic-gate 	for (;;) {
11827c478bd9Sstevel@tonic-gate 		if (ddi_get8(kb8042->handle,
11837c478bd9Sstevel@tonic-gate 		    kb8042->addr + I8042_POLL_INPUT_AVAIL) == 0) {
11847c478bd9Sstevel@tonic-gate 			return (B_FALSE);
11857c478bd9Sstevel@tonic-gate 		}
11867c478bd9Sstevel@tonic-gate 
11877c478bd9Sstevel@tonic-gate 		scancode = ddi_get8(kb8042->handle,
11887c478bd9Sstevel@tonic-gate 		    kb8042->addr + I8042_POLL_INPUT_DATA);
11897c478bd9Sstevel@tonic-gate 
11907c478bd9Sstevel@tonic-gate 		legit = KeyboardConvertScan(kb8042, scancode, key, state,
11917c478bd9Sstevel@tonic-gate 		    &synthetic_release_needed);
11927c478bd9Sstevel@tonic-gate 		if (!legit) {
11937c478bd9Sstevel@tonic-gate 			continue;
11947c478bd9Sstevel@tonic-gate 		}
11957c478bd9Sstevel@tonic-gate 		/*
11967c478bd9Sstevel@tonic-gate 		 * For the moment at least, we rely on hardware autorepeat
11977c478bd9Sstevel@tonic-gate 		 * for polled I/O autorepeat.  However, for coordination
11987c478bd9Sstevel@tonic-gate 		 * with the interrupt-driven code, maintain the last key
11997c478bd9Sstevel@tonic-gate 		 * pressed.
12007c478bd9Sstevel@tonic-gate 		 */
12017c478bd9Sstevel@tonic-gate 		(void) kb8042_autorepeat_detect(kb8042, *key, *state);
12027c478bd9Sstevel@tonic-gate 
12037c478bd9Sstevel@tonic-gate 		/*
12047c478bd9Sstevel@tonic-gate 		 * This is a total hack to support two additional keys
12057c478bd9Sstevel@tonic-gate 		 * on Korean keyboards.  They report only on press, and
12067c478bd9Sstevel@tonic-gate 		 * so we synthesize a release.  Most likely this will
12077c478bd9Sstevel@tonic-gate 		 * never be important to polled  I/O, but if I do it
12087c478bd9Sstevel@tonic-gate 		 * "right" the first time it _won't_ be an issue.
12097c478bd9Sstevel@tonic-gate 		 */
12107c478bd9Sstevel@tonic-gate 		if (synthetic_release_needed) {
12117c478bd9Sstevel@tonic-gate 			kb8042->polled_synthetic_release_pending = B_TRUE;
12127c478bd9Sstevel@tonic-gate 			kb8042->polled_synthetic_release_key = *key;
12137c478bd9Sstevel@tonic-gate 		}
12147c478bd9Sstevel@tonic-gate 
12157c478bd9Sstevel@tonic-gate 		if (kb8042->simulated_kbd_type == KB_USB) {
12167c478bd9Sstevel@tonic-gate 			*key = keytab_pc2usb[*key];
12177c478bd9Sstevel@tonic-gate 		}
12187c478bd9Sstevel@tonic-gate 		return (B_TRUE);
12197c478bd9Sstevel@tonic-gate 	}
12207c478bd9Sstevel@tonic-gate }
12217c478bd9Sstevel@tonic-gate 
12227c478bd9Sstevel@tonic-gate static void
1223fd9cb95cSsethg kb8042_setled(struct kb8042 *kb8042, int led_state, boolean_t polled)
1224fd9cb95cSsethg {
1225fd9cb95cSsethg 	kb8042->leds.desired = led_state;
1226fd9cb95cSsethg 
1227fd9cb95cSsethg 	if (!polled)
1228fd9cb95cSsethg 		mutex_enter(&kb8042->w_hw_mutex);
1229fd9cb95cSsethg 
1230bb2d7d5eSSeth Goldberg 	if (kb8042->leds.desired != kb8042->leds.commanded) {
1231bb2d7d5eSSeth Goldberg 		kb8042_send_to_keyboard(kb8042, KB_SET_LED, polled);
1232bb2d7d5eSSeth Goldberg 	}
1233fd9cb95cSsethg 
1234fd9cb95cSsethg 	if (!polled)
1235fd9cb95cSsethg 		mutex_exit(&kb8042->w_hw_mutex);
1236fd9cb95cSsethg }
1237fd9cb95cSsethg 
1238fd9cb95cSsethg static void
12397c478bd9Sstevel@tonic-gate kb8042_polled_setled(struct kbtrans_hardware *hw, int led_state)
12407c478bd9Sstevel@tonic-gate {
12417c478bd9Sstevel@tonic-gate 	struct kb8042 *kb8042 = (struct kb8042 *)hw;
1242fd9cb95cSsethg 	kb8042_setled(kb8042, led_state, B_TRUE);
1243fd9cb95cSsethg }
12447c478bd9Sstevel@tonic-gate 
1245fd9cb95cSsethg static void
1246fd9cb95cSsethg kb8042_streams_setled(struct kbtrans_hardware *hw, int led_state)
1247fd9cb95cSsethg {
1248fd9cb95cSsethg 	struct kb8042 *kb8042 = (struct kb8042 *)hw;
1249fd9cb95cSsethg 	kb8042_setled(kb8042, led_state, B_FALSE);
12507c478bd9Sstevel@tonic-gate }
12517c478bd9Sstevel@tonic-gate 
1252*15bfc6b7SSeth Goldberg 
1253*15bfc6b7SSeth Goldberg static int
1254*15bfc6b7SSeth Goldberg kb8042_send_and_wait(struct kb8042 *kb8042, uint8_t u8, boolean_t polled)
1255*15bfc6b7SSeth Goldberg {
1256*15bfc6b7SSeth Goldberg 	uint8_t *outp = kb8042->addr +
1257*15bfc6b7SSeth Goldberg 	    (polled ? I8042_POLL_OUTPUT_DATA : I8042_INT_OUTPUT_DATA);
1258*15bfc6b7SSeth Goldberg 	uint8_t *inavp = kb8042->addr +
1259*15bfc6b7SSeth Goldberg 	    (polled ? I8042_POLL_INPUT_AVAIL : I8042_INT_INPUT_AVAIL);
1260*15bfc6b7SSeth Goldberg 	uint8_t *inp = kb8042->addr +
1261*15bfc6b7SSeth Goldberg 	    (polled ? I8042_POLL_INPUT_DATA : I8042_INT_INPUT_DATA);
1262*15bfc6b7SSeth Goldberg 	uint8_t b;
1263*15bfc6b7SSeth Goldberg 	int ms_waited;
1264*15bfc6b7SSeth Goldberg 	int timedout;
1265*15bfc6b7SSeth Goldberg 	int expire;
1266*15bfc6b7SSeth Goldberg 	int retries = 0;
1267*15bfc6b7SSeth Goldberg 
1268*15bfc6b7SSeth Goldberg 	do {
1269*15bfc6b7SSeth Goldberg 		kb8042->acked = 0;
1270*15bfc6b7SSeth Goldberg 		kb8042->need_retry = 0;
1271*15bfc6b7SSeth Goldberg 		ms_waited = 0;		/* Zero it whether polled or not */
1272*15bfc6b7SSeth Goldberg 		timedout = 0;
1273*15bfc6b7SSeth Goldberg 
1274*15bfc6b7SSeth Goldberg 		ddi_put8(kb8042->handle, outp, u8);
1275*15bfc6b7SSeth Goldberg 
1276*15bfc6b7SSeth Goldberg 		while (!kb8042->acked && !kb8042->need_retry && !timedout) {
1277*15bfc6b7SSeth Goldberg 
1278*15bfc6b7SSeth Goldberg 			if (polled) {
1279*15bfc6b7SSeth Goldberg 				if (ddi_get8(kb8042->handle, inavp)) {
1280*15bfc6b7SSeth Goldberg 					b = ddi_get8(kb8042->handle, inp);
1281*15bfc6b7SSeth Goldberg 					switch (b) {
1282*15bfc6b7SSeth Goldberg 					case KB_ACK:
1283*15bfc6b7SSeth Goldberg 						kb8042->acked = 1;
1284*15bfc6b7SSeth Goldberg 						break;
1285*15bfc6b7SSeth Goldberg 					case KB_RESEND:
1286*15bfc6b7SSeth Goldberg 						kb8042->need_retry = 1;
1287*15bfc6b7SSeth Goldberg 						break;
1288*15bfc6b7SSeth Goldberg 					default:
1289*15bfc6b7SSeth Goldberg 						/*
1290*15bfc6b7SSeth Goldberg 						 * drop it: We should never
1291*15bfc6b7SSeth Goldberg 						 * get scancodes while
1292*15bfc6b7SSeth Goldberg 						 * we're in the middle of a
1293*15bfc6b7SSeth Goldberg 						 * command anyway.
1294*15bfc6b7SSeth Goldberg 						 */
1295*15bfc6b7SSeth Goldberg #ifdef DEBUG
1296*15bfc6b7SSeth Goldberg 						cmn_err(CE_WARN, "!Unexpected "
1297*15bfc6b7SSeth Goldberg 						    " byte 0x%x", b);
1298*15bfc6b7SSeth Goldberg #endif
1299*15bfc6b7SSeth Goldberg 						break;
1300*15bfc6b7SSeth Goldberg 					}
1301*15bfc6b7SSeth Goldberg 				}
1302*15bfc6b7SSeth Goldberg 
1303*15bfc6b7SSeth Goldberg 				/*
1304*15bfc6b7SSeth Goldberg 				 * Wait 1ms if an ACK wasn't received yet
1305*15bfc6b7SSeth Goldberg 				 */
1306*15bfc6b7SSeth Goldberg 				if (!kb8042->acked) {
1307*15bfc6b7SSeth Goldberg 					drv_usecwait(1000);
1308*15bfc6b7SSeth Goldberg 					ms_waited++;
1309*15bfc6b7SSeth Goldberg 					if (ms_waited >= MAX_KB8042_WAIT_MAX_MS)
1310*15bfc6b7SSeth Goldberg 						timedout = B_TRUE;
1311*15bfc6b7SSeth Goldberg 				}
1312*15bfc6b7SSeth Goldberg 			} else {
1313*15bfc6b7SSeth Goldberg 				/* Interrupt-driven */
1314*15bfc6b7SSeth Goldberg 				expire = ddi_get_lbolt() +
1315*15bfc6b7SSeth Goldberg 				    drv_usectohz(MAX_KB8042_WAIT_MAX_MS * 1000);
1316*15bfc6b7SSeth Goldberg 
1317*15bfc6b7SSeth Goldberg 				/*
1318*15bfc6b7SSeth Goldberg 				 * If cv_timedwait returned -1 and we neither
1319*15bfc6b7SSeth Goldberg 				 * received an ACK nor a RETRY response, then
1320*15bfc6b7SSeth Goldberg 				 * we timed out.
1321*15bfc6b7SSeth Goldberg 				 */
1322*15bfc6b7SSeth Goldberg 				if (cv_timedwait(&kb8042->cmd_cv,
1323*15bfc6b7SSeth Goldberg 				    &kb8042->w_hw_mutex, expire) == -1 &&
1324*15bfc6b7SSeth Goldberg 				    !kb8042->acked && !kb8042->need_retry) {
1325*15bfc6b7SSeth Goldberg 					timedout = B_TRUE;
1326*15bfc6b7SSeth Goldberg 				}
1327*15bfc6b7SSeth Goldberg 			}
1328*15bfc6b7SSeth Goldberg 
1329*15bfc6b7SSeth Goldberg 		}
1330*15bfc6b7SSeth Goldberg 	} while ((kb8042->need_retry || timedout) &&
1331*15bfc6b7SSeth Goldberg 	    ++retries < MAX_KB8042_RETRIES);
1332*15bfc6b7SSeth Goldberg 
1333*15bfc6b7SSeth Goldberg 	return (kb8042->acked);
1334*15bfc6b7SSeth Goldberg }
1335*15bfc6b7SSeth Goldberg 
1336*15bfc6b7SSeth Goldberg /*
1337*15bfc6b7SSeth Goldberg  * kb8042_send_to_keyboard should be called with w_hw_mutex held if
1338*15bfc6b7SSeth Goldberg  * polled is FALSE.
1339*15bfc6b7SSeth Goldberg  */
13407c478bd9Sstevel@tonic-gate static void
13417c478bd9Sstevel@tonic-gate kb8042_send_to_keyboard(struct kb8042 *kb8042, int byte, boolean_t polled)
13427c478bd9Sstevel@tonic-gate {
1343bb2d7d5eSSeth Goldberg 
1344bb2d7d5eSSeth Goldberg 	/*
1345*15bfc6b7SSeth Goldberg 	 * KB_SET_LED and KB_ENABLE are special commands which require blocking
1346*15bfc6b7SSeth Goldberg 	 * other 8042 consumers while executing.
1347bb2d7d5eSSeth Goldberg 	 *
1348bb2d7d5eSSeth Goldberg 	 * Other commands/data are sent using the single put8 I/O access
1349bb2d7d5eSSeth Goldberg 	 * function.
1350bb2d7d5eSSeth Goldberg 	 */
1351bb2d7d5eSSeth Goldberg 	if (byte == KB_SET_LED) {
1352*15bfc6b7SSeth Goldberg 
1353*15bfc6b7SSeth Goldberg 		if (!polled) {
1354*15bfc6b7SSeth Goldberg 			(void) ddi_get8(kb8042->handle, kb8042->addr +
1355*15bfc6b7SSeth Goldberg 			    I8042_LOCK);
1356*15bfc6b7SSeth Goldberg 		}
1357*15bfc6b7SSeth Goldberg 
1358*15bfc6b7SSeth Goldberg 		if (kb8042_send_and_wait(kb8042, KB_SET_LED, polled)) {
1359bb2d7d5eSSeth Goldberg 			/*
1360*15bfc6b7SSeth Goldberg 			 * Ignore return value, as there's nothing we can
1361*15bfc6b7SSeth Goldberg 			 * do about it if the SET LED command fails.
1362bb2d7d5eSSeth Goldberg 			 */
1363*15bfc6b7SSeth Goldberg 			(void) kb8042_send_and_wait(kb8042,
1364*15bfc6b7SSeth Goldberg 			    kb8042_xlate_leds(kb8042->leds.desired), polled);
1365*15bfc6b7SSeth Goldberg 		}
1366*15bfc6b7SSeth Goldberg 
1367*15bfc6b7SSeth Goldberg 		if (!polled) {
1368*15bfc6b7SSeth Goldberg 			(void) ddi_get8(kb8042->handle, kb8042->addr +
1369*15bfc6b7SSeth Goldberg 			    I8042_UNLOCK);
1370bb2d7d5eSSeth Goldberg 		}
1371bb2d7d5eSSeth Goldberg 		kb8042->leds.commanded = kb8042->leds.desired;
1372bb2d7d5eSSeth Goldberg 
1373bb2d7d5eSSeth Goldberg 	} else if (byte == KB_ENABLE) {
1374bb2d7d5eSSeth Goldberg 
1375*15bfc6b7SSeth Goldberg 		if (!polled) {
1376*15bfc6b7SSeth Goldberg 			(void) ddi_get8(kb8042->handle, kb8042->addr +
1377*15bfc6b7SSeth Goldberg 			    I8042_LOCK);
1378bb2d7d5eSSeth Goldberg 		}
1379*15bfc6b7SSeth Goldberg 
1380*15bfc6b7SSeth Goldberg 		(void) kb8042_send_and_wait(kb8042, KB_ENABLE, polled);
1381*15bfc6b7SSeth Goldberg 
1382*15bfc6b7SSeth Goldberg 		if (!polled) {
1383*15bfc6b7SSeth Goldberg 			(void) ddi_get8(kb8042->handle, kb8042->addr +
1384*15bfc6b7SSeth Goldberg 			    I8042_UNLOCK);
1385*15bfc6b7SSeth Goldberg 		}
1386*15bfc6b7SSeth Goldberg 
1387bb2d7d5eSSeth Goldberg 	} else {
1388bb2d7d5eSSeth Goldberg 		/* All other commands use the "normal" virtual output port */
13897c478bd9Sstevel@tonic-gate 		if (polled) {
13907c478bd9Sstevel@tonic-gate 			ddi_put8(kb8042->handle,
13917c478bd9Sstevel@tonic-gate 			    kb8042->addr + I8042_POLL_OUTPUT_DATA, byte);
13927c478bd9Sstevel@tonic-gate 		} else {
13937c478bd9Sstevel@tonic-gate 			ddi_put8(kb8042->handle,
13947c478bd9Sstevel@tonic-gate 			    kb8042->addr + I8042_INT_OUTPUT_DATA, byte);
13957c478bd9Sstevel@tonic-gate 		}
1396bb2d7d5eSSeth Goldberg 	}
13977c478bd9Sstevel@tonic-gate }
13987c478bd9Sstevel@tonic-gate 
13997c478bd9Sstevel@tonic-gate /*
14007c478bd9Sstevel@tonic-gate  * Wait until the keyboard is fully up, maybe.
14017c478bd9Sstevel@tonic-gate  * We may be the first person to talk to the keyboard, in which case
14027c478bd9Sstevel@tonic-gate  * it's patiently waiting to say "AA" to us to tell us it's up.
14037c478bd9Sstevel@tonic-gate  * In theory it sends the AA in 300ms < n < 9s, but it's a pretty
14047c478bd9Sstevel@tonic-gate  * good bet that we've already spent that long getting to that point,
14057c478bd9Sstevel@tonic-gate  * so we'll only wait long enough for the communications electronics to
14067c478bd9Sstevel@tonic-gate  * run.
14077c478bd9Sstevel@tonic-gate  */
14087c478bd9Sstevel@tonic-gate static void
14097c478bd9Sstevel@tonic-gate kb8042_wait_poweron(struct kb8042 *kb8042)
14107c478bd9Sstevel@tonic-gate {
14117c478bd9Sstevel@tonic-gate 	int cnt;
14127c478bd9Sstevel@tonic-gate 	int ready;
14137c478bd9Sstevel@tonic-gate 
1414fd9cb95cSsethg 	/* wait for up to 250 ms for a response */
14157c478bd9Sstevel@tonic-gate 	for (cnt = 0; cnt < 250; cnt++) {
14167c478bd9Sstevel@tonic-gate 		ready = ddi_get8(kb8042->handle,
14177c478bd9Sstevel@tonic-gate 		    kb8042->addr + I8042_INT_INPUT_AVAIL);
14187c478bd9Sstevel@tonic-gate 		if (ready != 0)
14197c478bd9Sstevel@tonic-gate 			break;
14207c478bd9Sstevel@tonic-gate 		drv_usecwait(1000);
14217c478bd9Sstevel@tonic-gate 	}
14227c478bd9Sstevel@tonic-gate 
14237c478bd9Sstevel@tonic-gate 	/*
14247c478bd9Sstevel@tonic-gate 	 * If there's something pending, read and discard it.  If not,
14257c478bd9Sstevel@tonic-gate 	 * assume things are OK anyway - maybe somebody else ate it
14267c478bd9Sstevel@tonic-gate 	 * already.  (On a PC, the BIOS almost certainly did.)
14277c478bd9Sstevel@tonic-gate 	 */
14287c478bd9Sstevel@tonic-gate 	if (ready != 0) {
1429*15bfc6b7SSeth Goldberg 		(void) ddi_get8(kb8042->handle,
14307c478bd9Sstevel@tonic-gate 		    kb8042->addr + I8042_INT_INPUT_DATA);
14317c478bd9Sstevel@tonic-gate 	}
14327c478bd9Sstevel@tonic-gate }
14337c478bd9Sstevel@tonic-gate 
14347c478bd9Sstevel@tonic-gate static int
14357c478bd9Sstevel@tonic-gate kb8042_xlate_leds(int led)
14367c478bd9Sstevel@tonic-gate {
14377c478bd9Sstevel@tonic-gate 	int res;
14387c478bd9Sstevel@tonic-gate 
14397c478bd9Sstevel@tonic-gate 	res = 0;
14407c478bd9Sstevel@tonic-gate 
14417c478bd9Sstevel@tonic-gate 	if (led & LED_NUM_LOCK)
14427c478bd9Sstevel@tonic-gate 		res |= LED_NUM;
14437c478bd9Sstevel@tonic-gate 	if (led & LED_SCROLL_LOCK)
14447c478bd9Sstevel@tonic-gate 		res |= LED_SCR;
14457c478bd9Sstevel@tonic-gate 	if (led & LED_CAPS_LOCK)
14467c478bd9Sstevel@tonic-gate 		res |= LED_CAP;
14477c478bd9Sstevel@tonic-gate 
14487c478bd9Sstevel@tonic-gate 	return (res);
14497c478bd9Sstevel@tonic-gate }
14507c478bd9Sstevel@tonic-gate 
14517c478bd9Sstevel@tonic-gate /*ARGSUSED*/
14527c478bd9Sstevel@tonic-gate static void
14537c478bd9Sstevel@tonic-gate kb8042_get_initial_leds(
14547c478bd9Sstevel@tonic-gate     struct kb8042 *kb8042,
14557c478bd9Sstevel@tonic-gate     int *initial_leds,
14567c478bd9Sstevel@tonic-gate     int *initial_led_mask)
14577c478bd9Sstevel@tonic-gate {
1458bb2d7d5eSSeth Goldberg #if defined(__i386) || defined(__amd64)
14597c478bd9Sstevel@tonic-gate 	extern caddr_t	p0_va;
14607c478bd9Sstevel@tonic-gate 	uint8_t		bios_kb_flag;
14617c478bd9Sstevel@tonic-gate 
14627c478bd9Sstevel@tonic-gate 	bios_kb_flag = p0_va[BIOS_KB_FLAG];
14637c478bd9Sstevel@tonic-gate 
14647c478bd9Sstevel@tonic-gate 	*initial_led_mask = LED_CAPS_LOCK | LED_NUM_LOCK | LED_SCROLL_LOCK;
14657c478bd9Sstevel@tonic-gate 	*initial_leds = 0;
14667c478bd9Sstevel@tonic-gate 	if (bios_kb_flag & BIOS_CAPS_STATE)
14677c478bd9Sstevel@tonic-gate 		*initial_leds |= LED_CAPS_LOCK;
14687c478bd9Sstevel@tonic-gate 	if (bios_kb_flag & BIOS_NUM_STATE)
14697c478bd9Sstevel@tonic-gate 		*initial_leds |= LED_NUM_LOCK;
14707c478bd9Sstevel@tonic-gate 	if (bios_kb_flag & BIOS_SCROLL_STATE)
14717c478bd9Sstevel@tonic-gate 		*initial_leds |= LED_SCROLL_LOCK;
14727c478bd9Sstevel@tonic-gate #else
14737c478bd9Sstevel@tonic-gate 	*initial_leds = 0;
14747c478bd9Sstevel@tonic-gate 	*initial_led_mask = 0;
14757c478bd9Sstevel@tonic-gate #endif
14767c478bd9Sstevel@tonic-gate }
14777c478bd9Sstevel@tonic-gate 
14787c478bd9Sstevel@tonic-gate static boolean_t
14797c478bd9Sstevel@tonic-gate kb8042_autorepeat_detect(
14807c478bd9Sstevel@tonic-gate     struct kb8042 *kb8042,
14817c478bd9Sstevel@tonic-gate     int key_pos,
14827c478bd9Sstevel@tonic-gate     enum keystate state)
14837c478bd9Sstevel@tonic-gate {
14847c478bd9Sstevel@tonic-gate 	if (state == KEY_RELEASED) {
14857c478bd9Sstevel@tonic-gate 		if (kb8042->kb_old_key_pos == key_pos)
14867c478bd9Sstevel@tonic-gate 			kb8042->kb_old_key_pos = 0;
14877c478bd9Sstevel@tonic-gate 	} else {
14887c478bd9Sstevel@tonic-gate 		if (kb8042->kb_old_key_pos == key_pos) {
14897c478bd9Sstevel@tonic-gate 			return (B_TRUE);
14907c478bd9Sstevel@tonic-gate 		}
14917c478bd9Sstevel@tonic-gate 		kb8042->kb_old_key_pos = key_pos;
14927c478bd9Sstevel@tonic-gate 	}
14937c478bd9Sstevel@tonic-gate 	return (B_FALSE);
14947c478bd9Sstevel@tonic-gate }
14957c478bd9Sstevel@tonic-gate 
14967c478bd9Sstevel@tonic-gate /* ARGSUSED */
14977c478bd9Sstevel@tonic-gate static void
14987c478bd9Sstevel@tonic-gate kb8042_type4_cmd(struct kb8042 *kb8042, int cmd)
14997c478bd9Sstevel@tonic-gate {
15007c478bd9Sstevel@tonic-gate 	switch (cmd) {
15017c478bd9Sstevel@tonic-gate 	case KBD_CMD_BELL:
1502c35aa225Smarx 		(void) beeper_on(BEEP_TYPE4);
15037c478bd9Sstevel@tonic-gate 		break;
15047c478bd9Sstevel@tonic-gate 	case KBD_CMD_NOBELL:
1505c35aa225Smarx 		(void) beeper_off();
15067c478bd9Sstevel@tonic-gate 		break;
15077c478bd9Sstevel@tonic-gate 	}
15087c478bd9Sstevel@tonic-gate }
15097c478bd9Sstevel@tonic-gate 
15107c478bd9Sstevel@tonic-gate 
15117c478bd9Sstevel@tonic-gate /*
15127c478bd9Sstevel@tonic-gate  * This is a pass-thru routine to get a character at poll time.
15137c478bd9Sstevel@tonic-gate  */
15147c478bd9Sstevel@tonic-gate static int
1515281f0747Slt200341 kb8042_polled_getchar(cons_polledio_arg_t arg)
15167c478bd9Sstevel@tonic-gate {
15177c478bd9Sstevel@tonic-gate 	struct kb8042	*kb8042;
15187c478bd9Sstevel@tonic-gate 
15197c478bd9Sstevel@tonic-gate 	kb8042 = (struct kb8042 *)arg;
15207c478bd9Sstevel@tonic-gate 
15217c478bd9Sstevel@tonic-gate 	return (kbtrans_getchar(kb8042->hw_kbtrans));
15227c478bd9Sstevel@tonic-gate }
15237c478bd9Sstevel@tonic-gate 
15247c478bd9Sstevel@tonic-gate /*
15257c478bd9Sstevel@tonic-gate  * This is a pass-thru routine to get a character at poll time.
15267c478bd9Sstevel@tonic-gate  */
15277c478bd9Sstevel@tonic-gate static int
1528281f0747Slt200341 kb8042_polled_ischar(cons_polledio_arg_t arg)
15297c478bd9Sstevel@tonic-gate {
15307c478bd9Sstevel@tonic-gate 	struct kb8042	*kb8042;
15317c478bd9Sstevel@tonic-gate 
15327c478bd9Sstevel@tonic-gate 	kb8042 = (struct kb8042 *)arg;
15337c478bd9Sstevel@tonic-gate 
15347c478bd9Sstevel@tonic-gate 	return (kbtrans_ischar(kb8042->hw_kbtrans));
15357c478bd9Sstevel@tonic-gate }
1536