Import 2.1.34

[davej-history.git] / drivers / sbus / char / sunkbd.c

/* keyboard.c: Sun keyboard driver.
 *
 * Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu)
 * Added vuid event generation and /dev/kbd device for SunOS
 * compatibility - Miguel (miguel@nuclecu.unam.mx)
 */

#include <linux/kernel.h>
#include <linux/sched.h>
#include <linux/tty.h>
#include <linux/tty_flip.h>
#include <linux/mm.h>
#include <linux/ptrace.h>
#include <linux/signal.h>
#include <linux/string.h>
#include <linux/fcntl.h>
#include <linux/poll.h>
#include <linux/random.h>
#include <linux/init.h>

#include <asm/kbio.h>
#include <asm/vuid_event.h>
#include <asm/delay.h>
#include <asm/bitops.h>
#include <asm/oplib.h>
#include <asm/uaccess.h>

#include"../../char/kbd_kern.h"
#include"../../char/diacr.h"
#include"../../char/vt_kern.h"

#define SIZE(x) (sizeof(x)/sizeof((x)[0]))

/* Define this one if you are making a new frame buffer driver */
/* it will not block the keyboard */
/* #define CODING_NEW_DRIVER */

/* KBD device number, temporal */
#define KBD_MAJOR 11

#define KBD_REPORT_ERR
#define KBD_REPORT_UNKN

#ifndef KBD_DEFMODE
#define KBD_DEFMODE ((1 << VC_REPEAT) | (1 << VC_META))
#endif

#ifndef KBD_DEFLEDS
/*
 * Some laptops take the 789uiojklm,. keys as number pad when NumLock
 * is on. This seems a good reason to start with NumLock off.
 */
#define KBD_DEFLEDS 0
#endif

#ifndef KBD_DEFLOCK
#define KBD_DEFLOCK 0
#endif

externvoidpoke_blanked_console(void);
externvoidctrl_alt_del(void);
externvoidreset_vc(unsigned int new_console);
externvoidscrollback(int);
externvoidscrollfront(int);

unsigned char kbd_read_mask =0x01;/* modified by psaux.c */
unsigned char aux_device_present =0x00;/* To make kernel/ksyms.c happy */

struct wait_queue * keypress_wait = NULL;

voidkeyboard_wait_for_keypress(void)
{
sleep_on(&keypress_wait);
}

/*
 * global state includes the following, and various static variables
 * in this module: prev_scancode, shift_state, diacr, npadch, dead_key_next.
 * (last_console is now a global variable)
 */

/* shift state counters.. */
static unsigned char k_down[NR_SHIFT] = {0, };
/* keyboard key bitmap */
#define BITS_PER_LONG (8*sizeof(unsigned long))
static unsigned long key_down[256/BITS_PER_LONG] = {0, };

voidpush_kbd(int scan);
int kbd_redirected =0;

static int dead_key_next =0;
/* 
 * In order to retrieve the shift_state (for the mouse server), either
 * the variable must be global, or a new procedure must be created to 
 * return the value. I chose the former way.
 */
/*static*/int shift_state =0;
static int npadch = -1;/* -1 or number assembled on pad */
static unsigned char diacr =0;
static char rep =0;/* flag telling character repeat */
struct kbd_struct kbd_table[MAX_NR_CONSOLES];
static struct tty_struct **ttytab;
static struct kbd_struct * kbd = kbd_table;
static struct tty_struct * tty = NULL;
static int compose_led_on =0;
static int kbd_delay_ticks = HZ /5;
static int kbd_rate_ticks = HZ /20;

externvoidcompute_shiftstate(void);

typedefvoid(*k_hand)(unsigned char value,char up_flag);
typedefvoid(k_handfn)(unsigned char value,char up_flag);

static k_handfn
 do_self, do_fn, do_spec, do_pad, do_dead, do_cons, do_cur, do_shift,
 do_meta, do_ascii, do_lock, do_lowercase, do_ignore;

static k_hand key_handler[16] = {
 do_self, do_fn, do_spec, do_pad, do_dead, do_cons, do_cur, do_shift,
 do_meta, do_ascii, do_lock, do_lowercase,
 do_ignore, do_ignore, do_ignore, do_ignore
};

typedefvoid(*void_fnp)(void);
typedefvoid(void_fn)(void);

static void_fn do_null, enter, show_ptregs, send_intr, lastcons, caps_toggle,
 num, hold, scroll_forw, scroll_back, boot_it, caps_on, compose,
 SAK, decr_console, incr_console, spawn_console, bare_num;

static void_fnp spec_fn_table[] = {
 do_null, enter, show_ptregs, show_mem,
 show_state, send_intr, lastcons, caps_toggle,
 num, hold, scroll_forw, scroll_back,
 boot_it, caps_on, compose, SAK,
 decr_console, incr_console, spawn_console, bare_num
};

/* maximum values each key_handler can handle */
const int max_vals[] = {
255,SIZE(func_table) -1,SIZE(spec_fn_table) -1, NR_PAD -1,
 NR_DEAD -1,255,3, NR_SHIFT -1,
255, NR_ASCII -1, NR_LOCK -1,255
};

const int NR_TYPES =SIZE(max_vals);

static voidput_queue(int);
static unsigned charhandle_diacr(unsigned char);

/* pt_regs - set by keyboard_interrupt(), used by show_ptregs() */
static struct pt_regs * pt_regs;

volatileunsigned char sunkbd_layout;
volatileunsigned char sunkbd_type;
#define SUNKBD_TYPE2 0x02
#define SUNKBD_TYPE3 0x03
#define SUNKBD_TYPE4 0x04

