Expand PMF_FN_* macros.

[netbsd-mini2440.git] / sys / dev / sun / kbd.c

/*      $NetBSD: kbd.c,v 1.62 2009/01/11 23:36:39 christos Exp $        */

/*
 * Copyright (c) 1992, 1993
 *      The Regents of the University of California.  All rights reserved.
 *
 * This software was developed by the Computer Systems Engineering group
 * at Lawrence Berkeley Laboratory under DARPA contract BG 91-66 and
 * contributed to Berkeley.
 *
 * All advertising materials mentioning features or use of this software
 * must display the following acknowledgement:
 *      This product includes software developed by the University of
 *      California, Lawrence Berkeley Laboratory.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. Neither the name of the University nor the names of its contributors
 *    may be used to endorse or promote products derived from this software
 *    without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 *
 *      @(#)kbd.c       8.2 (Berkeley) 10/30/93
 */

/*
 * Keyboard driver (/dev/kbd -- note that we do not have minor numbers
 * [yet?]).  Translates incoming bytes to ASCII or to `firm_events' and
 * passes them up to the appropriate reader.
 */

#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: kbd.c,v 1.62 2009/01/11 23:36:39 christos Exp $");

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/conf.h>
#include <sys/device.h>
#include <sys/ioctl.h>
#include <sys/kernel.h>
#include <sys/proc.h>
#include <sys/malloc.h>
#include <sys/signal.h>
#include <sys/signalvar.h>
#include <sys/time.h>
#include <sys/syslog.h>
#include <sys/select.h>
#include <sys/poll.h>
#include <sys/file.h>

#include <dev/wscons/wsksymdef.h>

#include <dev/sun/kbd_reg.h>
#include <dev/sun/kbio.h>
#include <dev/sun/vuid_event.h>
#include <dev/sun/event_var.h>
#include <dev/sun/kbd_xlate.h>
#include <dev/sun/kbdvar.h>

#include "ioconf.h"
#include "locators.h"

dev_type_open(kbdopen);
dev_type_close(kbdclose);
dev_type_read(kbdread);
dev_type_ioctl(kbdioctl);
dev_type_poll(kbdpoll);
dev_type_kqfilter(kbdkqfilter);

const struct cdevsw kbd_cdevsw = {
        kbdopen, kbdclose, kbdread, nowrite, kbdioctl,
        nostop, notty, kbdpoll, nommap, kbdkqfilter, D_OTHER
};

#if NWSKBD > 0
static int      wssunkbd_enable(void *, int);
static void     wssunkbd_set_leds(void *, int);
static int      wssunkbd_ioctl(void *, u_long, void *, int, struct lwp *);
static void     sunkbd_wskbd_cngetc(void *, u_int *, int *);
static void     sunkbd_wskbd_cnpollc(void *, int);
static void     sunkbd_wskbd_cnbell(void *, u_int, u_int, u_int);
static void     sunkbd_bell_off(void *v);
static void     kbd_enable(device_t); /* deferred keyboard init */

const struct wskbd_accessops sunkbd_wskbd_accessops = {
        wssunkbd_enable,
        wssunkbd_set_leds,
        wssunkbd_ioctl,
};

extern const struct wscons_keydesc wssun_keydesctab[];
const struct wskbd_mapdata sunkbd_wskbd_keymapdata = {
        wssun_keydesctab,
#ifdef SUNKBD_LAYOUT
        SUNKBD_LAYOUT,
#else
        KB_US,
#endif
};

const struct wskbd_consops sunkbd_wskbd_consops = {
        sunkbd_wskbd_cngetc,
        sunkbd_wskbd_cnpollc,
        sunkbd_wskbd_cnbell,
};

void kbd_wskbd_attach(struct kbd_softc *, int);
#endif

/* ioctl helpers */
static int kbd_iockeymap(struct kbd_state *, u_long, struct kiockeymap *);
#ifdef KIOCGETKEY
static int kbd_oldkeymap(struct kbd_state *, u_long, struct okiockey *);
#endif


/* callbacks for console driver */
static int kbd_cc_open(struct cons_channel *);
static int kbd_cc_close(struct cons_channel *);

