io/kb8042/kb8042.c

	kb8042.c revision e8ed0869d5c65afe0c37c4755bf81f7381d1f43c
/*
 * CDDL HEADER START
 *
 * The contents of this file are subject to the terms of the
 * Common Development and Distribution License (the "License").
 * You may not use this file except in compliance with the License.
 *
 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
 * or http://www.opensolaris.org/os/licensing.
 * See the License for the specific language governing permissions
 * and limitations under the License.
 *
 * When distributing Covered Code, include this CDDL HEADER in each
 * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
 * If applicable, add the following below this CDDL HEADER, with the
 * fields enclosed by brackets "[]" replaced with your own identifying
 * information: Portions Copyright [yyyy] [name of copyright owner]
 *
 * CDDL HEADER END
 */
/*  Copyright (c) 1990, 1991 UNIX System Laboratories, Inc. */
/*  Copyright (c) 1984, 1986, 1987, 1988, 1989, 1990 AT&T   */
/*    All Rights Reserved   */

/*
 * Copyright 2008 Sun Microsystems, Inc.  All rights reserved.
 * Use is subject to license terms.
 */

#define KEYMAP_SIZE_VARIABLE

#include <sys/types.h>
#include <sys/errno.h>
#include <sys/inline.h>
#include <sys/termio.h>
#include <sys/stropts.h>
#include <sys/termios.h>
#include <sys/stream.h>
#include <sys/strtty.h>
#include <sys/strsubr.h>
#include <sys/strsun.h>
#include <sys/ddi.h>
#include <sys/sunddi.h>
#include <sys/note.h>
#include "sys/consdev.h"
#include <sys/kbd.h>
#include <sys/kbtrans.h>
#include "kb8042.h"

#include <sys/i8042.h>

#include "sys/kbio.h"       /* for KIOCSLAYOUT */
#include "sys/stat.h"
#include "sys/reboot.h"
#include <sys/promif.h>
#include <sys/beep.h>
#include <sys/inttypes.h>

/*
 * For any keyboard, there is a unique code describing the position
 * of the key on a keyboard. We refer to the code as "station number".
 * The following table is used to map the station numbers from ps2
 * AT/XT keyboards to that of a USB one.
 *
 * A mapping was added for entry K8042_STOP, to map to USB key code 120 (which
 * maps to the STOP key) when in KB_USB mode, and maps to a HOLE entry
 * when in KB_PC mode.  Note that this does not need to be made conditional
 * on the architecture for which this module is complied because there are no
 * keys that map to K8042_STOP on non-SPARC platforms.
 */
static kbtrans_key_t keytab_pc2usb[KBTRANS_KEYNUMS_MAX] = {
/*  0 */    0,  53, 30, 31, 32, 33, 34, 35,
/*  8 */    36, 37, 38, 39, 45, 46, 137,    42,
/* 16 */    43, 20, 26, 8,  21, 23, 28, 24,
/* 24 */    12, 18, 19, 47, 48, 49, 57, 4,
/* 32 */    22, 7,  9,  10, 11, 13, 14, 15,
/* 40 */    51, 52, 50, 40, 225,    100,    29, 27,
/* 48 */    6,  25, 5,  17, 16, 54, 55, 56,
/* 56 */    135,    229,    224,    227,    226,    44, 230,    231,
/* 64 */    228,    101,    0,  0,  0,  0,  0,  0,
/* 72 */    0,  0,  0,  73, 76, 0,  0,  80,
/* 80 */    74, 77, 0,  82, 81, 75, 78, 0,
/* 88 */    0,  79, 83, 95, 92, 89, 0,  84,
/* 96 */    96, 93, 90, 98, 85, 97, 94, 91,
/* 104 */   99, 86, 87, 133,    88, 0,  41, 0,
/* 112 */   58, 59, 60, 61, 62, 63, 64, 65,
/* 120 */   66, 67, 68, 69, 70, 71, 72, 0,
/* 128 */   0,  0,  0,  139,    138,    136,    0,  0,
/* 136 */   0,  0,  0,  0,  0,  0,  0,  0,
/* 144 */   0,  0,  0,  0,  0,  0,  0,  0,
/* 152 */   0,  0,  0,  0,  0,  0,  0,  0,
/* 160 */   120,    0,  0,  0,  0,  0,  0,  0,
/* 168 */   0,  0,  0,  0,  0,  0,  0,  0,
/* 176 */   0,  0,  0,  0,  0,  0,  0,  0,
/* 184 */   0,  0,  0,  0,  0,  0,  0,  0,
/* 192 */   0,  0,  0,  0,  0,  0,  0,  0,
/* 200 */   0,  0,  0,  0,  0,  0,  0,  0,
/* 208 */   0,  0,  0,  0,  0,  0,  0,  0,
/* 216 */   0,  0,  0,  0,  0,  0,  0,  0,
/* 224 */   0,  0,  0,  0,  0,  0,  0,  0,
/* 232 */   0,  0,  0,  0,  0,  0,  0,  0,
/* 240 */   0,  0,  0,  0,  0,  0,  0,  0,
/* 248 */   0,  0,  0,  0
};

/*
 * DEBUG (or KD_DEBUG for just this module) turns on a flag called
 * kb8042_enable_debug_hotkey.  If kb8042_enable_debug_hotkey is true,
 * then the following hotkeys are enabled:
 *    F10 - turn on debugging "normal" translations
 *    F9  - turn on debugging "getchar" translations
 *    F8  - turn on "low level" debugging
 *    F7  - turn on terse press/release debugging
 *    F1  - turn off all debugging
 * The default value for kb8042_enable_debug_hotkey is false, disabling
 * these hotkeys.
 */

#if defined(DEBUG) || defined(lint)
#define KD_DEBUG
#endif

#ifdef  KD_DEBUG
boolean_t   kb8042_enable_debug_hotkey = B_FALSE;
boolean_t   kb8042_debug = B_FALSE;
boolean_t   kb8042_getchar_debug = B_FALSE;
boolean_t   kb8042_low_level_debug = B_FALSE;
boolean_t   kb8042_pressrelease_debug = B_FALSE;
static void kb8042_debug_hotkey(int scancode);
#endif

#ifdef __sparc
#define USECS_PER_WAIT 100
#define MAX_WAIT_USECS 100000 /* in usecs = 100 ms */
#define MIN_DELAY_USECS USECS_PER_WAIT

boolean_t kb8042_warn_unknown_scanset = B_TRUE;
int kb8042_default_scanset = 2;

#endif

enum state_return { STATE_NORMAL, STATE_INTERNAL };

