| /* | 
 |  * 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 */ | 
 | 		/* drop through */ | 
 | 	case KT_SPEC: | 
 | 		if (keychar == K_ENTER) | 
 | 			break; | 
 | 		/* drop through */ | 
 | 	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; | 
 | 	} | 
 | } |