/* console input */
static void     kbd_input_console(struct kbd_softc *, int);
static void     kbd_repeat(void *);
static int      kbd_input_keysym(struct kbd_softc *, int);
static void     kbd_input_string(struct kbd_softc *, char *);
static void     kbd_input_funckey(struct kbd_softc *, int);
static void     kbd_update_leds(struct kbd_softc *);

#if NWSKBD > 0
static void     kbd_input_wskbd(struct kbd_softc *, int);
#endif

/* firm events input */
static void     kbd_input_event(struct kbd_softc *, int);



/****************************************************************
 *  Entry points for /dev/kbd
 *  (open,close,read,write,...)
 ****************************************************************/

/*
 * Open:
 * Check exclusion, open actual device (_iopen),
 * setup event channel, clear ASCII repeat stuff.
 */
int
kbdopen(dev_t dev, int flags, int mode, struct lwp *l)
{
        struct kbd_softc *k;
        int error;

        /* locate device */
        k = device_lookup_private(&kbd_cd, minor(dev));
        if (k == NULL)
                return ENXIO;

#if NWSKBD > 0
        /*
         * NB: wscons support: while we can track if wskbd has called
         * enable(), we can't tell if that's for console input or for
         * events input, so we should probably just let the open to
         * always succeed regardless (e.g. Xsun opening /dev/kbd).
         */
        if (!k->k_wsenabled)
                wssunkbd_enable(k, 1);
#endif

        /* exclusive open required for /dev/kbd */
        if (k->k_events.ev_io)
                return EBUSY;
        k->k_events.ev_io = l->l_proc;

        /* stop pending autorepeat of console input */
        if (k->k_repeating) {
                k->k_repeating = 0;
                callout_stop(&k->k_repeat_ch);
        }

        /* open actual underlying device */
        if (k->k_ops != NULL && k->k_ops->open != NULL)
                if ((error = (*k->k_ops->open)(k)) != 0) {
                        k->k_events.ev_io = NULL;
                        return error;
                }

        ev_init(&k->k_events);
        k->k_evmode = 0;        /* XXX: OK? */

        return 0;
}


/*
 * Close:
 * Turn off event mode, dump the queue, and close the keyboard
 * unless it is supplying console input.
 */
int
kbdclose(dev_t dev, int flags, int mode, struct lwp *l)
{
        struct kbd_softc *k;

        k = device_lookup_private(&kbd_cd, minor(dev));
        k->k_evmode = 0;
        ev_fini(&k->k_events);
        k->k_events.ev_io = NULL;

        if (k->k_ops != NULL && k->k_ops->close != NULL) {
                int error;
                if ((error = (*k->k_ops->close)(k)) != 0)
                        return error;
        }
        return 0;
}


int
kbdread(dev_t dev, struct uio *uio, int flags)
{
        struct kbd_softc *k;

        k = device_lookup_private(&kbd_cd, minor(dev));
        return ev_read(&k->k_events, uio, flags);
}


int
kbdpoll(dev_t dev, int events, struct lwp *l)
{
        struct kbd_softc *k;

        k = device_lookup_private(&kbd_cd, minor(dev));
        return ev_poll(&k->k_events, events, l);
}

int
kbdkqfilter(dev_t dev, struct knote *kn)
{
        struct kbd_softc *k;

        k = device_lookup_private(&kbd_cd, minor(dev));
        return ev_kqfilter(&k->k_events, kn);
}