static void kb8042_init(struct kb8042 *kb8042, boolean_t from_resume);
static uint_t kb8042_intr(caddr_t arg);
static void kb8042_wait_poweron(struct kb8042 *kb8042);
static void kb8042_send_to_keyboard(struct kb8042 *, int, boolean_t);
static int kb8042_xlate_leds(int);
static void kb8042_setled(struct kb8042 *, int led_state, boolean_t polled);
static void kb8042_streams_setled(struct kbtrans_hardware *hw, int led_state);
static void kb8042_polled_setled(struct kbtrans_hardware *hw, int led_state);
static boolean_t kb8042_polled_keycheck(
            struct kbtrans_hardware *hw, int *key,
            enum keystate *state);
static void kb8042_get_initial_leds(struct kb8042 *, int *, int *);
static boolean_t kb8042_autorepeat_detect(struct kb8042 *kb8042, int key_pos,
            enum keystate state);
static void kb8042_type4_cmd(struct kb8042 *kb8042, int cmd);
static void kb8042_ioctlmsg(struct kb8042 *kb8042, queue_t *, mblk_t *);
static void kb8042_iocdatamsg(queue_t *, mblk_t *);
static void kb8042_process_key(struct kb8042 *, kbtrans_key_t, enum keystate);
static int kb8042_polled_ischar(cons_polledio_arg_t arg);
static int kb8042_polled_getchar(cons_polledio_arg_t arg);
static void kb8042_cleanup(struct kb8042 *kb8042);

static struct kbtrans_callbacks kb8042_callbacks = {
    kb8042_streams_setled,
    kb8042_polled_setled,
    kb8042_polled_keycheck,
};

extern struct keyboard keyindex_pc;

#define DRIVER_NAME(dip) ddi_driver_name(dip)

static  char    module_name[] = "kb8042";

static int kb8042_open(queue_t *qp, dev_t *devp, int flag, int sflag,
            cred_t *credp);
static int kb8042_close(queue_t *qp, int flag, cred_t *credp);
static int kb8042_wsrv();

struct module_info kb8042_sinfo = {
    42,     /* Module ID */
    module_name,
    0, 32,      /* Minimum and maximum packet sizes */
    256, 128    /* High and low water marks */
};

static struct qinit kb8042_rinit = {
    NULL, NULL, kb8042_open, kb8042_close, NULL, &kb8042_sinfo, NULL
};

static struct qinit kb8042_winit = {
    putq, kb8042_wsrv, kb8042_open, kb8042_close, NULL, &kb8042_sinfo, NULL
};

struct streamtab
    kb8042_str_info = { &kb8042_rinit, &kb8042_winit, NULL, NULL };

struct kb8042   Kdws = {0};
static dev_info_t *kb8042_dip = NULL;

static int kb8042_getinfo(dev_info_t *dip, ddi_info_cmd_t infocmd, void *arg,
        void **result);
static int kb8042_attach(dev_info_t *, ddi_attach_cmd_t);
static int kb8042_detach(dev_info_t *, ddi_detach_cmd_t);

static  struct cb_ops cb_kb8042_ops = {
    nulldev,        /* cb_open */
    nulldev,        /* cb_close */
    nodev,          /* cb_strategy */
    nodev,          /* cb_print */
    nodev,          /* cb_dump */
    nodev,          /* cb_read */
    nodev,          /* cb_write */
    nodev,          /* cb_ioctl */
    nodev,          /* cb_devmap */
    nodev,          /* cb_mmap */
    nodev,          /* cb_segmap */
    nochpoll,       /* cb_chpoll */
    ddi_prop_op,        /* cb_prop_op */
    &kb8042_str_info,   /* cb_stream */
    D_MP
};

struct dev_ops kb8042_ops = {
    DEVO_REV,       /* devo_rev */
    0,          /* devo_refcnt */
    kb8042_getinfo,     /* devo_getinfo */
    nulldev,        /* devo_identify */
    nulldev,        /* devo_probe */
    kb8042_attach,      /* devo_attach */
    kb8042_detach,      /* devo_detach */
    nodev,          /* devo_reset */
    &cb_kb8042_ops,     /* devo_cb_ops */
    (struct bus_ops *)NULL, /* devo_bus_ops */
    NULL,           /* devo_power */
    ddi_quiesce_not_needed, /* devo_quiesce */
};


/*
 * This is the loadable module wrapper.
 */
#include <sys/modctl.h>

/*
 * Module linkage information for the kernel.
 */
static struct modldrv modldrv = {
    &mod_driverops, /* Type of module.  This one is a driver */
    "PS/2 keyboard driver",
    &kb8042_ops,    /* driver ops */
};

static struct modlinkage modlinkage = {
    MODREV_1,
    (void *) &modldrv,
    NULL
};

int
_init(void)
{
    int rv;

    rv = mod_install(&modlinkage);
    return (rv);
}


int
_fini(void)
{
    return (mod_remove(&modlinkage));
}

int
_info(struct modinfo *modinfop)
{
    return (mod_info(&modlinkage, modinfop));
}

#ifdef __sparc
static boolean_t
kb8042_is_input_avail(struct kb8042 *kb8042, int timeout_usec, boolean_t polled)
{
    int i;
    int port = (polled == B_TRUE) ? I8042_POLL_INPUT_AVAIL :
        I8042_INT_INPUT_AVAIL;
    int reps = timeout_usec / USECS_PER_WAIT;

    for (i = 0; i < reps; i++) {
        if (ddi_get8(kb8042->handle, kb8042->addr + port) != 0)
            return (B_TRUE);

        if (i < (reps - 1))
            drv_usecwait(USECS_PER_WAIT);
    }
    return (B_FALSE);
}

static void
kb8042_clear_input_buffer(struct kb8042 *kb8042, boolean_t polled)
{
    int port = (polled == B_TRUE) ? I8042_POLL_INPUT_DATA :
        I8042_INT_INPUT_DATA;

    while (kb8042_is_input_avail(kb8042, MIN_DELAY_USECS, polled)) {
        (void) ddi_get8(kb8042->handle, kb8042->addr + port);
    }
}

static boolean_t
kb8042_send_and_expect(struct kb8042 *kb8042, uint8_t send, uint8_t expect,
    boolean_t polled, int timeout, int *error, uint8_t *got)
{
    int port = (polled == B_TRUE) ? I8042_POLL_INPUT_DATA :
        I8042_INT_INPUT_DATA;
    uint8_t datab;
    int err;
    boolean_t rval;

    kb8042_send_to_keyboard(kb8042, send, polled);

    if (kb8042_is_input_avail(kb8042, timeout, polled)) {
        err = 0;
        datab = ddi_get8(kb8042->handle, kb8042->addr + port);
        rval = ((datab == expect) ? B_TRUE : B_FALSE);
    } else {
        err = EAGAIN;
        rval = B_FALSE;
    }

    if (error != NULL)
        *error = err;
    if (got != NULL)
        *got = datab;
    return (rval);
}