#define SUNKBD_LOUT_TYP4 0x00
#define SUNKBD_LOUT_TYP5_MASK 0x20

volatileint kbd_reset_pending;
volatileint kbd_layout_pending;

/* commands */
#define SKBDCMD_RESET 0x1
#define SKBDCMD_GLAYOUT 0xf
#define SKBDCMD_BELLON 0x2
#define SKBDCMD_BELLOFF 0x3
#define SKBDCMD_SETLED 0xe
#define SKBDCMD_NOCLICK 0xb
#define SKBDCMD_CLICK 0xa

static unsigned char sunkbd_clickp;

/* The led set commands require sending the SETLED byte then
 * a byte encoding which led's to have set. Here are the bit
 * values, a bit set = led-on.
 */
#define LED_NLOCK 0x1/* Num-lock */
#define LED_CMPOSE 0x2/* Compose */
#define LED_SCRLCK 0x4/* Scroll-lock */
#define LED_CLOCK 0x8/* Caps-lock */

/* Special state characters */
#define SKBD_RESET 0xff
#define SKBD_ALLUP 0x7f
#define SKBD_LYOUT 0xfe

/* On the Sparc the keyboard could be one of two things.
 * It could be a real keyboard speaking over one of the
 * channels of the second zs8530 chip (other channel is
 * used by the Sun mouse). Else we have serial console
 * going, and thus the other zs8530 chip is who we speak
 * to. Either way, we communicate through the zs8530
 * driver for all our I/O.
 */

#define SUNKBD_UBIT 0x80/* If set, key went up */
#define SUNKBD_KMASK 0x7f/* Other bits are the keycode */

#define KEY_LSHIFT 0x81
#define KEY_RSHIFT 0x82
#define KEY_CONTROL 0x83
#define KEY_NILL 0x84
#define KEY_CAPSLOCK 0x85
#define KEY_ALT 0x86
#define KEY_L1 0x87

externvoidkbd_put_char(unsigned char ch);
staticinlinevoidsend_cmd(unsigned char c)
{
kbd_put_char(c);
}

/* kbd_bh() calls this to send the SKBDCMD_SETLED to the sun keyboard
 * with the proper bit pattern for the leds to be set. It basically
 * converts the kbd->ledflagstate values to corresponding sun kbd led
 * bit value.
 */
staticinlineunsigned charvcleds_to_sunkbd(unsigned char vcleds)
{
unsigned char retval =0;

if(vcleds & (1<<VC_SCROLLOCK))
 retval |= LED_SCRLCK;
if(vcleds & (1<<VC_NUMLOCK))
 retval |= LED_NLOCK;
if(vcleds & (1<<VC_CAPSLOCK))
 retval |= LED_CLOCK;
if(compose_led_on)
 retval |= LED_CMPOSE;
return retval;
}

/*
 * Translation of escaped scancodes to keycodes.
 * This is now user-settable.
 * The keycodes 1-88,96-111,119 are fairly standard, and
 * should probably not be changed - changing might confuse X.
 * X also interprets scancode 0x5d (KEY_Begin).
 *
 * For 1-88 keycode equals scancode.
 */

#define E0_KPENTER 96
#define E0_RCTRL 97
#define E0_KPSLASH 98
#define E0_PRSCR 99
#define E0_RALT 100
#define E0_BREAK 101/* (control-pause) */
#define E0_HOME 102
#define E0_UP 103
#define E0_PGUP 104
#define E0_LEFT 105
#define E0_RIGHT 106
#define E0_END 107
#define E0_DOWN 108
#define E0_PGDN 109
#define E0_INS 110
#define E0_DEL 111

#define E1_PAUSE 119

/*
 * The keycodes below are randomly located in 89-95,112-118,120-127.
 * They could be thrown away (and all occurrences below replaced by 0),
 * but that would force many users to use the `setkeycodes' utility, where
 * they needed not before. It does not matter that there are duplicates, as
 * long as no duplication occurs for any single keyboard.
 */
#define SC_LIM 89

#define FOCUS_PF1 85/* actual code! */
#define FOCUS_PF2 89
#define FOCUS_PF3 90
#define FOCUS_PF4 91
#define FOCUS_PF5 92
#define FOCUS_PF6 93
#define FOCUS_PF7 94
#define FOCUS_PF8 95
#define FOCUS_PF9 120
#define FOCUS_PF10 121
#define FOCUS_PF11 122
#define FOCUS_PF12 123

#define JAP_86 124
/* tfj@olivia.ping.dk:
 * The four keys are located over the numeric keypad, and are
 * labelled A1-A4. It's an rc930 keyboard, from
 * Regnecentralen/RC International, Now ICL.
 * Scancodes: 59, 5a, 5b, 5c.
 */
#define RGN1 124
#define RGN2 125
#define RGN3 126
#define RGN4 127

static unsigned char high_keys[128- SC_LIM] = {
 RGN1, RGN2, RGN3, RGN4,0,0,0,/* 0x59-0x5f */
0,0,0,0,0,0,0,0,/* 0x60-0x67 */
0,0,0,0,0, FOCUS_PF11,0, FOCUS_PF12,/* 0x68-0x6f */
0,0,0, FOCUS_PF2, FOCUS_PF9,0,0, FOCUS_PF3,/* 0x70-0x77 */
 FOCUS_PF4, FOCUS_PF5, FOCUS_PF6, FOCUS_PF7,/* 0x78-0x7b */
 FOCUS_PF8, JAP_86, FOCUS_PF10,0/* 0x7c-0x7f */
};

