264 строки
5.5 KiB
C
264 строки
5.5 KiB
C
/*
|
|
* Kernel Debugger Architecture Dependent Console I/O handler
|
|
*
|
|
* This file is subject to the terms and conditions of the GNU General Public
|
|
* License.
|
|
*
|
|
* Copyright (c) 1999-2006 Silicon Graphics, Inc. All Rights Reserved.
|
|
* Copyright (c) 2009 Wind River Systems, Inc. All Rights Reserved.
|
|
*/
|
|
|
|
#include <linux/kdb.h>
|
|
#include <linux/keyboard.h>
|
|
#include <linux/ctype.h>
|
|
#include <linux/module.h>
|
|
#include <linux/io.h>
|
|
|
|
/* Keyboard Controller Registers on normal PCs. */
|
|
|
|
#define KBD_STATUS_REG 0x64 /* Status register (R) */
|
|
#define KBD_DATA_REG 0x60 /* Keyboard data register (R/W) */
|
|
|
|
/* Status Register Bits */
|
|
|
|
#define KBD_STAT_OBF 0x01 /* Keyboard output buffer full */
|
|
#define KBD_STAT_MOUSE_OBF 0x20 /* Mouse output buffer full */
|
|
|
|
static int kbd_exists;
|
|
static int kbd_last_ret;
|
|
|
|
/*
|
|
* Check if the keyboard controller has a keypress for us.
|
|
* Some parts (Enter Release, LED change) are still blocking polled here,
|
|
* but hopefully they are all short.
|
|
*/
|
|
int kdb_get_kbd_char(void)
|
|
{
|
|
int scancode, scanstatus;
|
|
static int shift_lock; /* CAPS LOCK state (0-off, 1-on) */
|
|
static int shift_key; /* Shift next keypress */
|
|
static int ctrl_key;
|
|
u_short keychar;
|
|
|
|
if (KDB_FLAG(NO_I8042) || KDB_FLAG(NO_VT_CONSOLE) ||
|
|
(inb(KBD_STATUS_REG) == 0xff && inb(KBD_DATA_REG) == 0xff)) {
|
|
kbd_exists = 0;
|
|
return -1;
|
|
}
|
|
kbd_exists = 1;
|
|
|
|
if ((inb(KBD_STATUS_REG) & KBD_STAT_OBF) == 0)
|
|
return -1;
|
|
|
|
/*
|
|
* Fetch the scancode
|
|
*/
|
|
scancode = inb(KBD_DATA_REG);
|
|
scanstatus = inb(KBD_STATUS_REG);
|
|
|
|
/*
|
|
* Ignore mouse events.
|
|
*/
|
|
if (scanstatus & KBD_STAT_MOUSE_OBF)
|
|
return -1;
|
|
|
|
/*
|
|
* Ignore release, trigger on make
|
|
* (except for shift keys, where we want to
|
|
* keep the shift state so long as the key is
|
|
* held down).
|
|
*/
|
|
|
|
if (((scancode&0x7f) == 0x2a) || ((scancode&0x7f) == 0x36)) {
|
|
/*
|
|
* Next key may use shift table
|
|
*/
|
|
if ((scancode & 0x80) == 0)
|
|
shift_key = 1;
|
|
else
|
|
shift_key = 0;
|
|
return -1;
|
|
}
|
|
|
|
if ((scancode&0x7f) == 0x1d) {
|
|
/*
|
|
* Left ctrl key
|
|
*/
|
|
if ((scancode & 0x80) == 0)
|
|
ctrl_key = 1;
|
|
else
|
|
ctrl_key = 0;
|
|
return -1;
|
|
}
|
|
|
|
if ((scancode & 0x80) != 0) {
|
|
if (scancode == 0x9c)
|
|
kbd_last_ret = 0;
|
|
return -1;
|
|
}
|
|
|
|
scancode &= 0x7f;
|
|
|
|
/*
|
|
* Translate scancode
|
|
*/
|
|
|
|
if (scancode == 0x3a) {
|
|
/*
|
|
* Toggle caps lock
|
|
*/
|
|
shift_lock ^= 1;
|
|
|
|
#ifdef KDB_BLINK_LED
|
|
kdb_toggleled(0x4);
|
|
#endif
|
|
return -1;
|
|
}
|
|
|
|
if (scancode == 0x0e) {
|
|
/*
|
|
* Backspace
|
|
*/
|
|
return 8;
|
|
}
|
|
|
|
/* Special Key */
|
|
switch (scancode) {
|
|
case 0xF: /* Tab */
|
|
return 9;
|
|
case 0x53: /* Del */
|
|
return 4;
|
|
case 0x47: /* Home */
|
|
return 1;
|
|
case 0x4F: /* End */
|
|
return 5;
|
|
case 0x4B: /* Left */
|
|
return 2;
|
|
case 0x48: /* Up */
|
|
return 16;
|
|
case 0x50: /* Down */
|
|
return 14;
|
|
case 0x4D: /* Right */
|
|
return 6;
|
|
}
|
|
|
|
if (scancode == 0xe0)
|
|
return -1;
|
|
|
|
/*
|
|
* For Japanese 86/106 keyboards
|
|
* See comment in drivers/char/pc_keyb.c.
|
|
* - Masahiro Adegawa
|
|
*/
|
|
if (scancode == 0x73)
|
|
scancode = 0x59;
|
|
else if (scancode == 0x7d)
|
|
scancode = 0x7c;
|
|
|
|
if (!shift_lock && !shift_key && !ctrl_key) {
|
|
keychar = plain_map[scancode];
|
|
} else if ((shift_lock || shift_key) && key_maps[1]) {
|
|
keychar = key_maps[1][scancode];
|
|
} else if (ctrl_key && key_maps[4]) {
|
|
keychar = key_maps[4][scancode];
|
|
} else {
|
|
keychar = 0x0020;
|
|
kdb_printf("Unknown state/scancode (%d)\n", scancode);
|
|
}
|
|
keychar &= 0x0fff;
|
|
if (keychar == '\t')
|
|
keychar = ' ';
|
|
switch (KTYP(keychar)) {
|
|
case KT_LETTER:
|
|
case KT_LATIN:
|
|
if (isprint(keychar))
|
|
break; /* printable characters */
|
|
fallthrough;
|
|
case KT_SPEC:
|
|
if (keychar == K_ENTER)
|
|
break;
|
|
fallthrough;
|
|
default:
|
|
return -1; /* ignore unprintables */
|
|
}
|
|
|
|
if (scancode == 0x1c) {
|
|
kbd_last_ret = 1;
|
|
return 13;
|
|
}
|
|
|
|
return keychar & 0xff;
|
|
}
|
|
EXPORT_SYMBOL_GPL(kdb_get_kbd_char);
|
|
|
|
/*
|
|
* Best effort cleanup of ENTER break codes on leaving KDB. Called on
|
|
* exiting KDB, when we know we processed an ENTER or KP ENTER scan
|
|
* code.
|
|
*/
|
|
void kdb_kbd_cleanup_state(void)
|
|
{
|
|
int scancode, scanstatus;
|
|
|
|
/*
|
|
* Nothing to clean up, since either
|
|
* ENTER was never pressed, or has already
|
|
* gotten cleaned up.
|
|
*/
|
|
if (!kbd_last_ret)
|
|
return;
|
|
|
|
kbd_last_ret = 0;
|
|
/*
|
|
* Enter key. Need to absorb the break code here, lest it gets
|
|
* leaked out if we exit KDB as the result of processing 'g'.
|
|
*
|
|
* This has several interesting implications:
|
|
* + Need to handle KP ENTER, which has break code 0xe0 0x9c.
|
|
* + Need to handle repeat ENTER and repeat KP ENTER. Repeats
|
|
* only get a break code at the end of the repeated
|
|
* sequence. This means we can't propagate the repeated key
|
|
* press, and must swallow it away.
|
|
* + Need to handle possible PS/2 mouse input.
|
|
* + Need to handle mashed keys.
|
|
*/
|
|
|
|
while (1) {
|
|
while ((inb(KBD_STATUS_REG) & KBD_STAT_OBF) == 0)
|
|
cpu_relax();
|
|
|
|
/*
|
|
* Fetch the scancode.
|
|
*/
|
|
scancode = inb(KBD_DATA_REG);
|
|
scanstatus = inb(KBD_STATUS_REG);
|
|
|
|
/*
|
|
* Skip mouse input.
|
|
*/
|
|
if (scanstatus & KBD_STAT_MOUSE_OBF)
|
|
continue;
|
|
|
|
/*
|
|
* If we see 0xe0, this is either a break code for KP
|
|
* ENTER, or a repeat make for KP ENTER. Either way,
|
|
* since the second byte is equivalent to an ENTER,
|
|
* skip the 0xe0 and try again.
|
|
*
|
|
* If we see 0x1c, this must be a repeat ENTER or KP
|
|
* ENTER (and we swallowed 0xe0 before). Try again.
|
|
*
|
|
* We can also see make and break codes for other keys
|
|
* mashed before or after pressing ENTER. Thus, if we
|
|
* see anything other than 0x9c, we have to try again.
|
|
*
|
|
* Note, if you held some key as ENTER was depressed,
|
|
* that break code would get leaked out.
|
|
*/
|
|
if (scancode != 0x9c)
|
|
continue;
|
|
|
|
return;
|
|
}
|
|
}
|