static const char *
kb8042_error_string(int errcode)
{
    switch (errcode) {
    case EAGAIN:
        return ("Timed out");
    default:
        return ("Unknown error");
    }
}

static int
kb8042_read_scanset(struct kb8042 *kb8042, boolean_t polled)
{
    int scanset = -1;
    int port = (polled == B_TRUE) ? I8042_POLL_INPUT_DATA :
        I8042_INT_INPUT_DATA;
    int err;
    uint8_t got;

    kb8042_clear_input_buffer(kb8042, B_TRUE);

    /*
     * Send a "change scan code set" command to the keyboard.
     * It should respond with an ACK.
     */
    if (kb8042_send_and_expect(kb8042, KB_SET_SCAN, KB_ACK, polled,
        MAX_WAIT_USECS, &err, &got) != B_TRUE) {
        goto fail_read_scanset;
    }

    /*
     * Send a 0.  The keyboard should ACK the 0, then it should send the
     * scan code set in use.
     */
    if (kb8042_send_and_expect(kb8042, 0, KB_ACK, polled,
        MAX_WAIT_USECS, &err, &got) != B_TRUE) {
        goto fail_read_scanset;
    }

    /*
     * The next input byte from the keyboard should be the scan code
     * set in use, though some keyboards like to send a few more acks
     * just for fun, so blow past those to get the keyboard scan code.
     */
    while (kb8042_is_input_avail(kb8042, MAX_WAIT_USECS, B_TRUE) &&
        (scanset = ddi_get8(kb8042->handle, kb8042->addr + port))
        == KB_ACK)
        ;

#ifdef KD_DEBUG
    cmn_err(CE_NOTE, "!Scan code set from keyboard is `%d'.",
        scanset);
#endif

    return (scanset);

fail_read_scanset:
#ifdef KD_DEBUG
    if (err == 0)
        cmn_err(CE_NOTE, "Could not read current scan set from "
            "keyboard: %s. (Expected 0x%x, but got 0x%x).",
            kb8042_error_string(err), KB_ACK, got);
    else
        cmn_err(CE_NOTE, "Could not read current scan set from "
            "keyboard: %s.", kb8042_error_string(err));
#endif
    return (-1);
}
#endif

static int
kb8042_attach(dev_info_t *devi, ddi_attach_cmd_t cmd)
{
    int rc;
    int scanset;
    int leds;

    struct kb8042   *kb8042 = &Kdws;
    static ddi_device_acc_attr_t attr = {
        DDI_DEVICE_ATTR_V0,
        DDI_NEVERSWAP_ACC,
        DDI_STRICTORDER_ACC,
    };

    switch (cmd) {
    case DDI_RESUME:
        leds = kb8042->leds.commanded;
        kb8042->w_init = 0;
        kb8042_init(kb8042, B_TRUE);
        kb8042_setled(kb8042, leds, B_FALSE);
        mutex_enter(&kb8042->w_hw_mutex);
        kb8042->suspended = B_FALSE;
        if (kb8042->w_qp != NULL) {
            enableok(WR(kb8042->w_qp));
            qenable(WR(kb8042->w_qp));
        }
        cv_broadcast(&kb8042->suspend_cv);
        mutex_exit(&kb8042->w_hw_mutex);
        return (DDI_SUCCESS);

    case DDI_ATTACH:
        if (kb8042_dip != NULL)
            return (DDI_FAILURE);
        /* The rest of the function is for attach */
        break;

    default:
        return (DDI_FAILURE);
    }

    kb8042->debugger.mod1 = 58; /* Left Ctrl */
    kb8042->debugger.mod2 = 60; /* Left Alt */
    kb8042->debugger.trigger = 33;  /* D */
    kb8042->debugger.mod1_down = B_FALSE;
    kb8042->debugger.mod2_down = B_FALSE;
    kb8042->debugger.enabled = B_FALSE;

    kb8042_dip = devi;
    kb8042->init_state = KB8042_UNINITIALIZED;

    kb8042->polled_synthetic_release_pending = B_FALSE;

    if (ddi_create_minor_node(devi, module_name, S_IFCHR, 0,
        DDI_NT_KEYBOARD, 0) == DDI_FAILURE) {
        goto failure;
    }

    kb8042->init_state |= KB8042_MINOR_NODE_CREATED;

    rc = ddi_regs_map_setup(devi, 0, (caddr_t *)&kb8042->addr,
        (offset_t)0, (offset_t)0, &attr, &kb8042->handle);
    if (rc != DDI_SUCCESS) {
#if defined(KD_DEBUG)
        cmn_err(CE_WARN, "kb8042_attach:  can't map registers");
#endif
        goto failure;
    }

    kb8042->init_state |= KB8042_REGS_MAPPED;

    if (ddi_get_iblock_cookie(devi, 0, &kb8042->w_iblock) !=
        DDI_SUCCESS) {
        cmn_err(CE_WARN, "kb8042_attach:  Can't get iblock cookie");
        goto failure;
    }

    mutex_init(&kb8042->w_hw_mutex, NULL, MUTEX_DRIVER, kb8042->w_iblock);
    cv_init(&kb8042->ops_cv, NULL, CV_DRIVER, NULL);
    cv_init(&kb8042->suspend_cv, NULL, CV_DRIVER, NULL);
    kb8042->init_state |= KB8042_HW_MUTEX_INITTED;

    kb8042_init(kb8042, B_FALSE);

#ifdef __sparc
    /* Detect the scan code set currently in use */
    scanset = kb8042_read_scanset(kb8042, B_TRUE);

    if (scanset < 0 && kb8042_warn_unknown_scanset) {

        cmn_err(CE_WARN, "Cannot determine keyboard scan code set ");
        cmn_err(CE_CONT, "(is the keyboard plugged in?). ");
        cmn_err(CE_CONT, "Defaulting to scan code set %d.  If the "
            "keyboard does not ", kb8042_default_scanset);
        cmn_err(CE_CONT, "work properly, add "
            "`set kb8042:kb8042_default_scanset=%d' to /etc/system ",
            (kb8042_default_scanset == 1) ? 2 : 1);
        cmn_err(CE_CONT, "(via network or with a USB keyboard) and "
            "restart the system.  If you ");
        cmn_err(CE_CONT, "do not want to see this message in the "
            "future, add ");
        cmn_err(CE_CONT, "`set kb8042:kb8042_warn_unknown_scanset=0' "
            "to /etc/system.\n");

        /* Use the default scan code set. */
        scanset = kb8042_default_scanset;
    }
#else
    /* x86 systems use scan code set 1 -- no detection required */
    scanset = 1;
#endif
    if (KeyboardConvertScan_init(kb8042, scanset) != DDI_SUCCESS) {
        cmn_err(CE_WARN, "Cannot initialize keyboard scan converter: "
            "Unknown scan code set `%d'.", scanset);
        /* Scan code set is not supported */
        goto failure;
    }

    /*
     * Turn on interrupts...
     */
    if (ddi_add_intr(devi, 0,
        &kb8042->w_iblock, (ddi_idevice_cookie_t *)NULL,
        kb8042_intr, (caddr_t)kb8042) != DDI_SUCCESS) {
        cmn_err(CE_WARN, "kb8042_attach: cannot add interrupt");
        goto failure;
    }

    kb8042->init_state |= KB8042_INTR_ADDED;

    ddi_report_dev(devi);

#ifdef  KD_DEBUG
    cmn_err(CE_CONT, "?%s instance #%d READY\n",
        DRIVER_NAME(devi), ddi_get_instance(devi));
#endif

    return (DDI_SUCCESS);

failure:
    kb8042_cleanup(kb8042);
    return (DDI_FAILURE);
}