/* BTC */
#define E0_MACRO 112
/* LK450 */
#define E0_F13 113
#define E0_F14 114
#define E0_HELP 115
#define E0_DO 116
#define E0_F17 117
#define E0_KPMINPLUS 118
/*
 * My OmniKey generates e0 4c for the "OMNI" key and the
 * right alt key does nada. [kkoller@nyx10.cs.du.edu]
 */
#define E0_OK 124
/*
 * New microsoft keyboard is rumoured to have
 * e0 5b (left window button), e0 5c (right window button),
 * e0 5d (menu button). [or: LBANNER, RBANNER, RMENU]
 * [or: Windows_L, Windows_R, TaskMan]
 */
#define E0_MSLW 125
#define E0_MSRW 126
#define E0_MSTM 127

static unsigned char e0_keys[128] = {
0,0,0,0,0,0,0,0,/* 0x00-0x07 */
0,0,0,0,0,0,0,0,/* 0x08-0x0f */
0,0,0,0,0,0,0,0,/* 0x10-0x17 */
0,0,0,0, E0_KPENTER, E0_RCTRL,0,0,/* 0x18-0x1f */
0,0,0,0,0,0,0,0,/* 0x20-0x27 */
0,0,0,0,0,0,0,0,/* 0x28-0x2f */
0,0,0,0,0, E0_KPSLASH,0, E0_PRSCR,/* 0x30-0x37 */
 E0_RALT,0,0,0,0, E0_F13, E0_F14, E0_HELP,/* 0x38-0x3f */
 E0_DO, E0_F17,0,0,0,0, E0_BREAK, E0_HOME,/* 0x40-0x47 */
 E0_UP, E0_PGUP,0, E0_LEFT, E0_OK, E0_RIGHT, E0_KPMINPLUS, E0_END,/* 0x48-0x4f */
 E0_DOWN, E0_PGDN, E0_INS, E0_DEL,0,0,0,0,/* 0x50-0x57 */
0,0,0, E0_MSLW, E0_MSRW, E0_MSTM,0,0,/* 0x58-0x5f */
0,0,0,0,0,0,0,0,/* 0x60-0x67 */
0,0,0,0,0,0,0, E0_MACRO,/* 0x68-0x6f */
0,0,0,0,0,0,0,0,/* 0x70-0x77 */
0,0,0,0,0,0,0,0/* 0x78-0x7f */
};

/* we use this map to determine if a particular key should not be
 autorepeated. We don't autorepeat CONTROL, LSHIFT, CAPS,
 ALT, LMETA, RSHIFT, RMETA, ALTG and COMPOSE */
static unsigned char norepeat_keys[128] = {
0,0,0,0,0,0,0,0,0,0,0,0,0,1,0,0,/* 0x00-0x0f */
0,0,0,1,0,0,0,0,0,0,0,0,0,0,0,0,/* 0x10-0x1f */
0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,/* 0x20-0x2f */
0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,/* 0x30-0x3f */
0,0,0,1,0,0,0,0,0,0,0,0,1,0,0,0,/* 0x40-0x4f */
0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,/* 0x50-0x5f */
0,0,0,1,0,0,0,0,0,0,0,0,0,0,1,0,/* 0x60-0x6f */
0,0,0,0,0,0,0,1,1,0,1,0,0,0,0,0,/* 0x70-0x7f */
};


intsetkeycode(unsigned int scancode,unsigned int keycode)
{
if(scancode < SC_LIM || scancode >255|| keycode >127)
return-EINVAL;
if(scancode <128)
 high_keys[scancode - SC_LIM] = keycode;
else
 e0_keys[scancode -128] = keycode;
return0;
}

intgetkeycode(unsigned int scancode)
{
return
(scancode < SC_LIM || scancode >255) ? -EINVAL :
(scancode <128) ? high_keys[scancode - SC_LIM] :
 e0_keys[scancode -128];
}

voidsunkbd_inchar(unsigned char ch,struct pt_regs *regs);
static voidkeyboard_timer(unsigned long ignored);

static struct timer_list
auto_repeat_timer = { NULL, NULL,0,0, keyboard_timer };

/* Keeps track of the last pressed key */
static unsigned char last_keycode;

static void
keyboard_timer(unsigned long ignored)
{
unsigned long flags;

save_flags(flags);cli();

/* Auto repeat: send regs = 0 to indicate autorepeat */
sunkbd_inchar(last_keycode,0);
del_timer(&auto_repeat_timer);
if(kbd_rate_ticks) {
 auto_repeat_timer.expires = jiffies + kbd_rate_ticks;
add_timer(&auto_repeat_timer);
}
restore_flags(flags);
}

