From c79577cc178f4f944af171fd4dfeaf52e4fd11e1 Mon Sep 17 00:00:00 2001 From: emax Date: Thu, 14 Jul 2005 17:48:04 +0000 Subject: kbdmux(4) keyboard multiplexer integration o Add sys/dev/kbdmux/kbdmux.c to the source tree o Add sys/modules/kbdmux/Makefile to the source tree These are not yet connected to the build. Man page and other changes to follow. MFC after: 1 week --- sys/dev/kbdmux/kbdmux.c | 1314 +++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 1314 insertions(+) create mode 100644 sys/dev/kbdmux/kbdmux.c (limited to 'sys/dev/kbdmux/kbdmux.c') diff --git a/sys/dev/kbdmux/kbdmux.c b/sys/dev/kbdmux/kbdmux.c new file mode 100644 index 0000000..4a36513 --- /dev/null +++ b/sys/dev/kbdmux/kbdmux.c @@ -0,0 +1,1314 @@ +/* + * kbdmux.c + */ + +/*- + * Copyright (c) 2005 Maksim Yevmenkin + * All rights reserved. + * + * 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. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR 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 AUTHOR 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. + * + * $Id: kbdmux.c,v 1.4 2005/07/14 17:38:35 max Exp $ + * $FreeBSD$ + */ + +#include "opt_kbd.h" + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define KEYBOARD_NAME "kbdmux" + +MALLOC_DECLARE(M_KBDMUX); +MALLOC_DEFINE(M_KBDMUX, KEYBOARD_NAME, "Keyboard multiplexor"); + +/***************************************************************************** + ***************************************************************************** + ** Keyboard state + ***************************************************************************** + *****************************************************************************/ + +#define KBDMUX_Q_SIZE 512 /* input queue size */ + +/* + * XXX + * For now rely on Giant mutex to protect our data structures. + * Just like the rest of keyboard drivers and syscons(4) do. + * Note that callout is initialized as not MP-safe to make sure + * Giant is held. + */ + +#if 0 /* not yet */ +#define KBDMUX_LOCK_DECL_GLOBAL \ + struct mtx ks_lock +#define KBDMUX_LOCK_INIT(s) \ + mtx_init(&(s)->ks_lock, "kbdmux", NULL, MTX_DEF|MTX_RECURSE) +#define KBDMUX_LOCK_DESTROY(s) \ + mtx_destroy(&(s)->ks_lock) +#define KBDMUX_LOCK(s) \ + mtx_lock(&(s)->ks_lock) +#define KBDMUX_UNLOCK(s) \ + mtx_unlock(&(s)->ks_lock) +#define KBDMUX_LOCK_ASSERT(s, w) \ + mtx_assert(&(s)->ks_lock, (w)) +#define KBDMUX_SLEEP(s, f, d, t) \ + msleep(&(s)->f, &(s)->ks_lock, PCATCH | (PZERO + 1), (d), (t)) +#define KBDMUX_CALLOUT_INIT(s) \ + callout_init_mtx(&(s)->ks_timo, &(s)->ks_lock, 0) +#define KBDMUX_QUEUE_INTR(s) \ + taskqueue_enqueue(taskqueue_swi_giant, &(s)->ks_task) +#else +#define KBDMUX_LOCK_DECL_GLOBAL + +#define KBDMUX_LOCK_INIT(s) + +#define KBDMUX_LOCK_DESTROY(s) + +#define KBDMUX_LOCK(s) + +#define KBDMUX_UNLOCK(s) + +#define KBDMUX_LOCK_ASSERT(s, w) + +#define KBDMUX_SLEEP(s, f, d, t) \ + tsleep(&(s)->f, PCATCH | (PZERO + 1), (d), (t)) +#define KBDMUX_CALLOUT_INIT(s) \ + callout_init(&(s)->ks_timo, 0) +#define KBDMUX_QUEUE_INTR(s) \ + taskqueue_enqueue(taskqueue_swi_giant, &(s)->ks_task) +#endif /* not yet */ + +#define KBDMUX_INTR(kbd, arg) \ + (*kbdsw[(kbd)->kb_index]->intr)((kbd), (arg)) + +#define KBDMUX_IOCTL(kbd, cmd, arg) \ + (*kbdsw[(kbd)->kb_index]->ioctl)((kbd), (cmd), (caddr_t) (arg)) + +#define KBDMUX_CHECK_CHAR(kbd) \ + (*kbdsw[(kbd)->kb_index]->check_char)((kbd)) + +#define KBDMUX_READ_CHAR(kbd, wait) \ + (*kbdsw[(kbd)->kb_index]->read_char)((kbd), (wait)) + +#define KBDMUX_ENABLE(kbd) \ + (*kbdsw[(kbd)->kb_index]->enable)((kbd)) + +#define KBDMUX_POLL(kbd, on) \ + (*kbdsw[(kbd)->kb_index]->poll)((kbd), (on)) + +#define KBDMUX_CLEAR_STATE(kbd) \ + (*kbdsw[(kbd)->kb_index]->clear_state)((kbd)) + +/* + * kbdmux keyboard + */ +struct kbdmux_kbd +{ + keyboard_t *kbd; /* keyboard */ + int idx; /* keyboard index */ + SLIST_ENTRY(kbdmux_kbd) next; /* link to next */ +}; + +typedef struct kbdmux_kbd kbdmux_kbd_t; + +/* + * kbdmux state + */ +struct kbdmux_state +{ + struct clist ks_inq; /* input chars queue */ + struct task ks_task; /* interrupt task */ + struct callout ks_timo; /* timeout handler */ +#define TICKS (hz) /* rate */ + + int ks_flags; /* flags */ +#define COMPOSE (1 << 0) /* compose char flag */ +#define POLLING (1 << 1) /* polling */ +#define TASK (1 << 2) /* interrupt task queued */ + + int ks_mode; /* K_XLATE, K_RAW, K_CODE */ + int ks_state; /* state */ + int ks_accents; /* accent key index (> 0) */ + u_int ks_composed_char; /* composed char code */ + u_char ks_prefix; /* AT scan code prefix */ + + SLIST_HEAD(, kbdmux_kbd) ks_kbds; /* keyboards */ + + KBDMUX_LOCK_DECL_GLOBAL; +}; + +typedef struct kbdmux_state kbdmux_state_t; + +/***************************************************************************** + ***************************************************************************** + ** Helper functions + ***************************************************************************** + *****************************************************************************/ + +static task_fn_t kbdmux_kbd_intr; +static timeout_t kbdmux_kbd_intr_timo; +static kbd_callback_func_t kbdmux_kbd_event; + +/* + * Interrupt handler task + */ +void +kbdmux_kbd_intr(void *xkbd, int pending) +{ + keyboard_t *kbd = (keyboard_t *) xkbd; + kbdmux_state_t *state = (kbdmux_state_t *) kbd->kb_data; + + KBDMUX_INTR(kbd, NULL); + + KBDMUX_LOCK(state); + + state->ks_flags &= ~TASK; + wakeup(&state->ks_task); + + KBDMUX_UNLOCK(state); +} + +/* + * Schedule interrupt handler on timeout. Called with locked state. + */ +void +kbdmux_kbd_intr_timo(void *xstate) +{ + kbdmux_state_t *state = (kbdmux_state_t *) xstate; + + KBDMUX_LOCK_ASSERT(state, MA_OWNED); + + if (callout_pending(&state->ks_timo)) + return; /* callout was reset */ + + if (!callout_active(&state->ks_timo)) + return; /* callout was stopped */ + + callout_deactivate(&state->ks_timo); + + /* queue interrupt task if needed */ + if (state->ks_inq.c_cc > 0 && !(state->ks_flags & TASK) && + KBDMUX_QUEUE_INTR(state) == 0) + state->ks_flags |= TASK; + + /* re-schedule timeout */ + callout_reset(&state->ks_timo, TICKS, kbdmux_kbd_intr_timo, state); +} + +/* + * Process event from one of our keyboards + */ +static int +kbdmux_kbd_event(keyboard_t *kbd, int event, void *arg) +{ + kbdmux_state_t *state = (kbdmux_state_t *) arg; + + switch (event) { + case KBDIO_KEYINPUT: { + int c; + + KBDMUX_LOCK(state); + + /* read all chars from the keyboard */ + while (KBDMUX_CHECK_CHAR(kbd)) { + c = KBDMUX_READ_CHAR(kbd, 0); + if (c == NOKEY) + continue; + if (c == ERRKEY) + continue; /* XXX ring bell */ + if (!KBD_IS_BUSY(kbd)) + continue; /* not open - discard the input */ + + putc(c, &state->ks_inq); + } + + /* queue interrupt task if needed */ + if (state->ks_inq.c_cc > 0 && !(state->ks_flags & TASK) && + KBDMUX_QUEUE_INTR(state) == 0) + state->ks_flags |= TASK; + + KBDMUX_UNLOCK(state); + } break; + + case KBDIO_UNLOADING: { + kbdmux_kbd_t *k; + + KBDMUX_LOCK(state); + + SLIST_FOREACH(k, &state->ks_kbds, next) + if (k->kbd == kbd) + break; + + if (k != NULL) { + kbd_release(k->kbd, &k->kbd); + SLIST_REMOVE(&state->ks_kbds, k, kbdmux_kbd, next); + + k->kbd = NULL; + k->idx = -1; + + free(k, M_KBDMUX); + } + + KBDMUX_UNLOCK(state); + } break; + + default: + return (EINVAL); + /* NOT REACHED */ + } + + return (0); +} + +/**************************************************************************** + **************************************************************************** + ** Keyboard driver + **************************************************************************** + ****************************************************************************/ + +static int kbdmux_configure(int flags); +static kbd_probe_t kbdmux_probe; +static kbd_init_t kbdmux_init; +static kbd_term_t kbdmux_term; +static kbd_intr_t kbdmux_intr; +static kbd_test_if_t kbdmux_test_if; +static kbd_enable_t kbdmux_enable; +static kbd_disable_t kbdmux_disable; +static kbd_read_t kbdmux_read; +static kbd_check_t kbdmux_check; +static kbd_read_char_t kbdmux_read_char; +static kbd_check_char_t kbdmux_check_char; +static kbd_ioctl_t kbdmux_ioctl; +static kbd_lock_t kbdmux_lock; +static void kbdmux_clear_state_locked(kbdmux_state_t *state); +static kbd_clear_state_t kbdmux_clear_state; +static kbd_get_state_t kbdmux_get_state; +static kbd_set_state_t kbdmux_set_state; +static kbd_poll_mode_t kbdmux_poll; + +static keyboard_switch_t kbdmuxsw = { + .probe = kbdmux_probe, + .init = kbdmux_init, + .term = kbdmux_term, + .intr = kbdmux_intr, + .test_if = kbdmux_test_if, + .enable = kbdmux_enable, + .disable = kbdmux_disable, + .read = kbdmux_read, + .check = kbdmux_check, + .read_char = kbdmux_read_char, + .check_char = kbdmux_check_char, + .ioctl = kbdmux_ioctl, + .lock = kbdmux_lock, + .clear_state = kbdmux_clear_state, + .get_state = kbdmux_get_state, + .set_state = kbdmux_set_state, + .get_fkeystr = genkbd_get_fkeystr, + .poll = kbdmux_poll, + .diag = genkbd_diag, +}; + +/* + * Return the number of found keyboards + */ +static int +kbdmux_configure(int flags) +{ + return (1); +} + +/* + * Detect a keyboard + */ +static int +kbdmux_probe(int unit, void *arg, int flags) +{ + return (0); +} + +/* + * Reset and initialize the keyboard (stolen from atkbd.c) + */ +static int +kbdmux_init(int unit, keyboard_t **kbdp, void *arg, int flags) +{ + keyboard_t *kbd = NULL; + kbdmux_state_t *state = NULL; + keymap_t *keymap = NULL; + accentmap_t *accmap = NULL; + fkeytab_t *fkeymap = NULL; + int error, needfree, fkeymap_size, delay[2]; + + if (*kbdp == NULL) { + *kbdp = kbd = malloc(sizeof(*kbd), M_KBDMUX, M_NOWAIT | M_ZERO); + state = malloc(sizeof(*state), M_KBDMUX, M_NOWAIT | M_ZERO); + keymap = malloc(sizeof(key_map), M_KBDMUX, M_NOWAIT); + accmap = malloc(sizeof(accent_map), M_KBDMUX, M_NOWAIT); + fkeymap = malloc(sizeof(fkey_tab), M_KBDMUX, M_NOWAIT); + fkeymap_size = sizeof(fkey_tab)/sizeof(fkey_tab[0]); + needfree = 1; + + if ((kbd == NULL) || (state == NULL) || (keymap == NULL) || + (accmap == NULL) || (fkeymap == NULL)) { + error = ENOMEM; + goto bad; + } + + KBDMUX_LOCK_INIT(state); + clist_alloc_cblocks(&state->ks_inq, + KBDMUX_Q_SIZE, KBDMUX_Q_SIZE / 2); + TASK_INIT(&state->ks_task, 0, kbdmux_kbd_intr, (void *) kbd); + KBDMUX_CALLOUT_INIT(state); + SLIST_INIT(&state->ks_kbds); + } else if (KBD_IS_INITIALIZED(*kbdp) && KBD_IS_CONFIGURED(*kbdp)) { + return (0); + } else { + kbd = *kbdp; + state = (kbdmux_state_t *) kbd->kb_data; + keymap = kbd->kb_keymap; + accmap = kbd->kb_accentmap; + fkeymap = kbd->kb_fkeytab; + fkeymap_size = kbd->kb_fkeytab_size; + needfree = 0; + } + + if (!KBD_IS_PROBED(kbd)) { + /* XXX assume 101/102 keys keyboard */ + kbd_init_struct(kbd, KEYBOARD_NAME, KB_101, unit, flags, 0, 0); + bcopy(&key_map, keymap, sizeof(key_map)); + bcopy(&accent_map, accmap, sizeof(accent_map)); + bcopy(fkey_tab, fkeymap, + imin(fkeymap_size*sizeof(fkeymap[0]), sizeof(fkey_tab))); + kbd_set_maps(kbd, keymap, accmap, fkeymap, fkeymap_size); + kbd->kb_data = (void *)state; + + KBD_FOUND_DEVICE(kbd); + KBD_PROBE_DONE(kbd); + + KBDMUX_LOCK(state); + kbdmux_clear_state_locked(state); + state->ks_mode = K_XLATE; + KBDMUX_UNLOCK(state); + } + + if (!KBD_IS_INITIALIZED(kbd) && !(flags & KB_CONF_PROBE_ONLY)) { + kbd->kb_config = flags & ~KB_CONF_PROBE_ONLY; + + kbdmux_ioctl(kbd, KDSETLED, (caddr_t)&state->ks_state); + + delay[0] = kbd->kb_delay1; + delay[1] = kbd->kb_delay2; + kbdmux_ioctl(kbd, KDSETREPEAT, (caddr_t)delay); + + KBD_INIT_DONE(kbd); + } + + if (!KBD_IS_CONFIGURED(kbd)) { + if (kbd_register(kbd) < 0) { + error = ENXIO; + goto bad; + } + + KBD_CONFIG_DONE(kbd); + + KBDMUX_LOCK(state); + callout_reset(&state->ks_timo, TICKS, kbdmux_kbd_intr_timo, state); + KBDMUX_UNLOCK(state); + } + + return (0); +bad: + if (needfree) { + if (state != NULL) { + clist_free_cblocks(&state->ks_inq); + free(state, M_KBDMUX); + } + if (keymap != NULL) + free(keymap, M_KBDMUX); + if (accmap != NULL) + free(accmap, M_KBDMUX); + if (fkeymap != NULL) + free(fkeymap, M_KBDMUX); + if (kbd != NULL) { + free(kbd, M_KBDMUX); + *kbdp = NULL; /* insure ref doesn't leak to caller */ + } + } + + return (error); +} + +/* + * Finish using this keyboard + */ +static int +kbdmux_term(keyboard_t *kbd) +{ + kbdmux_state_t *state = (kbdmux_state_t *) kbd->kb_data; + kbdmux_kbd_t *k; + + KBDMUX_LOCK(state); + + /* kill callout */ + callout_stop(&state->ks_timo); + + /* wait for interrupt task */ + while (state->ks_flags & TASK) + KBDMUX_SLEEP(state, ks_task, "kbdmuxc", 0); + + /* release all keyboards from the mux */ + while ((k = SLIST_FIRST(&state->ks_kbds)) != NULL) { + kbd_release(k->kbd, &k->kbd); + SLIST_REMOVE_HEAD(&state->ks_kbds, next); + + k->kbd = NULL; + k->idx = -1; + + free(k, M_KBDMUX); + } + + /* flush input queue */ + ndflush(&state->ks_inq, state->ks_inq.c_cc); + clist_free_cblocks(&state->ks_inq); + + KBDMUX_UNLOCK(state); + + kbd_unregister(kbd); + + KBDMUX_LOCK_DESTROY(state); + bzero(state, sizeof(*state)); + free(state, M_KBDMUX); + free(kbd, M_KBDMUX); + + return (0); +} + +/* + * Keyboard interrupt routine + */ +static int +kbdmux_intr(keyboard_t *kbd, void *arg) +{ + int c; + + if (KBD_IS_ACTIVE(kbd) && KBD_IS_BUSY(kbd)) { + /* let the callback function to process the input */ + (*kbd->kb_callback.kc_func)(kbd, KBDIO_KEYINPUT, + kbd->kb_callback.kc_arg); + } else { + /* read and discard the input; no one is waiting for input */ + do { + c = kbdmux_read_char(kbd, FALSE); + } while (c != NOKEY); + } + + return (0); +} + +/* + * Test the interface to the device + */ +static int +kbdmux_test_if(keyboard_t *kbd) +{ + return (0); +} + +/* + * Enable the access to the device; until this function is called, + * the client cannot read from the keyboard. + */ +static int +kbdmux_enable(keyboard_t *kbd) +{ + KBD_ACTIVATE(kbd); + return (0); +} + +/* + * Disallow the access to the device + */ +static int +kbdmux_disable(keyboard_t *kbd) +{ + KBD_DEACTIVATE(kbd); + return (0); +} + +/* + * Read one byte from the keyboard if it's allowed + */ +static int +kbdmux_read(keyboard_t *kbd, int wait) +{ + kbdmux_state_t *state = (kbdmux_state_t *) kbd->kb_data; + int c; + + KBDMUX_LOCK(state); + c = getc(&state->ks_inq); + KBDMUX_UNLOCK(state); + + if (c != -1) + kbd->kb_count ++; + + return (KBD_IS_ACTIVE(kbd)? c : -1); +} + +/* + * Check if data is waiting + */ +static int +kbdmux_check(keyboard_t *kbd) +{ + kbdmux_state_t *state = (kbdmux_state_t *) kbd->kb_data; + int ready; + + if (!KBD_IS_ACTIVE(kbd)) + return (FALSE); + + KBDMUX_LOCK(state); + ready = (state->ks_inq.c_cc > 0)? TRUE : FALSE; + KBDMUX_UNLOCK(state); + + return (ready); +} + +/* + * Read char from the keyboard (stolen from atkbd.c) + */ +static u_int +kbdmux_read_char(keyboard_t *kbd, int wait) +{ + kbdmux_state_t *state = (kbdmux_state_t *) kbd->kb_data; + u_int action; + int scancode, keycode; + + KBDMUX_LOCK(state); + +next_code: + + /* do we have a composed char to return? */ + if (!(state->ks_flags & COMPOSE) && (state->ks_composed_char > 0)) { + action = state->ks_composed_char; + state->ks_composed_char = 0; + if (action > UCHAR_MAX) { + KBDMUX_UNLOCK(state); + + return (ERRKEY); + } + + KBDMUX_UNLOCK(state); + + return (action); + } + + /* see if there is something in the keyboard queue */ + scancode = getc(&state->ks_inq); + if (scancode == -1) { + KBDMUX_UNLOCK(state); + return (NOKEY); + } + /* XXX FIXME: check for -1 if wait == 1! */ + + kbd->kb_count ++; + + /* return the byte as is for the K_RAW mode */ + if (state->ks_mode == K_RAW) { + KBDMUX_UNLOCK(state); + return (scancode); + } + + /* translate the scan code into a keycode */ + keycode = scancode & 0x7F; + switch (state->ks_prefix) { + case 0x00: /* normal scancode */ + switch(scancode) { + case 0xB8: /* left alt (compose key) released */ + if (state->ks_flags & COMPOSE) { + state->ks_flags &= ~COMPOSE; + if (state->ks_composed_char > UCHAR_MAX) + state->ks_composed_char = 0; + } + break; + case 0x38: /* left alt (compose key) pressed */ + if (!(state->ks_flags & COMPOSE)) { + state->ks_flags |= COMPOSE; + state->ks_composed_char = 0; + } + break; + case 0xE0: + case 0xE1: + state->ks_prefix = scancode; + goto next_code; + } + break; + case 0xE0: /* 0xE0 prefix */ + state->ks_prefix = 0; + switch (keycode) { + case 0x1C: /* right enter key */ + keycode = 0x59; + break; + case 0x1D: /* right ctrl key */ + keycode = 0x5A; + break; + case 0x35: /* keypad divide key */ + keycode = 0x5B; + break; + case 0x37: /* print scrn key */ + keycode = 0x5C; + break; + case 0x38: /* right alt key (alt gr) */ + keycode = 0x5D; + break; + case 0x46: /* ctrl-pause/break on AT 101 (see below) */ + keycode = 0x68; + break; + case 0x47: /* grey home key */ + keycode = 0x5E; + break; + case 0x48: /* grey up arrow key */ + keycode = 0x5F; + break; + case 0x49: /* grey page up key */ + keycode = 0x60; + break; + case 0x4B: /* grey left arrow key */ + keycode = 0x61; + break; + case 0x4D: /* grey right arrow key */ + keycode = 0x62; + break; + case 0x4F: /* grey end key */ + keycode = 0x63; + break; + case 0x50: /* grey down arrow key */ + keycode = 0x64; + break; + case 0x51: /* grey page down key */ + keycode = 0x65; + break; + case 0x52: /* grey insert key */ + keycode = 0x66; + break; + case 0x53: /* grey delete key */ + keycode = 0x67; + break; + /* the following 3 are only used on the MS "Natural" keyboard */ + case 0x5b: /* left Window key */ + keycode = 0x69; + break; + case 0x5c: /* right Window key */ + keycode = 0x6a; + break; + case 0x5d: /* menu key */ + keycode = 0x6b; + break; + case 0x5e: /* power key */ + keycode = 0x6d; + break; + case 0x5f: /* sleep key */ + keycode = 0x6e; + break; + case 0x63: /* wake key */ + keycode = 0x6f; + break; + default: /* ignore everything else */ + goto next_code; + } + break; + case 0xE1: /* 0xE1 prefix */ + /* + * The pause/break key on the 101 keyboard produces: + * E1-1D-45 E1-9D-C5 + * Ctrl-pause/break produces: + * E0-46 E0-C6 (See above.) + */ + state->ks_prefix = 0; + if (keycode == 0x1D) + state->ks_prefix = 0x1D; + goto next_code; + /* NOT REACHED */ + case 0x1D: /* pause / break */ + state->ks_prefix = 0; + if (keycode != 0x45) + goto next_code; + keycode = 0x68; + break; + } + + /* XXX assume 101/102 keys AT keyboard */ + switch (keycode) { + case 0x5c: /* print screen */ + if (state->ks_flags & ALTS) + keycode = 0x54; /* sysrq */ + break; + case 0x68: /* pause/break */ + if (state->ks_flags & CTLS) + keycode = 0x6c; /* break */ + break; + } + + /* return the key code in the K_CODE mode */ + if (state->ks_mode == K_CODE) { + KBDMUX_UNLOCK(state); + return (keycode | (scancode & 0x80)); + } + + /* compose a character code */ + if (state->ks_flags & COMPOSE) { + switch (keycode | (scancode & 0x80)) { + /* key pressed, process it */ + case 0x47: case 0x48: case 0x49: /* keypad 7,8,9 */ + state->ks_composed_char *= 10; + state->ks_composed_char += keycode - 0x40; + if (state->ks_composed_char > UCHAR_MAX) { + KBDMUX_UNLOCK(state); + return (ERRKEY); + } + goto next_code; + case 0x4B: case 0x4C: case 0x4D: /* keypad 4,5,6 */ + state->ks_composed_char *= 10; + state->ks_composed_char += keycode - 0x47; + if (state->ks_composed_char > UCHAR_MAX) { + KBDMUX_UNLOCK(state); + return (ERRKEY); + } + goto next_code; + case 0x4F: case 0x50: case 0x51: /* keypad 1,2,3 */ + state->ks_composed_char *= 10; + state->ks_composed_char += keycode - 0x4E; + if (state->ks_composed_char > UCHAR_MAX) { + KBDMUX_UNLOCK(state); + return (ERRKEY); + } + goto next_code; + case 0x52: /* keypad 0 */ + state->ks_composed_char *= 10; + if (state->ks_composed_char > UCHAR_MAX) { + KBDMUX_UNLOCK(state); + return (ERRKEY); + } + goto next_code; + + /* key released, no interest here */ + case 0xC7: case 0xC8: case 0xC9: /* keypad 7,8,9 */ + case 0xCB: case 0xCC: case 0xCD: /* keypad 4,5,6 */ + case 0xCF: case 0xD0: case 0xD1: /* keypad 1,2,3 */ + case 0xD2: /* keypad 0 */ + goto next_code; + + case 0x38: /* left alt key */ + break; + + default: + if (state->ks_composed_char > 0) { + state->ks_flags &= ~COMPOSE; + state->ks_composed_char = 0; + KBDMUX_UNLOCK(state); + return (ERRKEY); + } + break; + } + } + + /* keycode to key action */ + action = genkbd_keyaction(kbd, keycode, scancode & 0x80, + &state->ks_state, &state->ks_accents); + if (action == NOKEY) + goto next_code; + + KBDMUX_UNLOCK(state); + + return (action); +} + +/* + * Check if char is waiting + */ +static int +kbdmux_check_char(keyboard_t *kbd) +{ + kbdmux_state_t *state = (kbdmux_state_t *) kbd->kb_data; + int ready; + + if (!KBD_IS_ACTIVE(kbd)) + return (FALSE); + + KBDMUX_LOCK(state); + + if (!(state->ks_flags & COMPOSE) && (state->ks_composed_char != 0)) + ready = TRUE; + else + ready = (state->ks_inq.c_cc > 0)? TRUE : FALSE; + + KBDMUX_UNLOCK(state); + + return (ready); +} + +/* + * Keyboard ioctl's + */ +static int +kbdmux_ioctl(keyboard_t *kbd, u_long cmd, caddr_t arg) +{ + static int delays[] = { + 250, 500, 750, 1000 + }; + + static int rates[] = { + 34, 38, 42, 46, 50, 55, 59, 63, + 68, 76, 84, 92, 100, 110, 118, 126, + 136, 152, 168, 184, 200, 220, 236, 252, + 272, 304, 336, 368, 400, 440, 472, 504 + }; + + kbdmux_state_t *state = (kbdmux_state_t *) kbd->kb_data; + kbdmux_kbd_t *k; + int error = 0, mode; + + if (state == NULL) + return (ENXIO); + + switch (cmd) { + case KBADDKBD: /* add keyboard to the mux */ + KBDMUX_LOCK(state); + + SLIST_FOREACH(k, &state->ks_kbds, next) + if (k->idx == *((int *) arg)) + break; + + if (k != NULL) { + KBDMUX_UNLOCK(state); + + return (0); /* keyboard already in the mux */ + } + + k = malloc(sizeof(*k), M_KBDMUX, M_NOWAIT | M_ZERO); + if (k == NULL) { + KBDMUX_UNLOCK(state); + + return (ENOMEM); /* out of memory */ + } + + k->kbd = kbd_get_keyboard(*((int *) arg)); + if (k->kbd == NULL) { + KBDMUX_UNLOCK(state); + free(k, M_KBDMUX); + + return (EINVAL); /* bad keyboard index */ + } + + k->idx = kbd_allocate(k->kbd->kb_name, k->kbd->kb_unit, + (void *) &k->kbd, + kbdmux_kbd_event, (void *) state); + if (k->idx == -1) { + KBDMUX_UNLOCK(state); + free(k, M_KBDMUX); + + return (EBUSY); /* keyboard is busy */ + } + + KBDMUX_ENABLE(k->kbd); + KBDMUX_CLEAR_STATE(k->kbd); + + /* set K_RAW mode on slave keyboard */ + mode = K_RAW; + error = KBDMUX_IOCTL(k->kbd, KDSKBMODE, &mode); + if (error == 0) { + /* set lock keys state on slave keyboard */ + mode = state->ks_state & LOCK_MASK; + error = KBDMUX_IOCTL(k->kbd, KDSKBSTATE, &mode); + } + + if (error != 0) { + KBDMUX_UNLOCK(state); + + kbd_release(k->kbd, &k->kbd); + k->kbd = NULL; + k->idx = -1; + + free(k, M_KBDMUX); + + return (error); /* could not set mode */ + } + + SLIST_INSERT_HEAD(&state->ks_kbds, k, next); + + KBDMUX_UNLOCK(state); + break; + + case KBRELKBD: /* release keyboard from the mux */ + KBDMUX_LOCK(state); + + SLIST_FOREACH(k, &state->ks_kbds, next) + if (k->idx == *((int *) arg)) + break; + + if (k != NULL) { + error = kbd_release(k->kbd, &k->kbd); + if (error == 0) { + SLIST_REMOVE(&state->ks_kbds, k, kbdmux_kbd, next); + + k->kbd = NULL; + k->idx = -1; + + free(k, M_KBDMUX); + } + } else + error = ENXIO; /* keyboard is not in the mux */ + + KBDMUX_UNLOCK(state); + break; + + case KDGKBMODE: /* get kyboard mode */ + KBDMUX_LOCK(state); + *((int *) arg) = state->ks_mode; + KBDMUX_UNLOCK(state); + break; + + case KDSKBMODE: /* set keyboard mode */ + KBDMUX_LOCK(state); + + switch (*((int *) arg)) { + case K_XLATE: + if (state->ks_mode != K_XLATE) { + /* make lock key state and LED state match */ + state->ks_state &= ~LOCK_MASK; + state->ks_state |= KBD_LED_VAL(kbd); + } + /* FALLTHROUGH */ + + case K_RAW: + case K_CODE: + if (state->ks_mode != *((int *) arg)) { + kbdmux_clear_state_locked(state); + state->ks_mode = *((int *) arg); + } + break; + + default: + error = EINVAL; + break; + } + + KBDMUX_UNLOCK(state); + break; + + case KDGETLED: /* get keyboard LED */ + KBDMUX_LOCK(state); + *((int *) arg) = KBD_LED_VAL(kbd); + KBDMUX_UNLOCK(state); + break; + + case KDSETLED: /* set keyboard LED */ + KBDMUX_LOCK(state); + + /* NOTE: lock key state in ks_state won't be changed */ + if (*((int *) arg) & ~LOCK_MASK) { + KBDMUX_UNLOCK(state); + + return (EINVAL); + } + + KBD_LED_VAL(kbd) = *((int *) arg); + + /* KDSETLED on all slave keyboards */ + SLIST_FOREACH(k, &state->ks_kbds, next) + KBDMUX_IOCTL(k->kbd, KDSETLED, arg); + + KBDMUX_UNLOCK(state); + break; + + case KDGKBSTATE: /* get lock key state */ + KBDMUX_LOCK(state); + *((int *) arg) = state->ks_state & LOCK_MASK; + KBDMUX_UNLOCK(state); + break; + + case KDSKBSTATE: /* set lock key state */ + KBDMUX_LOCK(state); + + if (*((int *) arg) & ~LOCK_MASK) { + KBDMUX_UNLOCK(state); + + return (EINVAL); + } + + state->ks_state &= ~LOCK_MASK; + state->ks_state |= *((int *) arg); + + /* KDSKBSTATE on all slave keyboards */ + SLIST_FOREACH(k, &state->ks_kbds, next) + KBDMUX_IOCTL(k->kbd, KDSKBSTATE, arg); + + KBDMUX_UNLOCK(state); + + return (kbdmux_ioctl(kbd, KDSETLED, arg)); + /* NOT REACHED */ + + case KDSETREPEAT: /* set keyboard repeat rate (new interface) */ + case KDSETRAD: /* set keyboard repeat rate (old interface) */ + KBDMUX_LOCK(state); + + if (cmd == KDSETREPEAT) { + int i; + + /* lookup delay */ + for (i = sizeof(delays)/sizeof(delays[0]) - 1; i > 0; i --) + if (((int *) arg)[0] >= delays[i]) + break; + mode = i << 5; + + /* lookup rate */ + for (i = sizeof(rates)/sizeof(rates[0]) - 1; i > 0; i --) + if (((int *) arg)[1] >= rates[i]) + break; + mode |= i; + } else + mode = *((int *) arg); + + if (mode & ~0x7f) { + KBDMUX_UNLOCK(state); + + return (EINVAL); + } + + kbd->kb_delay1 = delays[(mode >> 5) & 3]; + kbd->kb_delay2 = rates[mode & 0x1f]; + + /* perform command on all slave keyboards */ + SLIST_FOREACH(k, &state->ks_kbds, next) + KBDMUX_IOCTL(k->kbd, cmd, arg); + + KBDMUX_UNLOCK(state); + break; + + case PIO_KEYMAP: /* set keyboard translation table */ + case PIO_KEYMAPENT: /* set keyboard translation table entry */ + case PIO_DEADKEYMAP: /* set accent key translation table */ + KBDMUX_LOCK(state); + state->ks_accents = 0; + + /* perform command on all slave keyboards */ + SLIST_FOREACH(k, &state->ks_kbds, next) + KBDMUX_IOCTL(k->kbd, cmd, arg); + + KBDMUX_UNLOCK(state); + /* FALLTHROUGH */ + + default: + error = genkbd_commonioctl(kbd, cmd, arg); + break; + } + + return (error); +} + +/* + * Lock the access to the keyboard + */ +static int +kbdmux_lock(keyboard_t *kbd, int lock) +{ + return (1); /* XXX */ +} + +/* + * Clear the internal state of the keyboard + */ +static void +kbdmux_clear_state_locked(kbdmux_state_t *state) +{ + KBDMUX_LOCK_ASSERT(state, MA_OWNED); + + state->ks_flags &= ~(COMPOSE|POLLING); + state->ks_state &= LOCK_MASK; /* preserve locking key state */ + state->ks_accents = 0; + state->ks_composed_char = 0; +/* state->ks_prefix = 0; XXX */ + + ndflush(&state->ks_inq, state->ks_inq.c_cc); +} + +static void +kbdmux_clear_state(keyboard_t *kbd) +{ + kbdmux_state_t *state = (kbdmux_state_t *) kbd->kb_data; + + KBDMUX_LOCK(state); + kbdmux_clear_state_locked(state); + KBDMUX_UNLOCK(state); +} + +/* + * Save the internal state + */ +static int +kbdmux_get_state(keyboard_t *kbd, void *buf, size_t len) +{ + if (len == 0) + return (sizeof(kbdmux_state_t)); + if (len < sizeof(kbdmux_state_t)) + return (-1); + + bcopy(kbd->kb_data, buf, sizeof(kbdmux_state_t)); /* XXX locking? */ + + return (0); +} + +/* + * Set the internal state + */ +static int +kbdmux_set_state(keyboard_t *kbd, void *buf, size_t len) +{ + if (len < sizeof(kbdmux_state_t)) + return (ENOMEM); + + bcopy(buf, kbd->kb_data, sizeof(kbdmux_state_t)); /* XXX locking? */ + + return (0); +} + +/* + * Set polling + */ +static int +kbdmux_poll(keyboard_t *kbd, int on) +{ + kbdmux_state_t *state = (kbdmux_state_t *) kbd->kb_data; + kbdmux_kbd_t *k; + + KBDMUX_LOCK(state); + + if (on) + state->ks_flags |= POLLING; + else + state->ks_flags &= ~POLLING; + + /* set poll on slave keyboards */ + SLIST_FOREACH(k, &state->ks_kbds, next) + KBDMUX_POLL(k->kbd, on); + + KBDMUX_UNLOCK(state); + + return (0); +} + +/***************************************************************************** + ***************************************************************************** + ** Module + ***************************************************************************** + *****************************************************************************/ + +KEYBOARD_DRIVER(kbdmux, kbdmuxsw, kbdmux_configure); + +static int +kbdmux_modevent(module_t mod, int type, void *data) +{ + keyboard_switch_t *sw; + keyboard_t *kbd; + int error; + + switch (type) { + case MOD_LOAD: + if ((error = kbd_add_driver(&kbdmux_kbd_driver)) != 0) + break; + + if ((sw = kbd_get_switch(KEYBOARD_NAME)) == NULL) { + kbd_delete_driver(&kbdmux_kbd_driver); + error = ENXIO; + break; + } + + kbd = NULL; + + if ((error = (*sw->probe)(0, NULL, 0)) != 0 || + (error = (*sw->init)(0, &kbd, NULL, 0)) != 0) { + kbd_delete_driver(&kbdmux_kbd_driver); + break; + } + +#ifdef KBD_INSTALL_CDEV + if ((error = kbd_attach(kbd)) != 0) { + (*sw->term)(kbd); + kbd_delete_driver(&kbdmux_kbd_driver); + break; + } +#endif + + if ((error = (*sw->enable)(kbd)) != 0) { + (*sw->disable)(kbd); + kbd_detach(kbd); + (*sw->term)(kbd); + kbd_delete_driver(&kbdmux_kbd_driver); + break; + } + break; + + case MOD_UNLOAD: + if ((sw = kbd_get_switch(KEYBOARD_NAME)) == NULL) + panic("kbd_get_switch(" KEYBOARD_NAME ") == NULL"); + + kbd = kbd_get_keyboard(kbd_find_keyboard(KEYBOARD_NAME, 0)); + if (kbd == NULL) + panic("kbd_get_keyboard(kbd_find_keyboard(" KEYBOARD_NAME ", 0)) == NULL"); + + (*sw->disable)(kbd); +#ifdef KBD_INSTALL_CDEV + kbd_detach(kbd); +#endif + (*sw->term)(kbd); + kbd_delete_driver(&kbdmux_kbd_driver); + error = 0; + break; + + default: + error = EOPNOTSUPP; + break; + } + + return (0); +} + +DEV_MODULE(kbdmux, kbdmux_modevent, NULL); + -- cgit v1.1