static int
kb8042_detach(dev_info_t *dip, ddi_detach_cmd_t cmd)
{
    struct kb8042 *kb8042 = &Kdws;

    switch (cmd) {
    case DDI_SUSPEND:
        mutex_enter(&kb8042->w_hw_mutex);
        ASSERT(kb8042->ops >= 0);
        while (kb8042->ops > 0)
            cv_wait(&kb8042->ops_cv, &kb8042->w_hw_mutex);
        kb8042->suspended = B_TRUE;
        mutex_exit(&kb8042->w_hw_mutex);
        return (DDI_SUCCESS);

    case DDI_DETACH:
        /* If someone has a stream open, fail to detach */
        if (kb8042->w_qp != NULL)
            return (DDI_FAILURE);

        ASSERT(kb8042_dip == dip);

        kb8042_cleanup(kb8042);

        return (DDI_SUCCESS);

    default:
        return (DDI_FAILURE);
    }
}

/*ARGSUSED*/
static int
kb8042_getinfo(
    dev_info_t *dip,
    ddi_info_cmd_t infocmd,
    void *arg,
    void **result)
{
    register int error;

    switch (infocmd) {
    case DDI_INFO_DEVT2DEVINFO:
        if (kb8042_dip == NULL) {
            error = DDI_FAILURE;
        } else {
            *result = (void *) kb8042_dip;
            error = DDI_SUCCESS;
        }
        break;
    case DDI_INFO_DEVT2INSTANCE:
        *result = (void *)0;
        error = DDI_SUCCESS;
        break;
    default:
        error = DDI_FAILURE;
        break;
    }
    return (error);
}

static void
kb8042_cleanup(struct kb8042 *kb8042)
{
    ASSERT(kb8042_dip != NULL);

    if (kb8042->init_state & KB8042_HW_MUTEX_INITTED) {
        cv_destroy(&kb8042->suspend_cv);
        cv_destroy(&kb8042->ops_cv);
        mutex_destroy(&kb8042->w_hw_mutex);
    }

    if (kb8042->init_state & KB8042_INTR_ADDED)
        ddi_remove_intr(kb8042_dip, 0, kb8042->w_iblock);

    if (kb8042->init_state & KB8042_REGS_MAPPED)
        ddi_regs_map_free(&kb8042->handle);

    if (kb8042->init_state & KB8042_MINOR_NODE_CREATED)
        ddi_remove_minor_node(kb8042_dip, NULL);

    kb8042->init_state = KB8042_UNINITIALIZED;
    kb8042_dip = NULL;
}

static void
kb8042_init(struct kb8042 *kb8042, boolean_t from_resume)
{
    if (kb8042->w_init)
        return;

    if (!from_resume) {
        kb8042->w_kblayout = 0; /* Default to US */
        kb8042->w_qp = (queue_t *)NULL;
        kb8042->simulated_kbd_type = KB_PC;
        kb8042->leds.commanded = -1;    /* Unknown initial state */
        kb8042->leds.desired = -1;  /* Unknown initial state */
    }

    kb8042_wait_poweron(kb8042);

    kb8042->kb_old_key_pos = 0;

    /* Set up the command state machine and start it running. */
    kb8042_send_to_keyboard(kb8042, KB_ENABLE, B_FALSE);

    kb8042->w_init++;

    (void) drv_setparm(SYSRINT, 1); /* reset keyboard interrupts */
}

/*ARGSUSED2*/
static int
kb8042_open(queue_t *qp, dev_t *devp, int flag, int sflag, cred_t *credp)
{
    struct kb8042   *kb8042;
    int err;
    int initial_leds;
    int initial_led_mask;

    kb8042 = &Kdws;

    mutex_enter(&kb8042->w_hw_mutex);
    while (kb8042->suspended) {
        if (cv_wait_sig(&kb8042->suspend_cv, &kb8042->w_hw_mutex) ==
            0) {
            mutex_exit(&kb8042->w_hw_mutex);
            return (EINTR);
        }
    }

    kb8042->w_dev = *devp;

    if (qp->q_ptr) {
        mutex_exit(&kb8042->w_hw_mutex);
        return (0);
    }
    qp->q_ptr = (caddr_t)kb8042;
    WR(qp)->q_ptr = qp->q_ptr;
    if (!kb8042->w_qp)
        kb8042->w_qp = qp;

    ASSERT(kb8042->ops >= 0);
    kb8042->ops++;
    mutex_exit(&kb8042->w_hw_mutex);

    kb8042_get_initial_leds(kb8042, &initial_leds, &initial_led_mask);
    err = kbtrans_streams_init(qp, sflag, credp,
        (struct kbtrans_hardware *)kb8042, &kb8042_callbacks,
        &kb8042->hw_kbtrans,
        initial_leds, initial_led_mask);
    if (err != 0)
        return (err);

    kbtrans_streams_set_keyboard(kb8042->hw_kbtrans, KB_PC, &keyindex_pc);

    kb8042->polledio.cons_polledio_version = CONSPOLLEDIO_V1;
    kb8042->polledio.cons_polledio_argument =
        (cons_polledio_arg_t)kb8042;
    kb8042->polledio.cons_polledio_putchar = NULL;
    kb8042->polledio.cons_polledio_getchar =
        (int (*)(cons_polledio_arg_t))kb8042_polled_getchar;
    kb8042->polledio.cons_polledio_ischar =
        (boolean_t (*)(cons_polledio_arg_t))kb8042_polled_ischar;
    kb8042->polledio.cons_polledio_enter = NULL;
    kb8042->polledio.cons_polledio_exit = NULL;
    kb8042->polledio.cons_polledio_setled =
        (void (*)(cons_polledio_arg_t, int))kb8042_polled_setled;
    kb8042->polledio.cons_polledio_keycheck =
        (boolean_t (*)(cons_polledio_arg_t, int *,
        enum keystate *))kb8042_polled_keycheck;

    qprocson(qp);

    kbtrans_streams_enable(kb8042->hw_kbtrans);

    mutex_enter(&kb8042->w_hw_mutex);
    ASSERT(kb8042->ops > 0);
    kb8042->ops--;
    if (kb8042->ops == 0)
        cv_broadcast(&kb8042->ops_cv);
    mutex_exit(&kb8042->w_hw_mutex);

    return (0);
}