/* #define SKBD_DEBUG */
/* This is our keyboard 'interrupt' routine. */
voidsunkbd_inchar(unsigned char ch,struct pt_regs *regs)
{
unsigned char keycode;
char up_flag;/* 0 or SUNKBD_UBIT */
char raw_mode;

if(ch == SKBD_RESET) {
 kbd_reset_pending =1;
return;
}
if(ch == SKBD_LYOUT) {
 kbd_layout_pending =1;
return;
}
if(kbd_reset_pending) {
 sunkbd_type = ch;
 kbd_reset_pending =0;
if(ch == SUNKBD_TYPE4)
send_cmd(SKBDCMD_GLAYOUT);
return;
}else if(kbd_layout_pending) {
 sunkbd_layout = ch;
 kbd_layout_pending =0;
return;
}else if(ch == SKBD_ALLUP) {
del_timer(&auto_repeat_timer);
memset(key_down,0,sizeof(key_down));
compute_shiftstate();
return;
}
#ifdef SKBD_DEBUG
if(ch ==0x7f)
printk("KBD<ALL KEYS UP>");
else
printk("KBD<%x %s>", ch,
((ch&0x80) ?"UP":"DOWN"));
#endif

/* Whee, a real character. */
if(regs) {
 pt_regs = regs;
 last_keycode = keycode = ch;
}else{
 keycode = ch;
}
add_keyboard_randomness(keycode);

mark_bh(KEYBOARD_BH);
 do_poke_blanked_console =1;
mark_bh(CONSOLE_BH);
 kbd = kbd_table + fg_console;
 tty = ttytab[fg_console];
if((raw_mode = (kbd->kbdmode == VC_RAW))) {
if(kbd_redirected == fg_console+1)
push_kbd(keycode);
else
put_queue(keycode);
/* we do not return yet, because we want to maintain
 * the key_down array, so that we have the correct
 * values when finishing RAW mode or when changing VT's.
 */
}
 up_flag = (keycode & SUNKBD_UBIT);/* The 'up' bit */
 keycode &= SUNKBD_KMASK;/* all the rest */
del_timer(&auto_repeat_timer);
if(up_flag) {
 rep =0;
clear_bit(keycode, key_down);
}else{
if(!norepeat_keys[keycode]) {
if(kbd_rate_ticks) {
 auto_repeat_timer.expires =
 jiffies + kbd_delay_ticks;
add_timer(&auto_repeat_timer);
}
}
 rep =set_bit(keycode, key_down);
}

if(raw_mode)
return;

if(kbd->kbdmode == VC_MEDIUMRAW) {
put_queue(keycode + up_flag);
return;
}

/*
 * Small change in philosophy: earlier we defined repetition by
 * rep = keycode == prev_keycode;
 * prev_keycode = keycode;
 * but now by the fact that the depressed key was down already.
 * Does this ever make a difference? Yes.
 */

/*
 * Repeat a key only if the input buffers are empty or the
 * characters get echoed locally. This makes key repeat usable
 * with slow applications and under heavy loads.
 */
if(!rep ||
(vc_kbd_mode(kbd,VC_REPEAT) && tty &&
(L_ECHO(tty) || (tty->driver.chars_in_buffer(tty) ==0)))) {
 u_short keysym;
 u_char type;

/* the XOR below used to be an OR */
int shift_final = shift_state ^ kbd->lockstate;
 ushort *key_map = key_maps[shift_final];

if(key_map != NULL) {
 keysym = key_map[keycode];
 type =KTYP(keysym);

if(type >=0xf0) {
 type -=0xf0;
if(type == KT_LETTER) {
 type = KT_LATIN;
if(vc_kbd_led(kbd, VC_CAPSLOCK)) {
 key_map = key_maps[shift_final ^ (1<<KG_SHIFT)];
if(key_map)
 keysym = key_map[keycode];
}
}
(*key_handler[type])(keysym &0xff, up_flag);
if(type != KT_SLOCK)
 kbd->slockstate =0;
}
}else{
/* maybe beep? */
/* we have at least to update shift_state */
compute_shiftstate();
}
}
}

static voidput_queue(int ch)
{
wake_up(&keypress_wait);
if(tty) {
tty_insert_flip_char(tty, ch,0);
tty_schedule_flip(tty);
}
}

static voidputs_queue(char*cp)
{
wake_up(&keypress_wait);
if(!tty)
return;

while(*cp) {
tty_insert_flip_char(tty, *cp,0);
 cp++;
}
tty_schedule_flip(tty);
}

static voidapplkey(int key,char mode)
{
static char buf[] = {0x1b,'O',0x00,0x00};

 buf[1] = (mode ?'O':'[');
 buf[2] = key;
puts_queue(buf);
}

static voidenter(void)
{
put_queue(13);
if(vc_kbd_mode(kbd,VC_CRLF))
put_queue(10);
}

static voidcaps_toggle(void)
{
if(rep)
return;
chg_vc_kbd_led(kbd, VC_CAPSLOCK);
}

static voidcaps_on(void)
{
if(rep)
return;
set_vc_kbd_led(kbd, VC_CAPSLOCK);
}

static voidshow_ptregs(void)
{
if(pt_regs)
show_regs(pt_regs);
}

static voidhold(void)
{
if(rep || !tty)
return;

/*
 * Note: SCROLLOCK will be set (cleared) by stop_tty (start_tty);
 * these routines are also activated by ^S/^Q.
 * (And SCROLLOCK can also be set by the ioctl KDSKBLED.)
 */
if(tty->stopped)
start_tty(tty);
else
stop_tty(tty);
}

static voidnum(void)
{
if(vc_kbd_mode(kbd,VC_APPLIC))
applkey('P',1);
else
bare_num();
}

/*
 * Bind this to Shift-NumLock if you work in application keypad mode
 * but want to be able to change the NumLock flag.
 * Bind this to NumLock if you prefer that the NumLock key always
 * changes the NumLock flag.
 */
static voidbare_num(void)
{
if(!rep)
chg_vc_kbd_led(kbd,VC_NUMLOCK);
}

static voidlastcons(void)
{
/* switch to the last used console, ChN */
set_console(last_console);
}

static voiddecr_console(void)
{
int i;

for(i = fg_console-1; i != fg_console; i--) {
if(i == -1)
 i = MAX_NR_CONSOLES-1;
if(vc_cons_allocated(i))
break;
}
set_console(i);
}