int
kbdioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l)
{
        struct kbd_softc *k;
        struct kbd_state *ks;
        int error = 0;

        k = device_lookup_private(&kbd_cd, minor(dev));
        ks = &k->k_state;

        switch (cmd) {

        case KIOCTRANS:         /* Set translation mode */
                /* We only support "raw" mode on /dev/kbd */
                if (*(int *)data != TR_UNTRANS_EVENT)
                        error = EINVAL;
                break;

        case KIOCGTRANS:        /* Get translation mode */
                /* We only support "raw" mode on /dev/kbd */
                *(int *)data = TR_UNTRANS_EVENT;
                break;

#ifdef KIOCGETKEY
        case KIOCGETKEY:        /* Get keymap entry (old format) */
                error = kbd_oldkeymap(ks, cmd, (struct okiockey *)data);
                break;
#endif /* KIOCGETKEY */

        case KIOCSKEY:          /* Set keymap entry */
                /* FALLTHROUGH */
        case KIOCGKEY:          /* Get keymap entry */
                error = kbd_iockeymap(ks, cmd, (struct kiockeymap *)data);
                break;

        case KIOCCMD:           /* Send a command to the keyboard */
                /* pass it to the middle layer */
                if (k->k_ops != NULL && k->k_ops->docmd != NULL)
                        error = (*k->k_ops->docmd)(k, *(int *)data, 1);
                break;

        case KIOCTYPE:          /* Get keyboard type */
                *(int *)data = ks->kbd_id;
                break;

        case KIOCSDIRECT:       /* Where to send input */
                k->k_evmode = *(int *)data;
                break;

        case KIOCLAYOUT:        /* Get keyboard layout */
                *(int *)data = ks->kbd_layout;
                break;

        case KIOCSLED:          /* Set keyboard LEDs */
                /* pass the request to the middle layer */
                if (k->k_ops != NULL && k->k_ops->setleds != NULL)
                        error = (*k->k_ops->setleds)(k, *(char *)data, 1);
                break;

        case KIOCGLED:          /* Get keyboard LEDs */
                *(char *)data = ks->kbd_leds;
                break;

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

        case FIOASYNC:
                k->k_events.ev_async = (*(int *)data != 0);
                break;

        case FIOSETOWN:
                if (-*(int *)data != k->k_events.ev_io->p_pgid
                    && *(int *)data != k->k_events.ev_io->p_pid)
                        error = EPERM;
                break;

        case TIOCSPGRP:
                if (*(int *)data != k->k_events.ev_io->p_pgid)
                        error = EPERM;
                break;

        default:
                error = ENOTTY;
                break;
        }

        return error;
}


/****************************************************************
 * ioctl helpers
 ****************************************************************/

/*
 * Get/Set keymap entry
 */
static int
kbd_iockeymap(struct kbd_state *ks, u_long cmd, struct kiockeymap *kio)
{
        u_short *km;
        u_int station;

        switch (kio->kio_tablemask) {
        case KIOC_NOMASK:
                km = ks->kbd_k.k_normal;
                break;
        case KIOC_SHIFTMASK:
                km = ks->kbd_k.k_shifted;
                break;
        case KIOC_CTRLMASK:
                km = ks->kbd_k.k_control;
                break;
        case KIOC_UPMASK:
                km = ks->kbd_k.k_release;
                break;
        default:
                /* Silently ignore unsupported masks */
                return 0;
        }

        /* Range-check the table position. */
        station = kio->kio_station;
        if (station >= KEYMAP_SIZE)
                return EINVAL;

        switch (cmd) {

        case KIOCGKEY:  /* Get keymap entry */
                kio->kio_entry = km[station];
                break;

        case KIOCSKEY:  /* Set keymap entry */
                km[station] = kio->kio_entry;
                break;

        default:
                return ENOTTY;
        }
        return 0;
}


#ifdef KIOCGETKEY
/*
 * Get/Set keymap entry,
 * old format (compatibility)
 */
int
kbd_oldkeymap(struct kbd_state *ks, u_long cmd, struct okiockey *kio)
{
        int error = 0;

        switch (cmd) {

        case KIOCGETKEY:
                if (kio->kio_station == 118) {
                        /*
                         * This is X11 asking if a type 3 keyboard is
                         * really a type 3 keyboard.  Say yes, it is,
                         * by reporting key station 118 as a "hole".
                         * Note old (SunOS 3.5) definition of HOLE!
                         */
                        kio->kio_entry = 0xA2;
                        break;
                }
                /* fall through */

        default:
                error = ENOTTY;
                break;
        }

        return error;
}
#endif /* KIOCGETKEY */



/****************************************************************
 *  Keyboard input - called by middle layer at spltty().
 ****************************************************************/