/*ARGSUSED1*/
static int
kb8042_close(queue_t *qp, int flag, cred_t *credp)
{
    struct kb8042   *kb8042;

    /* If a beep is in progress, stop that */
    (void) beeper_off();

    kb8042 = (struct kb8042 *)qp->q_ptr;

    mutex_enter(&kb8042->w_hw_mutex);
    while (kb8042->suspended) {
        if (cv_wait_sig(&kb8042->suspend_cv, &kb8042->w_hw_mutex) ==
            0) {
            mutex_exit(&kb8042->w_hw_mutex);
            return (EINTR);
        }
    }

    ASSERT(kb8042->ops >= 0);
    kb8042->ops++;
    mutex_exit(&kb8042->w_hw_mutex);

    (void) kbtrans_streams_fini(kb8042->hw_kbtrans);

    kb8042->w_qp = (queue_t *)NULL;
    qprocsoff(qp);

    mutex_enter(&kb8042->w_hw_mutex);
    ASSERT(kb8042->ops > 0);
    kb8042->ops--;
    if (kb8042->ops == 0)
        cv_broadcast(&kb8042->ops_cv);
    mutex_exit(&kb8042->w_hw_mutex);

    return (0);
}

static int
kb8042_wsrv(queue_t *qp)
{
    struct kb8042 *kb8042;

    mblk_t  *mp;
    boolean_t suspended;

    kb8042 = (struct kb8042 *)qp->q_ptr;

    mutex_enter(&kb8042->w_hw_mutex);
    suspended = kb8042->suspended;
    ASSERT(kb8042->ops >= 0);
    if (!suspended)
        kb8042->ops++;
    mutex_exit(&kb8042->w_hw_mutex);

#ifdef NO_KB_DEBUG
    while (!suspended && (mp = getq(qp)) != NULL) {
#else
    /*
     * Not taking keyboard input while suspending can make debugging
     * difficult.  However, we still do the ops counting so that we
     * don't suspend at a bad time.
     */
    while ((mp = getq(qp))) {
#endif
        switch (kbtrans_streams_message(kb8042->hw_kbtrans, mp)) {
        case KBTRANS_MESSAGE_HANDLED:
            continue;
        case KBTRANS_MESSAGE_NOT_HANDLED:
            break;
        }
        switch (mp->b_datap->db_type) {
        case M_IOCTL:
            kb8042_ioctlmsg(kb8042, qp, mp);
            continue;
        case M_IOCDATA:
            kb8042_iocdatamsg(qp, mp);
            continue;
        case M_DELAY:
        case M_STARTI:
        case M_STOPI:
        case M_READ:    /* ignore, no buffered data */
            freemsg(mp);
            continue;
        case M_FLUSH:
            *mp->b_rptr &= ~FLUSHW;
            if (*mp->b_rptr & FLUSHR)
                qreply(qp, mp);
            else
                freemsg(mp);
            continue;
        default:
            cmn_err(CE_NOTE, "kb8042_wsrv: bad msg %x",
                mp->b_datap->db_type);
            freemsg(mp);
            continue;
        }
    }

    mutex_enter(&kb8042->w_hw_mutex);
    if (!suspended) {
        ASSERT(kb8042->ops > 0);
        kb8042->ops--;
        if (kb8042->ops == 0)
            cv_broadcast(&kb8042->ops_cv);
    }
    mutex_exit(&kb8042->w_hw_mutex);

    return (0);
}

static void
kb8042_ioctlmsg(struct kb8042 *kb8042, queue_t *qp, mblk_t *mp)
{
    struct iocblk   *iocp;
    mblk_t      *datap;
    int     error;
    int     tmp;
    int     cycles;
    int     frequency;
    int     msecs;

    iocp = (struct iocblk *)mp->b_rptr;

    switch (iocp->ioc_cmd) {

    case CONSOPENPOLLEDIO:
        error = miocpullup(mp, sizeof (struct cons_polledio *));
        if (error != 0) {
            miocnak(qp, mp, 0, error);
            return;
        }

        /*
         * We are given an appropriate-sized data block,
         * and return a pointer to our structure in it.
         */
        *(struct cons_polledio **)mp->b_cont->b_rptr =
            &kb8042->polledio;
        mp->b_datap->db_type = M_IOCACK;
        iocp->ioc_error = 0;
        qreply(qp, mp);
        break;

    case CONSCLOSEPOLLEDIO:
        miocack(qp, mp, 0, 0);
        break;

    case CONSSETABORTENABLE:
        if (iocp->ioc_count != TRANSPARENT) {
            miocnak(qp, mp, 0, EINVAL);
            return;
        }

        kb8042->debugger.enabled = *(intptr_t *)mp->b_cont->b_rptr;
        miocack(qp, mp, 0, 0);
        break;

    /*
     * Valid only in TR_UNTRANS_MODE mode.
     */
    case CONSSETKBDTYPE:
        error = miocpullup(mp, sizeof (int));
        if (error != 0) {
            miocnak(qp, mp, 0, error);
            return;
        }
        tmp =  *(int *)mp->b_cont->b_rptr;
        if (tmp != KB_PC && tmp != KB_USB) {
            miocnak(qp, mp, 0, EINVAL);
            break;
        }
        kb8042->simulated_kbd_type = tmp;
        miocack(qp, mp, 0, 0);
        break;

    case KIOCLAYOUT:
        if (kb8042->w_kblayout == -1) {
            miocnak(qp, mp, 0, EINVAL);
            return;
        }

        if ((datap = allocb(sizeof (int), BPRI_HI)) == NULL) {
            miocnak(qp, mp, 0, ENOMEM);
            return;
        }

        if (kb8042->simulated_kbd_type == KB_USB)
            *(int *)datap->b_wptr = KBTRANS_USBKB_DEFAULT_LAYOUT;
        else
            *(int *)datap->b_wptr = kb8042->w_kblayout;

        datap->b_wptr += sizeof (int);
        if (mp->b_cont)
            freemsg(mp->b_cont);
        mp->b_cont = datap;
        iocp->ioc_count = sizeof (int);
        mp->b_datap->db_type = M_IOCACK;
        iocp->ioc_error = 0;
        qreply(qp, mp);
        break;

    case KIOCSLAYOUT:
        if (iocp->ioc_count != TRANSPARENT) {
            miocnak(qp, mp, 0, EINVAL);
            return;
        }

        kb8042->w_kblayout = *(intptr_t *)mp->b_cont->b_rptr;
        miocack(qp, mp, 0, 0);
        break;

    case KIOCCMD:
        error = miocpullup(mp, sizeof (int));
        if (error != 0) {
            miocnak(qp, mp, 0, error);
            return;
        }

        kb8042_type4_cmd(kb8042, *(int *)mp->b_cont->b_rptr);
        miocack(qp, mp, 0, 0);
        break;

    case KIOCMKTONE:
        if (iocp->ioc_count != TRANSPARENT) {
            miocnak(qp, mp, 0, EINVAL);
            return;
        }

        tmp = (int)(*(intptr_t *)mp->b_cont->b_rptr);
        cycles = tmp & 0xffff;
        msecs = (tmp >> 16) & 0xffff;

        if (cycles == 0)
            frequency = UINT16_MAX;
        else if (cycles == UINT16_MAX)
            frequency = 0;
        else {
            frequency = (PIT_HZ + cycles / 2) / cycles;
            if (frequency > UINT16_MAX)
                frequency = UINT16_MAX;
        }

        error = beep_mktone(frequency, msecs);
        if (error != 0)
            miocnak(qp, mp, 0, error);
        else
            miocack(qp, mp, 0, 0);
        break;

    default:
#ifdef DEBUG1
        cmn_err(CE_NOTE, "!kb8042_ioctlmsg %x", iocp->ioc_cmd);
#endif
        miocnak(qp, mp, 0, EINVAL);
        return;
    }
}

/*
 * Process a byte received from the keyboard
 */
static void
kb8042_received_byte(
    struct kb8042   *kb8042,
    int     scancode)   /* raw scan code */
{
    boolean_t   legit;      /* is this a legit key pos'n? */
    int     key_pos = -1;
    enum keystate   state;
    boolean_t   synthetic_release_needed;

#ifdef  KD_DEBUG
    kb8042_debug_hotkey(scancode);
#endif

    if (!kb8042->w_init)    /* can't do anything anyway */
        return;

    legit = KeyboardConvertScan(kb8042, scancode, &key_pos, &state,
        &synthetic_release_needed);

    if (legit == 0) {
        /* Eaten by translation */
#ifdef  KD_DEBUG
        if (kb8042_debug)
            prom_printf("kb8042_intr: 0x%x -> ignored\n", scancode);
#endif
        return;
    }

#ifdef  KD_DEBUG
    if (kb8042_debug) {
        prom_printf("kb8042_intr:  0x%x -> %s %d",
            scancode,
            state == KEY_RELEASED ? "released" : "pressed",
            key_pos);
    }
#endif

    /*
     * Don't know if we want this permanently, but it seems interesting
     * for the moment.
     */
    if (key_pos == kb8042->debugger.mod1) {
#ifdef  KD_DEBUG
        if (kb8042_debug)
            prom_printf(" -> debug mod1");
#endif
        kb8042->debugger.mod1_down = (state == KEY_PRESSED);
    }
    if (key_pos == kb8042->debugger.mod2) {
#ifdef  KD_DEBUG
        if (kb8042_debug)
            prom_printf(" -> debug mod2");
#endif
        kb8042->debugger.mod2_down = (state == KEY_PRESSED);
    }
    if (kb8042->debugger.enabled &&
        key_pos == kb8042->debugger.trigger &&
        kb8042->debugger.mod1_down &&
        kb8042->debugger.mod2_down) {
#ifdef  KD_DEBUG
        if (kb8042_debug)
            prom_printf(" -> debugger\n");
#endif
        /*
         * Require new presses of the modifiers.
         */
        kb8042->debugger.mod1_down = B_FALSE;
        kb8042->debugger.mod2_down = B_FALSE;
        abort_sequence_enter(NULL);
        return;
    }

    /*
     * If there's no queue above us - as can happen if we've been
     * attached but not opened - drop the keystroke.
     * Note that we do this here instead of above so that
     * Ctrl-Alt-D still works.
     */
    if (kb8042->w_qp == NULL) {
#ifdef  KD_DEBUG
        if (kb8042_debug)
            prom_printf(" -> nobody home\n");
#endif
        return;
    }

    /*
     * This is to filter out auto repeat since it can't be
     * turned off at the hardware.  (Yeah, yeah, PS/2 keyboards
     * can.  Don't know whether they've taken over the world.
     * Don't think so.)
     */
    if (kb8042_autorepeat_detect(kb8042, key_pos, state)) {
#ifdef  KD_DEBUG
        if (kb8042_debug)
            prom_printf(" -> autorepeat ignored\n");
#endif
        return;
    }

#ifdef  KD_DEBUG
    if (kb8042_debug)
        prom_printf(" -> OK\n");
#endif

#if defined(KD_DEBUG)
    if (kb8042_pressrelease_debug) {
        prom_printf(" %s%d ",
            state == KEY_PRESSED ? "+" : "-",
            key_pos);
    }
#endif

        kb8042_process_key(kb8042, key_pos, state);

    /*
     * This is a total hack.  For some stupid reason, the two additional
     * keys on Korean keyboards (Hangul and Hangul/Hanja) report press
     * only.  We synthesize a release immediately.
     */
    if (synthetic_release_needed) {
#if defined(KD_DEBUG)
        if (kb8042_debug)
            prom_printf("synthetic release %d\n", key_pos);
        if (kb8042_pressrelease_debug)
            prom_printf(" -%d(s) ", key_pos);
#endif
        (void) kb8042_autorepeat_detect(kb8042, key_pos, KEY_RELEASED);
        kb8042_process_key(kb8042, key_pos, state);
    }
}


static void
kb8042_process_key(struct kb8042 *kb8042, kbtrans_key_t key_pos,
    enum keystate state)
{
    kbtrans_key_t key;

    ASSERT(key_pos >= 0 && key_pos <= 255);
    if (kb8042->simulated_kbd_type == KB_PC) {
        kbtrans_streams_key(kb8042->hw_kbtrans, key_pos, state);
    } else if (kb8042->simulated_kbd_type == KB_USB) {
        key = keytab_pc2usb[key_pos];
        if (key != 0) {
            kbtrans_streams_key(kb8042->hw_kbtrans, key, state);
        }
    }
}

/*
 * Called from interrupt handler when keyboard interrupt occurs.
 */
static uint_t
kb8042_intr(caddr_t arg)
{
    uchar_t scancode;   /* raw scan code */
    int rc;
    struct kb8042 *kb8042 = (struct kb8042 *)arg;

    rc = DDI_INTR_UNCLAIMED;

    if (kb8042->init_state == KB8042_UNINITIALIZED)
        return (DDI_INTR_UNCLAIMED);

    /* don't care if drv_setparm succeeds */
    (void) drv_setparm(SYSRINT, 1);

    while (ddi_get8(kb8042->handle, kb8042->addr + I8042_INT_INPUT_AVAIL)
        != 0) {
        rc = DDI_INTR_CLAIMED;

        scancode = ddi_get8(kb8042->handle,
            kb8042->addr + I8042_INT_INPUT_DATA);

#if defined(KD_DEBUG)
        if (kb8042_low_level_debug)
            prom_printf(" <K:%x ", scancode);
#endif

        kb8042_received_byte(kb8042, scancode);
    }

    return (rc);
}

static void
kb8042_iocdatamsg(queue_t *qp, mblk_t *mp)
{
    struct copyresp *csp;

    csp = (struct copyresp *)mp->b_rptr;
    if (csp->cp_rval) {
        freemsg(mp);
        return;
    }

    switch (csp->cp_cmd) {
    default:
        miocack(qp, mp, 0, 0);
        break;
    }
}

static boolean_t
kb8042_polled_keycheck(
    struct kbtrans_hardware *hw,
    int *key,
    enum keystate *state)
{
    struct kb8042 *kb8042 = (struct kb8042 *)hw;
    int scancode;
    boolean_t   legit;
    boolean_t   synthetic_release_needed;

    if (kb8042->polled_synthetic_release_pending) {
        *key = kb8042->polled_synthetic_release_key;
        *state = KEY_RELEASED;
        kb8042->polled_synthetic_release_pending = B_FALSE;
#if defined(KD_DEBUG)
        if (kb8042_getchar_debug)
            prom_printf("synthetic release 0x%x\n", *key);
#endif
        (void) kb8042_autorepeat_detect(kb8042, *key, *state);
        return (B_TRUE);
    }

    for (;;) {
        if (ddi_get8(kb8042->handle,
            kb8042->addr + I8042_POLL_INPUT_AVAIL) == 0) {
            return (B_FALSE);
        }

        scancode = ddi_get8(kb8042->handle,
            kb8042->addr + I8042_POLL_INPUT_DATA);

#if defined(KD_DEBUG)
        if (kb8042_low_level_debug)
            prom_printf(" g<%x ", scancode);
#endif

#ifdef  KD_DEBUG
        kb8042_debug_hotkey(scancode);
        if (kb8042_getchar_debug)
            prom_printf("polled 0x%x", scancode);
#endif

        legit = KeyboardConvertScan(kb8042, scancode, key, state,
            &synthetic_release_needed);
        if (!legit) {
#ifdef  KD_DEBUG
            if (kb8042_getchar_debug)
                prom_printf(" -> ignored\n");
#endif
            continue;
        }
#ifdef  KD_DEBUG
        if (kb8042_getchar_debug) {
            prom_printf(" -> %s %d\n",
                *state == KEY_PRESSED ? "pressed" : "released",
                *key);
        }
#endif
        /*
         * For the moment at least, we rely on hardware autorepeat
         * for polled I/O autorepeat.  However, for coordination
         * with the interrupt-driven code, maintain the last key
         * pressed.
         */
        (void) kb8042_autorepeat_detect(kb8042, *key, *state);

        /*
         * This is a total hack to support two additional keys
         * on Korean keyboards.  They report only on press, and
         * so we synthesize a release.  Most likely this will
         * never be important to polled  I/O, but if I do it
         * "right" the first time it _won't_ be an issue.
         */
        if (synthetic_release_needed) {
            kb8042->polled_synthetic_release_pending = B_TRUE;
            kb8042->polled_synthetic_release_key = *key;
        }

        if (kb8042->simulated_kbd_type == KB_USB) {
            *key = keytab_pc2usb[*key];
        }
        return (B_TRUE);
    }
}

static void
kb8042_setled(struct kb8042 *kb8042, int led_state, boolean_t polled)
{
    kb8042->leds.desired = led_state;

    if (!polled)
        mutex_enter(&kb8042->w_hw_mutex);

    if (kb8042->leds.desired != kb8042->leds.commanded) {
        kb8042_send_to_keyboard(kb8042, KB_SET_LED, polled);
    }

    if (!polled)
        mutex_exit(&kb8042->w_hw_mutex);
}

static void
kb8042_polled_setled(struct kbtrans_hardware *hw, int led_state)
{
    struct kb8042 *kb8042 = (struct kb8042 *)hw;
    kb8042_setled(kb8042, led_state, B_TRUE);
}

static void
kb8042_streams_setled(struct kbtrans_hardware *hw, int led_state)
{
    struct kb8042 *kb8042 = (struct kb8042 *)hw;
    kb8042_setled(kb8042, led_state, B_FALSE);
}

static void
kb8042_send_to_keyboard(struct kb8042 *kb8042, int byte, boolean_t polled)
{
    uint8_t led_cmd[4];

    /*
     * KB_SET_LED and KB_ENABLE are special commands for which the nexus
     * driver is requested to wait for responses before proceeding.
     * KB_SET_LED also provides an option byte for the nexus to send to
     * the keyboard after the acknowledgement.
     *
     * Other commands/data are sent using the single put8 I/O access
     * function.
     */
    if (byte == KB_SET_LED) {
        /*
         * Initialize the buffer used with _rep_put8.  We
         * expect an ACK after the SET_LED command, at which point
         * the LED byte should be sent to the keyboard.
         */
        led_cmd[0] = KB_SET_LED;
        led_cmd[1] = KB_ACK;
        led_cmd[2] = KB_RESEND;
        led_cmd[3] = kb8042_xlate_leds(kb8042->leds.desired);
        if (polled) {
            ddi_rep_put8(kb8042->handle, &led_cmd[0],
                kb8042->addr + I8042_POLL_CMD_PLUS_PARAM, 4, 0);
        } else {
            ddi_rep_put8(kb8042->handle, &led_cmd[0],
                kb8042->addr + I8042_INT_CMD_PLUS_PARAM, 4, 0);
        }
        kb8042->leds.commanded = kb8042->leds.desired;

    } else if (byte == KB_ENABLE) {

        /*
         * Initialize the buffer used with _rep_put8.  We
         * expect an ACK after the KB_ENABLE command.
         */
        led_cmd[0] = KB_ENABLE;
        led_cmd[1] = KB_ACK;
        led_cmd[2] = KB_RESEND;
        if (polled) {
            ddi_rep_put8(kb8042->handle, &led_cmd[0],
                kb8042->addr + I8042_POLL_CMD_PLUS_PARAM, 3, 0);
        } else {
            ddi_rep_put8(kb8042->handle, &led_cmd[0],
                kb8042->addr + I8042_INT_CMD_PLUS_PARAM, 3, 0);
        }
    } else {
        /* All other commands use the "normal" virtual output port */
        if (polled) {
            ddi_put8(kb8042->handle,
                kb8042->addr + I8042_POLL_OUTPUT_DATA, byte);
        } else {
            ddi_put8(kb8042->handle,
                kb8042->addr + I8042_INT_OUTPUT_DATA, byte);
        }
    }

#if defined(KD_DEBUG)
    if (kb8042_low_level_debug)
        prom_printf(" >K:%x ", byte);
#endif
}

/*
 * Wait until the keyboard is fully up, maybe.
 * We may be the first person to talk to the keyboard, in which case
 * it's patiently waiting to say "AA" to us to tell us it's up.
 * In theory it sends the AA in 300ms < n < 9s, but it's a pretty
 * good bet that we've already spent that long getting to that point,
 * so we'll only wait long enough for the communications electronics to
 * run.
 */
static void
kb8042_wait_poweron(struct kb8042 *kb8042)
{
    int cnt;
    int ready;
    unsigned char byt;

    /* wait for up to 250 ms for a response */
    for (cnt = 0; cnt < 250; cnt++) {
        ready = ddi_get8(kb8042->handle,
            kb8042->addr + I8042_INT_INPUT_AVAIL);
        if (ready != 0)
            break;
        drv_usecwait(1000);
    }

    /*
     * If there's something pending, read and discard it.  If not,
     * assume things are OK anyway - maybe somebody else ate it
     * already.  (On a PC, the BIOS almost certainly did.)
     */
    if (ready != 0) {
        byt = ddi_get8(kb8042->handle,
            kb8042->addr + I8042_INT_INPUT_DATA);
#if defined(KD_DEBUG)
        if (kb8042_low_level_debug)
            prom_printf(" <K:%x ", byt);
#endif
    }
}

static int
kb8042_xlate_leds(int led)
{
    int res;

    res = 0;

    if (led & LED_NUM_LOCK)
        res |= LED_NUM;
    if (led & LED_SCROLL_LOCK)
        res |= LED_SCR;
    if (led & LED_CAPS_LOCK)
        res |= LED_CAP;

    return (res);
}

/*ARGSUSED*/
static void
kb8042_get_initial_leds(
    struct kb8042 *kb8042,
    int *initial_leds,
    int *initial_led_mask)
{
#if defined(__i386) || defined(__amd64)
    extern caddr_t  p0_va;
    uint8_t     bios_kb_flag;

    bios_kb_flag = p0_va[BIOS_KB_FLAG];

    *initial_led_mask = LED_CAPS_LOCK | LED_NUM_LOCK | LED_SCROLL_LOCK;
    *initial_leds = 0;
    if (bios_kb_flag & BIOS_CAPS_STATE)
        *initial_leds |= LED_CAPS_LOCK;
    if (bios_kb_flag & BIOS_NUM_STATE)
        *initial_leds |= LED_NUM_LOCK;
    if (bios_kb_flag & BIOS_SCROLL_STATE)
        *initial_leds |= LED_SCROLL_LOCK;
#else
    *initial_leds = 0;
    *initial_led_mask = 0;
#endif
}

#if defined(KD_DEBUG)
static void
kb8042_debug_hotkey(int scancode)
{
    if (!kb8042_enable_debug_hotkey)
        return;

    switch (scancode) {
    case 0x44:  /* F10 in Scan Set 1 code.  (Set 2 code is 0x09)  */
        if (!kb8042_debug) {
            prom_printf("\nKeyboard:  normal debugging on\n");
            kb8042_debug = B_TRUE;
        }
        break;
    case 0x43:  /* F9 in Scan Set 1 code.  (Set 2 code is 0x01) */
        if (!kb8042_getchar_debug) {
            prom_printf("\nKeyboard:  getchar debugging on\n");
            kb8042_getchar_debug = B_TRUE;
        }
        break;
    case 0x42:  /* F8 in Scan Set 1 code.  (Set 2 code is 0x0a) */
        if (!kb8042_low_level_debug) {
            prom_printf("\nKeyboard:  low-level debugging on\n");
            kb8042_low_level_debug = B_TRUE;
        }
        break;
    case 0x41:  /* F7 in Scan Set 1 code.  (Set 2 code is 0x83) */
        if (!kb8042_pressrelease_debug) {
            prom_printf(
                "\nKeyboard:  press/release debugging on\n");
            kb8042_pressrelease_debug = B_TRUE;
        }
        break;
    case 0x3b:  /* F1 in Scan Set 1 code.  (Set 2 code is 0x05) */
        if (kb8042_debug ||
            kb8042_getchar_debug ||
            kb8042_low_level_debug ||
            kb8042_pressrelease_debug) {
            prom_printf("\nKeyboard:  all debugging off\n");
            kb8042_debug = B_FALSE;
            kb8042_getchar_debug = B_FALSE;
            kb8042_low_level_debug = B_FALSE;
            kb8042_pressrelease_debug = B_FALSE;
        }
        break;
    }
}
#endif

static boolean_t
kb8042_autorepeat_detect(
    struct kb8042 *kb8042,
    int key_pos,
    enum keystate state)
{
    if (state == KEY_RELEASED) {
        if (kb8042->kb_old_key_pos == key_pos)
            kb8042->kb_old_key_pos = 0;
    } else {
        if (kb8042->kb_old_key_pos == key_pos) {
            return (B_TRUE);
        }
        kb8042->kb_old_key_pos = key_pos;
    }
    return (B_FALSE);
}

/* ARGSUSED */
static void
kb8042_type4_cmd(struct kb8042 *kb8042, int cmd)
{
    switch (cmd) {
    case KBD_CMD_BELL:
        (void) beeper_on(BEEP_TYPE4);
        break;
    case KBD_CMD_NOBELL:
        (void) beeper_off();
        break;
    }
}


/*
 * This is a pass-thru routine to get a character at poll time.
 */
static int
kb8042_polled_getchar(cons_polledio_arg_t arg)
{
    struct kb8042   *kb8042;

    kb8042 = (struct kb8042 *)arg;

    return (kbtrans_getchar(kb8042->hw_kbtrans));
}

/*
 * This is a pass-thru routine to get a character at poll time.
 */
static int
kb8042_polled_ischar(cons_polledio_arg_t arg)
{
    struct kb8042   *kb8042;

    kb8042 = (struct kb8042 *)arg;

    return (kbtrans_ischar(kb8042->hw_kbtrans));
}