static voidincr_console(void)
{
int i;

for(i = fg_console+1; i != fg_console; i++) {
if(i == MAX_NR_CONSOLES)
 i =0;
if(vc_cons_allocated(i))
break;
}
set_console(i);
}

static voidsend_intr(void)
{
if(!tty)
return;
tty_insert_flip_char(tty,0, TTY_BREAK);
tty_schedule_flip(tty);
}

static voidscroll_forw(void)
{
scrollfront(0);
}

static voidscroll_back(void)
{
scrollback(0);
}

static voidboot_it(void)
{
externintobp_system_intr(void);

if(!obp_system_intr())
ctrl_alt_del();
/* sigh.. attempt to prevent multiple entry */
 last_keycode=1;
 rep =0;
}

static voidcompose(void)
{
 dead_key_next =1;
 compose_led_on =1;
set_leds();
}

int spawnpid, spawnsig;

static voidspawn_console(void)
{
if(spawnpid)
if(kill_proc(spawnpid, spawnsig,1))
 spawnpid =0;
}

static voidSAK(void)
{
do_SAK(tty);
#if 0
/*
 * Need to fix SAK handling to fix up RAW/MEDIUM_RAW and
 * vt_cons modes before we can enable RAW/MEDIUM_RAW SAK
 * handling.
 * 
 * We should do this some day --- the whole point of a secure
 * attention key is that it should be guaranteed to always
 * work.
 */
reset_vc(fg_console);
do_unblank_screen();/* not in interrupt routine? */
#endif
}

static voiddo_ignore(unsigned char value,char up_flag)
{
}

static voiddo_null()
{
compute_shiftstate();
}

static voiddo_spec(unsigned char value,char up_flag)
{
if(up_flag)
return;
if(value >=SIZE(spec_fn_table))
return;
 spec_fn_table[value]();
}

static voiddo_lowercase(unsigned char value,char up_flag)
{
printk("keyboard.c: do_lowercase was called - impossible\n");
}

static voiddo_self(unsigned char value,char up_flag)
{
if(up_flag)
return;/* no action, if this is a key release */

if(diacr) {
 value =handle_diacr(value);
 compose_led_on =0;
set_leds();
}

if(dead_key_next) {
 dead_key_next =0;
 diacr = value;
return;
}

put_queue(value);
}

#define A_GRAVE'`'
#define A_ACUTE'\''
#define A_CFLEX'^'
#define A_TILDE'~'
#define A_DIAER'"'
#define A_CEDIL','
static unsigned char ret_diacr[NR_DEAD] =
{A_GRAVE, A_ACUTE, A_CFLEX, A_TILDE, A_DIAER, A_CEDIL };

/* If a dead key pressed twice, output a character corresponding to it, */
/* otherwise just remember the dead key. */

static voiddo_dead(unsigned char value,char up_flag)
{
if(up_flag)
return;

 value = ret_diacr[value];
if(diacr == value) {/* pressed twice */
 diacr =0;
put_queue(value);
return;
}
 diacr = value;
}


/* If space is pressed, return the character corresponding the pending */
/* dead key, otherwise try to combine the two. */

unsigned charhandle_diacr(unsigned char ch)
{
int d = diacr;
int i;

 diacr =0;
if(ch ==' ')
return d;

for(i =0; i < accent_table_size; i++) {
if(accent_table[i].diacr == d && accent_table[i].base == ch)
return accent_table[i].result;
}

put_queue(d);
return ch;
}

static voiddo_cons(unsigned char value,char up_flag)
{
if(up_flag)
return;
set_console(value);
}

static voiddo_fn(unsigned char value,char up_flag)
{
if(up_flag)
return;
if(value <SIZE(func_table)) {
if(func_table[value])
puts_queue(func_table[value]);
}else
printk("do_fn called with value=%d\n", value);
}

static voiddo_pad(unsigned char value,char up_flag)
{
static const char*pad_chars ="0123456789+-*/\015,.?";
static const char*app_map ="pqrstuvwxylSRQMnn?";

if(up_flag)
return;/* no action, if this is a key release */

/* kludge... shift forces cursor/number keys */
if(vc_kbd_mode(kbd,VC_APPLIC) && !k_down[KG_SHIFT]) {
applkey(app_map[value],1);
return;
}

if(!vc_kbd_led(kbd,VC_NUMLOCK))
switch(value) {
caseKVAL(K_PCOMMA):
caseKVAL(K_PDOT):
do_fn(KVAL(K_REMOVE),0);
return;
caseKVAL(K_P0):
do_fn(KVAL(K_INSERT),0);
return;
caseKVAL(K_P1):
do_fn(KVAL(K_SELECT),0);
return;
caseKVAL(K_P2):
do_cur(KVAL(K_DOWN),0);
return;
caseKVAL(K_P3):
do_fn(KVAL(K_PGDN),0);
return;
caseKVAL(K_P4):
do_cur(KVAL(K_LEFT),0);
return;
caseKVAL(K_P6):
do_cur(KVAL(K_RIGHT),0);
return;
caseKVAL(K_P7):
do_fn(KVAL(K_FIND),0);
return;
caseKVAL(K_P8):
do_cur(KVAL(K_UP),0);
return;
caseKVAL(K_P9):
do_fn(KVAL(K_PGUP),0);
return;
caseKVAL(K_P5):
applkey('G',vc_kbd_mode(kbd, VC_APPLIC));
return;
}

put_queue(pad_chars[value]);
if(value ==KVAL(K_PENTER) &&vc_kbd_mode(kbd, VC_CRLF))
put_queue(10);
}