void
kbd_input(struct kbd_softc *k, int code)
{
        if (k->k_evmode) {
                /*
                 * XXX: is this still true?
                 * IDLEs confuse the MIT X11R4 server badly, so we must drop them.
                 * This is bad as it means the server will not automatically resync
                 * on all-up IDLEs, but I did not drop them before, and the server
                 * goes crazy when it comes time to blank the screen....
                 */
                if (code == KBD_IDLE)
                        return;

                /*
                 * Keyboard is generating firm events.  Turn this keystroke
                 * into an event and put it in the queue.
                 */
                kbd_input_event(k, code);
                return;
        }

#if NWSKBD > 0
        if (k->k_wskbd != NULL && k->k_wsenabled) {
                /*
                 * We are using wskbd input mode, pass the event up.
                 */
                if (code == KBD_IDLE)
                        return; /* this key is not in the mapped */
                kbd_input_wskbd(k, code);
                return;
        }
#endif

        /*
         * If /dev/kbd is not connected in event mode, or wskbd mode,
         * translate and send upstream (to console).
         */
        kbd_input_console(k, code);
}



/****************************************************************
 *  Open/close routines called upon opening /dev/console
 *  if we serve console input.
 ****************************************************************/

struct cons_channel *
kbd_cc_alloc(struct kbd_softc *k)
{
        struct cons_channel *cc;

        if ((cc = malloc(sizeof *cc, M_DEVBUF, M_NOWAIT)) == NULL)
                return NULL;

        /* our callbacks for the console driver */
        cc->cc_private = k;
        cc->cc_iopen = kbd_cc_open;
        cc->cc_iclose = kbd_cc_close;

        /* will be provided by the console driver so that we can feed input */
        cc->cc_upstream = NULL;

        /*
         * TODO: clean up cons_attach_input() vs kd_attach_input() in
         * lower layers and move that code here.
         */

        k->k_cc = cc;
        return cc;
}


static int
kbd_cc_open(struct cons_channel *cc)
{
        struct kbd_softc *k;
        int ret;

        if (cc == NULL)
                return 0;

        k = cc->cc_private;
        if (k == NULL)
                return 0;

        if (k->k_ops != NULL && k->k_ops->open != NULL)
                ret = (*k->k_ops->open)(k);
        else
                ret = 0;

        /* XXX: verify that callout is not active? */
        k->k_repeat_start = hz/2;
        k->k_repeat_step = hz/20;
        callout_init(&k->k_repeat_ch, 0);

        return ret;
}


static int
kbd_cc_close(struct cons_channel *cc)
{
        struct kbd_softc *k;
        int ret;

        if (cc == NULL)
                return 0;

        k = cc->cc_private;
        if (k == NULL)
                return 0;

        if (k->k_ops != NULL && k->k_ops->close != NULL)
                ret = (*k->k_ops->close)(k);
        else
                ret = 0;

        /* stop any pending auto-repeat */
        if (k->k_repeating) {
                k->k_repeating = 0;
                callout_stop(&k->k_repeat_ch);
        }

        return ret;
}



/****************************************************************
 *  Console input - called by middle layer at spltty().
 ****************************************************************/

static void
kbd_input_console(struct kbd_softc *k, int code)
{
        struct kbd_state *ks= &k->k_state;
        int keysym;

        /* any input stops auto-repeat (i.e. key release) */
        if (k->k_repeating) {
                k->k_repeating = 0;
                callout_stop(&k->k_repeat_ch);
        }

        keysym = kbd_code_to_keysym(ks, code);

        /* pass to console */
        if (kbd_input_keysym(k, keysym)) {
                log(LOG_WARNING, "%s: code=0x%x with mod=0x%x"
                    " produced unexpected keysym 0x%x\n",
                    device_xname(k->k_dev),
                    code, ks->kbd_modbits, keysym);
                return;         /* no point in auto-repeat here */
        }

        if (KEYSYM_NOREPEAT(keysym))
                return;

        /* setup for auto-repeat after initial delay */
        k->k_repeating = 1;
        k->k_repeatsym = keysym;
        callout_reset(&k->k_repeat_ch, k->k_repeat_start,
                      kbd_repeat, k);
}


/*
 * This is the autorepeat callout function scheduled by kbd_input() above.
 * Called at splsoftclock().
 */