static voiddo_cur(unsigned char value,char up_flag)
{
static const char*cur_chars ="BDCA";
if(up_flag)
return;

applkey(cur_chars[value],vc_kbd_mode(kbd,VC_CKMODE));
}

static voiddo_shift(unsigned char value,char up_flag)
{
int old_state = shift_state;

if(rep)
return;

/* Mimic typewriter:
 a CapsShift key acts like Shift but undoes CapsLock */
if(value ==KVAL(K_CAPSSHIFT)) {
 value =KVAL(K_SHIFT);
if(!up_flag)
clr_vc_kbd_led(kbd, VC_CAPSLOCK);
}

if(up_flag) {
/* handle the case that two shift or control
 keys are depressed simultaneously */
if(k_down[value])
 k_down[value]--;
}else
 k_down[value]++;

if(k_down[value])
 shift_state |= (1<< value);
else
 shift_state &= ~ (1<< value);

/* kludge, no joke... */
if(up_flag && shift_state != old_state && npadch != -1) {
put_queue(npadch &0xff);
 npadch = -1;
}
}

/* called after returning from RAW mode or when changing consoles -
 recompute k_down[] and shift_state from key_down[] */
/* maybe called when keymap is undefined, so that shiftkey release is seen */
voidcompute_shiftstate(void)
{
int i, j, k, sym, val;

 shift_state =0;
for(i=0; i <SIZE(k_down); i++)
 k_down[i] =0;

for(i=0; i <SIZE(key_down); i++)
if(key_down[i]) {/* skip this word if not a single bit on */
 k = i*BITS_PER_LONG;
for(j=0; j<BITS_PER_LONG; j++,k++)
if(test_bit(k, key_down)) {
 sym =U(plain_map[k]);
if(KTYP(sym) == KT_SHIFT) {
 val =KVAL(sym);
if(val ==KVAL(K_CAPSSHIFT))
 val =KVAL(K_SHIFT);
 k_down[val]++;
 shift_state |= (1<<val);
}
}
}
}

static voiddo_meta(unsigned char value,char up_flag)
{
if(up_flag)
return;

if(vc_kbd_mode(kbd, VC_META)) {
put_queue('\033');
put_queue(value);
}else
put_queue(value |0x80);
}

static voiddo_ascii(unsigned char value,char up_flag)
{
int base;

if(up_flag)
return;

if(value <10)/* decimal input of code, while Alt depressed */
 base =10;
else{/* hexadecimal input of code, while AltGr depressed */
 value -=10;
 base =16;
}

if(npadch == -1)
 npadch = value;
else
 npadch = npadch * base + value;
}

static voiddo_lock(unsigned char value,char up_flag)
{
if(up_flag || rep)
return;
chg_vc_kbd_lock(kbd, value);
}

/*
 * The leds display either (i) the status of NumLock, CapsLock, ScrollLock,
 * or (ii) whatever pattern of lights people want to show using KDSETLED,
 * or (iii) specified bits of specified words in kernel memory.
 */

static unsigned char ledstate =0xff;/* undefined */
static unsigned char sunkbd_ledstate =0xff;/* undefined */
static unsigned char ledioctl;

unsigned chargetledstate(void) {
return ledstate;
}

voidsetledstate(struct kbd_struct *kbd,unsigned int led) {
if(!(led & ~7)) {
 ledioctl = led;
 kbd->ledmode = LED_SHOW_IOCTL;
}else
 kbd->ledmode = LED_SHOW_FLAGS;
set_leds();
}

static struct ledptr {
unsigned int*addr;
unsigned int mask;
unsigned char valid:1;
} ledptrs[3];

voidregister_leds(int console,unsigned int led,
unsigned int*addr,unsigned int mask) {
struct kbd_struct *kbd = kbd_table + console;
if(led <3) {
 ledptrs[led].addr = addr;
 ledptrs[led].mask = mask;
 ledptrs[led].valid =1;
 kbd->ledmode = LED_SHOW_MEM;
}else
 kbd->ledmode = LED_SHOW_FLAGS;
}

staticinlineunsigned chargetleds(void){
struct kbd_struct *kbd = kbd_table + fg_console;
unsigned char leds;

if(kbd->ledmode == LED_SHOW_IOCTL)
return ledioctl;
 leds = kbd->ledflagstate;
if(kbd->ledmode == LED_SHOW_MEM) {
if(ledptrs[0].valid) {
if(*ledptrs[0].addr & ledptrs[0].mask)
 leds |=1;
else
 leds &= ~1;
}
if(ledptrs[1].valid) {
if(*ledptrs[1].addr & ledptrs[1].mask)
 leds |=2;
else
 leds &= ~2;
}
if(ledptrs[2].valid) {
if(*ledptrs[2].addr & ledptrs[2].mask)
 leds |=4;
else
 leds &= ~4;
}
}
return leds;
}

/*
 * This routine is the bottom half of the keyboard interrupt
 * routine, and runs with all interrupts enabled. It does
 * console changing, led setting and copy_to_cooked, which can
 * take a reasonably long time.
 *
 * Aside from timing (which isn't really that important for
 * keyboard interrupts as they happen often), using the software
 * interrupt routines for this thing allows us to easily mask
 * this when we don't want any of the above to happen. Not yet
 * used, but this allows for easy and efficient race-condition
 * prevention later on.
 */
static voidkbd_bh(void)
{
unsigned char leds =getleds();
unsigned char kbd_leds =vcleds_to_sunkbd(leds);

if(kbd_leds != sunkbd_ledstate) {
 ledstate = leds;
 sunkbd_ledstate = kbd_leds;
send_cmd(SKBDCMD_SETLED);
send_cmd(kbd_leds);
}
}

/* Support for keyboard "beeps". */

/* Timer routine to turn off the beep after the interval expires. */
static voidsunkbd_kd_nosound(unsigned long __unused)
{
send_cmd(SKBDCMD_BELLOFF);
}

/*
 * Initiate a keyboard beep. If the frequency is zero, then we stop
 * the beep. Any other frequency will start a monotone beep. The beep
 * will be stopped by a timer after "ticks" jiffies. If ticks is 0,
 * then we do not start a timer.
 */
static voidsunkbd_kd_mksound(unsigned int hz,unsigned int ticks)
{
unsigned long flags;
static struct timer_list sound_timer = { NULL, NULL,0,0,
 sunkbd_kd_nosound };

save_flags(flags);
cli();

del_timer(&sound_timer);

if(hz) {
send_cmd(SKBDCMD_BELLON);
if(ticks) {
 sound_timer.expires = jiffies + ticks;
add_timer(&sound_timer);
}
}else
send_cmd(SKBDCMD_BELLOFF);

restore_flags(flags);
}

externvoid(*kd_mksound)(unsigned int hz,unsigned int ticks);

intkbd_init(void)
{
int i, opt_node;
struct kbd_struct kbd0;
externstruct tty_driver console_driver;

 kbd0.ledflagstate = kbd0.default_ledflagstate = KBD_DEFLEDS;
 kbd0.ledmode = LED_SHOW_FLAGS;
 kbd0.lockstate = KBD_DEFLOCK;
 kbd0.modeflags = KBD_DEFMODE;
 kbd0.kbdmode = VC_XLATE;

for(i =0; i < MAX_NR_CONSOLES ; i++)
 kbd_table[i] = kbd0;

 ttytab = console_driver.table;

 kd_mksound = sunkbd_kd_mksound;

/* XXX Check keyboard-click? property in 'options' PROM node XXX */
if(sparc_cpu_model != sun4) {
 opt_node =prom_getchild(prom_root_node);
 opt_node =prom_searchsiblings(opt_node,"options");
 i =prom_getintdefault(opt_node,"keyboard-click?", -1);
if(i != -1)
 sunkbd_clickp =1;
else
 sunkbd_clickp =0;
}else{
 sunkbd_clickp =0;
}
init_bh(KEYBOARD_BH, kbd_bh);
mark_bh(KEYBOARD_BH);
return0;
}

/* /dev/kbd support */

#define KBD_QSIZE 32
static Firm_event kbd_queue [KBD_QSIZE];
static int kbd_head, kbd_tail;
char kbd_opened;
static int kbd_active =0;
static struct wait_queue *kbd_wait;
static struct fasync_struct *kb_fasync;

void
push_kbd(int scan)
{
int next = (kbd_head +1) % KBD_QSIZE;

if(scan == KBD_IDLE)
return;
if(next != kbd_tail){
 kbd_queue [kbd_head].id = scan & KBD_KEYMASK;
 kbd_queue [kbd_head].value=scan & KBD_UP ? VKEY_UP : VKEY_DOWN;
 kbd_queue [kbd_head].time = xtime;
 kbd_head = next;
}
if(kb_fasync)
kill_fasync(kb_fasync, SIGIO);
wake_up_interruptible(&kbd_wait);
}

static long
kbd_read(struct inode *inode,struct file *f,char*buffer,unsigned long count)
{
struct wait_queue wait = { current, NULL };
char*end, *p;

/* Return EWOULDBLOCK, because this is what the X server expects */
if(kbd_head == kbd_tail){
if(f->f_flags & O_NONBLOCK)
return-EWOULDBLOCK;
add_wait_queue(&kbd_wait, &wait);
while(kbd_head == kbd_tail && !(current->signal & ~current->blocked)){
 current->state = TASK_INTERRUPTIBLE;
schedule();
}
 current->state = TASK_RUNNING;
remove_wait_queue(&kbd_wait, &wait);
}
/* There is data in the keyboard, fill the user buffer */
 end = buffer+count;
 p = buffer;
for(; p < end && kbd_head != kbd_tail; p +=sizeof(Firm_event)){
copy_to_user_ret((Firm_event *)p, &kbd_queue [kbd_tail],sizeof(Firm_event), -EFAULT);
#ifdef KBD_DEBUG
printk("[%s]", kbd_queue [kbd_tail].value == VKEY_UP ?"UP":"DOWN");
#endif
 kbd_tail++;
 kbd_tail %= KBD_QSIZE;
}
return p-buffer;
}

/* Needed by X */
static int
kbd_fasync(struct inode *inode,struct file *filp,int on)
{
int retval;

 retval =fasync_helper(inode, filp, on, &kb_fasync);
if(retval <0)
return retval;
return0;
}

static unsigned intkbd_poll(struct file *f, poll_table *wait)
{
poll_wait(&kbd_wait, wait);
if(kbd_head != kbd_tail)
return POLLIN | POLLRDNORM;
return0;
}