static void
kbd_repeat(void *arg)
{
        struct kbd_softc *k = arg;
        int s;

        s = spltty();
        if (k->k_repeating && k->k_repeatsym >= 0) {
                /* feed typematic keysym to the console */
                (void)kbd_input_keysym(k, k->k_repeatsym);

                /* reschedule next repeat */
                callout_reset(&k->k_repeat_ch, k->k_repeat_step,
                              kbd_repeat, k);
        }
        splx(s);
}



/*
 * Supply keysym as console input.  Convert keysym to character(s) and
 * pass them up to cons_channel's upstream hook.
 *
 * Return zero on success, else the keysym that we could not handle
 * (so that the caller may complain).
 */
static int
kbd_input_keysym(struct kbd_softc *k, int keysym)
{
        struct kbd_state *ks = &k->k_state;
        int data;
        /* Check if a recipient has been configured */
        if (k->k_cc == NULL || k->k_cc->cc_upstream == NULL)
                return 0;

        switch (KEYSYM_CLASS(keysym)) {

        case KEYSYM_ASCII:
                data = KEYSYM_DATA(keysym);
                if (ks->kbd_modbits & KBMOD_META_MASK)
                        data |= 0x80;
                (*k->k_cc->cc_upstream)(data);
                break;

        case KEYSYM_STRING:
                data = keysym & 0xF;
                kbd_input_string(k, kbd_stringtab[data]);
                break;

        case KEYSYM_FUNC:
                kbd_input_funckey(k, keysym);
                break;

        case KEYSYM_CLRMOD:
                data = 1 << (keysym & 0x1F);
                ks->kbd_modbits &= ~data;
                break;

        case KEYSYM_SETMOD:
                data = 1 << (keysym & 0x1F);
                ks->kbd_modbits |= data;
                break;

        case KEYSYM_INVMOD:
                data = 1 << (keysym & 0x1F);
                ks->kbd_modbits ^= data;
                kbd_update_leds(k);
                break;

        case KEYSYM_ALL_UP:
                ks->kbd_modbits &= ~0xFFFF;
                break;

        case KEYSYM_SPECIAL:
                if (keysym == KEYSYM_NOP)
                        break;
                /* FALLTHROUGH */
        default:
                /* We could not handle it. */
                return keysym;
        }

        return 0;
}


/*
 * Send string upstream.
 */
static void
kbd_input_string(struct kbd_softc *k, char *str)
{

        while (*str) {
                (*k->k_cc->cc_upstream)(*str);
                ++str;
        }
}


/*
 * Format the F-key sequence and send as a string.
 * XXX: Ugly compatibility mappings.
 */
static void
kbd_input_funckey(struct kbd_softc *k, int keysym)
{
        int n;
        char str[12];

        n = 0xC0 + (keysym & 0x3F);
        snprintf(str, sizeof(str), "\033[%dz", n);
        kbd_input_string(k, str);
}


/*
 * Update LEDs to reflect console input state.
 */
static void
kbd_update_leds(struct kbd_softc *k)
{
        struct kbd_state *ks = &k->k_state;
        char leds;

        leds = ks->kbd_leds;
        leds &= ~(LED_CAPS_LOCK|LED_NUM_LOCK);

        if (ks->kbd_modbits & (1 << KBMOD_CAPSLOCK))
                leds |= LED_CAPS_LOCK;
        if (ks->kbd_modbits & (1 << KBMOD_NUMLOCK))
                leds |= LED_NUM_LOCK;

        if (k->k_ops != NULL && k->k_ops->setleds != NULL)
                (void)(*k->k_ops->setleds)(k, leds, 0);
}



/****************************************************************
 *  Events input - called by middle layer at spltty().
 ****************************************************************/

/*
 * Supply raw keystrokes when keyboard is open in firm event mode.
 *
 * Turn the keystroke into an event and put it in the queue.
 * If the queue is full, the keystroke is lost (sorry!).
 */
static void
kbd_input_event(struct kbd_softc *k, int code)
{
        struct firm_event *fe;
        int put;

#ifdef DIAGNOSTIC
        if (!k->k_evmode) {
                printf("%s: kbd_input_event called when not in event mode\n",
                    device_xname(k->k_dev));
                return;
        }
#endif
        put = k->k_events.ev_put;
        fe = &k->k_events.ev_q[put];
        put = (put + 1) % EV_QSIZE;
        if (put == k->k_events.ev_get) {
                log(LOG_WARNING, "%s: event queue overflow\n",
                    device_xname(k->k_dev));
                return;
        }

        fe->id = KEY_CODE(code);
        fe->value = KEY_UP(code) ? VKEY_UP : VKEY_DOWN;
        firm_gettime(fe);
        k->k_events.ev_put = put;
        EV_WAKEUP(&k->k_events);
}



/****************************************************************
 *  Translation stuff declared in kbd_xlate.h
 ****************************************************************/

/*
 * Initialization - called by either lower layer attach or by kdcninit.
 */
void
kbd_xlate_init(struct kbd_state *ks)
{
        struct keyboard *ktbls;
        int id;

        id = ks->kbd_id;
        if (id < KBD_MIN_TYPE)
                id = KBD_MIN_TYPE;
        if (id > kbd_max_type)
                id = kbd_max_type;
        ktbls = keyboards[id];

        ks->kbd_k = *ktbls;     /* struct assignment */
        ks->kbd_modbits = 0;
}

/*
 * Turn keyboard up/down codes into a KEYSYM.
 * Note that the "kd" driver (on sun3 and sparc64) uses this too!
 */
int
kbd_code_to_keysym(struct kbd_state *ks, int c)
{
        u_short *km;
        int keysym;

        /*
         * Get keymap pointer.  One of these:
         * release, control, shifted, normal, ...
         */
        if (KEY_UP(c))
                km = ks->kbd_k.k_release;
        else if (ks->kbd_modbits & KBMOD_CTRL_MASK)
                km = ks->kbd_k.k_control;
        else if (ks->kbd_modbits & KBMOD_SHIFT_MASK)
                km = ks->kbd_k.k_shifted;
        else
                km = ks->kbd_k.k_normal;

        if (km == NULL) {
                /*
                 * Do not know how to translate yet.
                 * We will find out when a RESET comes along.
                 */
                return KEYSYM_NOP;
        }
        keysym = km[KEY_CODE(c)];

        /*
         * Post-processing for Caps-lock
         */
        if ((ks->kbd_modbits & (1 << KBMOD_CAPSLOCK)) &&
                (KEYSYM_CLASS(keysym) == KEYSYM_ASCII) )
        {
                if (('a' <= keysym) && (keysym <= 'z'))
                        keysym -= ('a' - 'A');
        }

        /*
         * Post-processing for Num-lock.  All "function"
         * keysyms get indirected through another table.
         * (XXX: Only if numlock on.  Want off also!)
         */
        if ((ks->kbd_modbits & (1 << KBMOD_NUMLOCK)) &&
                (KEYSYM_CLASS(keysym) == KEYSYM_FUNC) )
        {
                keysym = kbd_numlock_map[keysym & 0x3F];
        }

        return keysym;
}


/*
 * Back door for rcons (fb.c)
 */
void
kbd_bell(int on)
{
        struct kbd_softc *k;

        k = device_lookup_private(&kbd_cd, 0); /* XXX: hardcoded minor */

        if (k == NULL || k->k_ops == NULL || k->k_ops->docmd == NULL)
                return;

        (void)(*k->k_ops->docmd)(k, on ? KBD_CMD_BELL : KBD_CMD_NOBELL, 0);
}

#if NWSKBD > 0
static void
kbd_input_wskbd(struct kbd_softc *k, int code)
{
        int type, key;

#ifdef WSDISPLAY_COMPAT_RAWKBD
        if (k->k_wsraw) {
                u_char buf;

                buf = code;
                wskbd_rawinput(k->k_wskbd, &buf, 1);
                return;
        }
#endif

        type = KEY_UP(code) ? WSCONS_EVENT_KEY_UP : WSCONS_EVENT_KEY_DOWN;
        key = KEY_CODE(code);
        wskbd_input(k->k_wskbd, type, key);
}