static int
kbd_ioctl(struct inode *i,struct file *f,unsigned int cmd,unsigned long arg)
{
unsigned char c;
unsigned char leds =0;
int value;

switch(cmd){
case KIOCTYPE:/* return keyboard type */
put_user_ret(sunkbd_type, (int*) arg, -EFAULT);
break;
case KIOCGTRANS:
put_user_ret(TR_UNTRANS_EVENT, (int*) arg, -EFAULT);
break;
case KIOCTRANS:
get_user_ret(value, (int*) arg, -EFAULT);
if(value != TR_UNTRANS_EVENT)
return-EINVAL;
break;
case KIOCLAYOUT:
put_user_ret(sunkbd_layout, (int*) arg, -EFAULT);
break;
case KIOCSDIRECT:
#ifndef CODING_NEW_DRIVER
get_user_ret(value, (int*) arg, -EFAULT);
if(value)
 kbd_redirected = fg_console +1;
else
 kbd_redirected =0;
 kbd_table [fg_console].kbdmode = kbd_redirected ? VC_RAW : VC_XLATE;
#endif
break;
case KIOCCMD:
get_user_ret(value, (int*) arg, -EFAULT);
 c = (unsigned char) value;
switch(c) {
case SKBDCMD_CLICK:
case SKBDCMD_NOCLICK:
send_cmd(c);
return0;
case SKBDCMD_BELLON:
kd_mksound(1,0);
return0;
case SKBDCMD_BELLOFF:
kd_mksound(0,0);
return0;
default:
return-EINVAL;
}
case KIOCSLED:
get_user_ret(c, (unsigned char*) arg, -EFAULT);

if(c & LED_SCRLCK) leds |= (1<< VC_SCROLLOCK);
if(c & LED_NLOCK) leds |= (1<< VC_NUMLOCK);
if(c & LED_CLOCK) leds |= (1<< VC_CAPSLOCK);
 compose_led_on = !!(c & LED_CMPOSE);
setledstate(kbd_table + fg_console, leds);
break;
case KIOCGLED:
put_user_ret(vcleds_to_sunkbd(getleds()), (unsigned char*) arg, -EFAULT);
break;
case KIOCGRATE:
{
struct kbd_rate rate;

 rate.delay = kbd_delay_ticks;
if(kbd_rate_ticks)
 rate.rate = HZ / kbd_rate_ticks;
else
 rate.rate =0;

copy_to_user_ret((struct kbd_rate *)arg, &rate,
sizeof(struct kbd_rate), -EFAULT);

return0;
}
case KIOCSRATE:
{
struct kbd_rate rate;

if(verify_area(VERIFY_READ, (void*)arg,
sizeof(struct kbd_rate)))
return-EFAULT;
copy_from_user(&rate, (struct kbd_rate *)arg,
sizeof(struct kbd_rate));

if(rate.rate >50)
return-EINVAL;
if(rate.rate ==0)
 kbd_rate_ticks =0;
else
 kbd_rate_ticks = HZ / rate.rate;
 kbd_delay_ticks = rate.delay;

return0;
}
case FIONREAD:/* return number of bytes in kbd queue */
{
int count;

 count = kbd_head - kbd_tail;
put_user_ret((count <0) ? KBD_QSIZE - count : count, (int*) arg, -EFAULT);
return0;
}
default:
printk("Unknown Keyboard ioctl: %8.8x\n", cmd);
return-EINVAL;
}
return0;
}

static int
kbd_open(struct inode *i,struct file *f)
{
 kbd_active++;

if(kbd_opened)
return0;

 kbd_opened = fg_console +1;
 kbd_head = kbd_tail =0;
return0;
}

static int
kbd_close(struct inode *i,struct file *f)
{
if(--kbd_active)
return0;

if(kbd_redirected)
 kbd_table [kbd_opened-1].kbdmode = VC_XLATE;

 kbd_redirected =0;
 kbd_opened =0;

kbd_fasync(i, f,0);
return0;
}

static struct
file_operations kbd_fops =
{
 NULL,/* seek */
 kbd_read,/* read */
 NULL,/* write */
 NULL,/* readdir */
 kbd_poll,/* poll */
 kbd_ioctl,/* ioctl */
 NULL,/* mmap */
 kbd_open,/* open */
 kbd_close,/* close */
 NULL,/* fsync */
 kbd_fasync,/* fasync */
 NULL,/* check_media_change */
 NULL,/* revalidate */
};

__initfunc(voidkeyboard_zsinit(void))
{
int timeout =0;

/* Test out the leds */
 sunkbd_type =255;
send_cmd(SKBDCMD_RESET);
while((sunkbd_type==255) && timeout <500000) {
udelay(100);
 timeout +=20;
}

if(timeout>=500000) {
printk("keyboard: not present\n");
return;
}

if(sunkbd_type != SUNKBD_TYPE4) {
printk("Sun TYPE %d keyboard detected ", sunkbd_type);
}else{
udelay(200);
 timeout=0;
while(timeout++ <500000)
barrier();
printk("Sun TYPE %d keyboard detected ",
((sunkbd_layout & SUNKBD_LOUT_TYP5_MASK) ?5:4));
}
if(sunkbd_type == SUNKBD_TYPE2)
 sunkbd_clickp =0;

if(sunkbd_clickp) {
send_cmd(SKBDCMD_CLICK);
printk("with keyclick\n");
}else{
send_cmd(SKBDCMD_NOCLICK);
printk("without keyclick\n");
}

/* Dork with led lights, then turn them all off */
send_cmd(SKBDCMD_SETLED);send_cmd(0xf);/* All on */
send_cmd(SKBDCMD_SETLED);send_cmd(0x0);/* All off */

/* Register the /dev/kbd interface */
if(register_chrdev(KBD_MAJOR,"kbd", &kbd_fops)){
printk("Could not register /dev/kbd device\n");
return;
}
return;
}