int
wssunkbd_enable(void *v, int on)
{
        struct kbd_softc *k = v;
        if (k->k_wsenabled != on) {
                k->k_wsenabled = on;
                if (on) {
                        /* open actual underlying device */
                        if (k->k_ops != NULL && k->k_ops->open != NULL)
                                (*k->k_ops->open)(k);
                        ev_init(&k->k_events);
                        k->k_evmode = 0;        /* XXX: OK? */
                } else {
                        /* close underlying device */
                        if (k->k_ops != NULL && k->k_ops->close != NULL)
                                (*k->k_ops->close)(k);
                }
        }
        return 0;
}

void
wssunkbd_set_leds(void *v, int leds)
{
        struct kbd_softc *k = v;
        int l = 0;

        if (leds & WSKBD_LED_CAPS)
                l |= LED_CAPS_LOCK;
        if (leds & WSKBD_LED_NUM)
                l |= LED_NUM_LOCK;
        if (leds & WSKBD_LED_SCROLL)
                l |= LED_SCROLL_LOCK;
        if (leds & WSKBD_LED_COMPOSE)
                l |= LED_COMPOSE;
        if (k->k_ops != NULL && k->k_ops->setleds != NULL)
                (*k->k_ops->setleds)(k, l, 0);
        k->k_leds=l;
}

static int
wssunkbd_ioctl(void *v, u_long cmd, void *data, int flag, struct lwp *l)
{
        struct kbd_softc *k = v;
        
        switch (cmd) {
                case WSKBDIO_GTYPE:
                        /* we can't tell  4 from  5 or 6 */
                        *(int *)data = k->k_state.kbd_id < KB_SUN4 ?
                            WSKBD_TYPE_SUN : WSKBD_TYPE_SUN5;
                        return 0;
                case WSKBDIO_SETLEDS:
                        wssunkbd_set_leds(v, *(int *)data);
                        return 0;
                case WSKBDIO_GETLEDS:
                        *(int *)data = k->k_leds;
                        return 0;
#ifdef WSDISPLAY_COMPAT_RAWKBD
                case WSKBDIO_SETMODE:
                        k->k_wsraw = *(int *)data == WSKBD_RAW;
                        return 0;
#endif
        }
        return EPASSTHROUGH;
}

extern int      prom_cngetc(dev_t);

static void
sunkbd_wskbd_cngetc(void *v, u_int *type, int *data)
{
        /* struct kbd_sun_softc *k = v; */

        *data = prom_cngetc(0);
        *type = WSCONS_EVENT_ASCII;
}

void
sunkbd_wskbd_cnpollc(void *v, int on)
{
}

static void
sunkbd_bell_off(void *v)
{
        struct kbd_softc *k = v;

        k->k_ops->docmd(k, KBD_CMD_NOBELL, 0);
}

void
sunkbd_wskbd_cnbell(void *v, u_int pitch, u_int period, u_int volume)
{
        struct kbd_softc *k = v;

        callout_reset(&k->k_wsbell, period * 1000 / hz, sunkbd_bell_off, v);
        k->k_ops->docmd(k, KBD_CMD_BELL, 0);
}

void
kbd_enable(device_t dev)
{
        struct kbd_softc *k = device_private(dev);
        struct wskbddev_attach_args a;

        if (k->k_isconsole)
                wskbd_cnattach(&sunkbd_wskbd_consops, k,
                    &sunkbd_wskbd_keymapdata);

        a.console = k->k_isconsole;
        a.keymap = &sunkbd_wskbd_keymapdata;
        a.accessops = &sunkbd_wskbd_accessops;
        a.accesscookie = k;

        /* XXX why? */
        k->k_wsenabled = 0;

        /* Attach the wskbd */
        k->k_wskbd = config_found(k->k_dev, &a, wskbddevprint);

        callout_init(&k->k_wsbell, 0);

        wssunkbd_enable(k,1);
        
        wssunkbd_set_leds(k, WSKBD_LED_SCROLL | WSKBD_LED_NUM | WSKBD_LED_CAPS);
        delay(100000);
        wssunkbd_set_leds(k, 0);
}

void
kbd_wskbd_attach(struct kbd_softc *k, int isconsole)
{
        k->k_isconsole = isconsole;
        
        config_interrupts(k->k_dev, kbd_enable);
}
#endif