WebSVN – HelenOS-historic – Diff – /uspace/trunk/kbd/arch/ia32/src/kbd.c


/*
 * Copyright (C) 2001-2004 Jakub Jermar
 * Copyright (C) 2006 Josef Cejka
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - 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.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 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.
 */
 
/** @addtogroup kbdia32 ia32
 * @brief   HelenOS ia32 / amd64 arch dependent parts of uspace keyboard handler.
 * @ingroup  kbd
 * @{
 */
/** @file
 * @ingroup kbdamd64
 */
 
#include <arch/kbd.h>
#include <ipc/ipc.h>
#include <unistd.h>
#include <kbd.h>
#include <keys.h>
 
/* Interesting bits for status register */
#define i8042_OUTPUT_FULL  0x1
#define i8042_INPUT_FULL   0x2
#define i8042_MOUSE_DATA   0x20
 
/* Command constants */
#define i8042_CMD_KBD 0x60
#define i8042_CMD_MOUSE  0xd4
 
/* Keyboard cmd byte */
#define i8042_KBD_IE        0x1
#define i8042_MOUSE_IE      0x2
#define i8042_KBD_DISABLE   0x10
#define i8042_MOUSE_DISABLE 0x20
#define i8042_KBD_TRANSLATE 0x40
 
/* Mouse constants */
#define MOUSE_OUT_INIT  0xf4
#define MOUSE_ACK       0xfa
 
 
#define SPECIAL     255
#define KEY_RELEASE 0x80
 
/**
 * These codes read from i8042 data register are silently ignored.
 */
#define IGNORE_CODE 0x7f
 
#define PRESSED_SHIFT       (1<<0)
#define PRESSED_CAPSLOCK    (1<<1)
#define LOCKED_CAPSLOCK     (1<<0)
 
/** Scancodes. */
#define SC_ESC      0x01
#define SC_BACKSPACE    0x0e
#define SC_LSHIFT   0x2a
#define SC_RSHIFT   0x36
#define SC_CAPSLOCK 0x3a
#define SC_SPEC_ESCAPE  0xe0
#define SC_LEFTARR      0x4b
#define SC_RIGHTARR     0x4d
#define SC_UPARR        0x48
#define SC_DOWNARR      0x50
#define SC_DELETE       0x53
#define SC_HOME         0x47
#define SC_END          0x4f
 
#define FUNCTION_KEYS 0x100
 
static volatile int keyflags;       /**< Tracking of multiple keypresses. */
static volatile int lockflags;      /**< Tracking of multiple keys lockings. */
 
/** Primary meaning of scancodes. */
static int sc_primary_map[] = {
    SPECIAL, /* 0x00 */
    SPECIAL, /* 0x01 - Esc */
    '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '-', '=',
    '\b', /* 0x0e - Backspace */
    '\t', 'q', 'w', 'e', 'r', 't', 'y', 'u', 'i', 'o', 'p', '[', ']', '\n',
    SPECIAL, /* 0x1d - LCtrl */
    'a', 's', 'd', 'f', 'g', 'h', 'j', 'k', 'l', ';', '\'',
    '`',
    SPECIAL, /* 0x2a - LShift */
    '\\',
    'z', 'x', 'c', 'v', 'b', 'n', 'm', ',', '.', '/',
    SPECIAL, /* 0x36 - RShift */
    '*',
    SPECIAL, /* 0x38 - LAlt */
    ' ',
    SPECIAL, /* 0x3a - CapsLock */
    (FUNCTION_KEYS | 1), /* 0x3b - F1 */
    (FUNCTION_KEYS | 2), /* 0x3c - F2 */
    (FUNCTION_KEYS | 3), /* 0x3d - F3 */
    (FUNCTION_KEYS | 4), /* 0x3e - F4 */
    (FUNCTION_KEYS | 5), /* 0x3f - F5 */
    (FUNCTION_KEYS | 6), /* 0x40 - F6 */
    (FUNCTION_KEYS | 7), /* 0x41 - F7 */
    (FUNCTION_KEYS | 8), /* 0x42 - F8 */
    (FUNCTION_KEYS | 9), /* 0x43 - F9 */
    (FUNCTION_KEYS | 10), /* 0x44 - F10 */
    SPECIAL, /* 0x45 - NumLock */
    SPECIAL, /* 0x46 - ScrollLock */
    '7', '8', '9', '-',
    '4', '5', '6', '+',
    '1', '2', '3',
    '0', '.',
    SPECIAL, /* 0x54 - Alt-SysRq */
    SPECIAL, /* 0x55 - F11/F12/PF1/FN */
    SPECIAL, /* 0x56 - unlabelled key next to LAlt */
    (FUNCTION_KEYS | 11), /* 0x57 - F11 */
    (FUNCTION_KEYS | 12), /* 0x58 - F12 */
    SPECIAL, /* 0x59 */
    SPECIAL, /* 0x5a */
    SPECIAL, /* 0x5b */
    SPECIAL, /* 0x5c */
    SPECIAL, /* 0x5d */
    SPECIAL, /* 0x5e */
    SPECIAL, /* 0x5f */
    SPECIAL, /* 0x60 */
    SPECIAL, /* 0x61 */
    SPECIAL, /* 0x62 */
    SPECIAL, /* 0x63 */
    SPECIAL, /* 0x64 */
    SPECIAL, /* 0x65 */
    SPECIAL, /* 0x66 */
    SPECIAL, /* 0x67 */
    SPECIAL, /* 0x68 */
    SPECIAL, /* 0x69 */
    SPECIAL, /* 0x6a */
    SPECIAL, /* 0x6b */
    SPECIAL, /* 0x6c */
    SPECIAL, /* 0x6d */
    SPECIAL, /* 0x6e */
    SPECIAL, /* 0x6f */
    SPECIAL, /* 0x70 */
    SPECIAL, /* 0x71 */
    SPECIAL, /* 0x72 */
    SPECIAL, /* 0x73 */
    SPECIAL, /* 0x74 */
    SPECIAL, /* 0x75 */
    SPECIAL, /* 0x76 */
    SPECIAL, /* 0x77 */
    SPECIAL, /* 0x78 */
    SPECIAL, /* 0x79 */
    SPECIAL, /* 0x7a */
    SPECIAL, /* 0x7b */
    SPECIAL, /* 0x7c */
    SPECIAL, /* 0x7d */
    SPECIAL, /* 0x7e */
    SPECIAL, /* 0x7f */
};
 
/** Secondary meaning of scancodes. */
static int sc_secondary_map[] = {
    SPECIAL, /* 0x00 */
    0x1b, /* 0x01 - Esc */
    '!', '@', '#', '$', '%', '^', '&', '*', '(', ')', '_', '+',
    SPECIAL, /* 0x0e - Backspace */
    '\t', 'Q', 'W', 'E', 'R', 'T', 'Y', 'U', 'I', 'O', 'P', '{', '}', '\n',
    SPECIAL, /* 0x1d - LCtrl */
    'A', 'S', 'D', 'F', 'G', 'H', 'J', 'K', 'L', ':', '"',
    '~',
    SPECIAL, /* 0x2a - LShift */
    '|',
    'Z', 'X', 'C', 'V', 'B', 'N', 'M', '<', '>', '?',
    SPECIAL, /* 0x36 - RShift */
    '*',
    SPECIAL, /* 0x38 - LAlt */
    ' ',
    SPECIAL, /* 0x3a - CapsLock */
    SPECIAL, /* 0x3b - F1 */
    SPECIAL, /* 0x3c - F2 */
    SPECIAL, /* 0x3d - F3 */
    SPECIAL, /* 0x3e - F4 */
    SPECIAL, /* 0x3f - F5 */
    SPECIAL, /* 0x40 - F6 */
    SPECIAL, /* 0x41 - F7 */
    SPECIAL, /* 0x42 - F8 */
    SPECIAL, /* 0x43 - F9 */
    SPECIAL, /* 0x44 - F10 */
    SPECIAL, /* 0x45 - NumLock */
    SPECIAL, /* 0x46 - ScrollLock */
    '7', '8', '9', '-',
    '4', '5', '6', '+',
    '1', '2', '3',
    '0', '.',
    SPECIAL, /* 0x54 - Alt-SysRq */
    SPECIAL, /* 0x55 - F11/F12/PF1/FN */
    SPECIAL, /* 0x56 - unlabelled key next to LAlt */
    SPECIAL, /* 0x57 - F11 */
    SPECIAL, /* 0x58 - F12 */
    SPECIAL, /* 0x59 */
    SPECIAL, /* 0x5a */
    SPECIAL, /* 0x5b */
    SPECIAL, /* 0x5c */
    SPECIAL, /* 0x5d */
    SPECIAL, /* 0x5e */
    SPECIAL, /* 0x5f */
    SPECIAL, /* 0x60 */
    SPECIAL, /* 0x61 */
    SPECIAL, /* 0x62 */
    SPECIAL, /* 0x63 */
    SPECIAL, /* 0x64 */
    SPECIAL, /* 0x65 */
    SPECIAL, /* 0x66 */
    SPECIAL, /* 0x67 */
    SPECIAL, /* 0x68 */
    SPECIAL, /* 0x69 */
    SPECIAL, /* 0x6a */
    SPECIAL, /* 0x6b */
    SPECIAL, /* 0x6c */
    SPECIAL, /* 0x6d */
    SPECIAL, /* 0x6e */
    SPECIAL, /* 0x6f */
    SPECIAL, /* 0x70 */
    SPECIAL, /* 0x71 */
    SPECIAL, /* 0x72 */
    SPECIAL, /* 0x73 */
    SPECIAL, /* 0x74 */
    SPECIAL, /* 0x75 */
    SPECIAL, /* 0x76 */
    SPECIAL, /* 0x77 */
    SPECIAL, /* 0x78 */
    SPECIAL, /* 0x79 */
    SPECIAL, /* 0x7a */
    SPECIAL, /* 0x7b */
    SPECIAL, /* 0x7c */
    SPECIAL, /* 0x7d */
    SPECIAL, /* 0x7e */
    SPECIAL, /* 0x7f */
};
 
irq_cmd_t i8042_cmds[2] = {
    { CMD_PORT_READ_1, (void *)0x64, 0, 1 },
    { CMD_PORT_READ_1, (void *)0x60, 0, 2 }
};
 
irq_code_t i8042_kbd = {
    2,
    i8042_cmds
};
 
static int key_released(keybuffer_t *keybuffer, unsigned char key)
{
    switch (key) {
        case SC_LSHIFT:
        case SC_RSHIFT:
            keyflags &= ~PRESSED_SHIFT;
            break;
        case SC_CAPSLOCK:
            keyflags &= ~PRESSED_CAPSLOCK;
            if (lockflags & LOCKED_CAPSLOCK)
                lockflags &= ~LOCKED_CAPSLOCK;
                else
                lockflags |= LOCKED_CAPSLOCK;
            break;
        default:
            break;
    }
}
 
static int key_pressed(keybuffer_t *keybuffer, unsigned char key)
{
    int *map = sc_primary_map;
    int ascii = sc_primary_map[key];
    int shift, capslock;
    int letter = 0;
 
    static int esc_count=0;
 
   
    if ( key == SC_ESC ) {
        esc_count++;
        if ( esc_count == 3 ) {
            __SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE);
        }  
    } else {
        esc_count=0;
    }
   
   
 
    switch (key) {
        case SC_LSHIFT:
        case SC_RSHIFT:
                keyflags |= PRESSED_SHIFT;
            break;
        case SC_CAPSLOCK:
            keyflags |= PRESSED_CAPSLOCK;
            break;
        case SC_SPEC_ESCAPE:
            break;
    /*  case SC_LEFTARR:
            if (keybuffer_available(keybuffer) >= 3) {
                keybuffer_push(keybuffer, 0x1b);   
                keybuffer_push(keybuffer, 0x5b);   
                keybuffer_push(keybuffer, 0x44);   
            }
            break;
        case SC_RIGHTARR:
            if (keybuffer_available(keybuffer) >= 3) {
                keybuffer_push(keybuffer, 0x1b);   
                keybuffer_push(keybuffer, 0x5b);   
                keybuffer_push(keybuffer, 0x43);   
            }
            break;
        case SC_UPARR:
            if (keybuffer_available(keybuffer) >= 3) {
                keybuffer_push(keybuffer, 0x1b);   
                keybuffer_push(keybuffer, 0x5b);   
                keybuffer_push(keybuffer, 0x41);   
            }
            break;
        case SC_DOWNARR:
            if (keybuffer_available(keybuffer) >= 3) {
                keybuffer_push(keybuffer, 0x1b);   
                keybuffer_push(keybuffer, 0x5b);   
                keybuffer_push(keybuffer, 0x42);   
            }
            break;
        case SC_HOME:
            if (keybuffer_available(keybuffer) >= 3) {
                keybuffer_push(keybuffer, 0x1b);   
                keybuffer_push(keybuffer, 0x4f);   
                keybuffer_push(keybuffer, 0x48);   
            }
            break;
        case SC_END:
            if (keybuffer_available(keybuffer) >= 3) {
                keybuffer_push(keybuffer, 0x1b);   
                keybuffer_push(keybuffer, 0x4f);   
                keybuffer_push(keybuffer, 0x46);   
            }
            break;
        case SC_DELETE:
            if (keybuffer_available(keybuffer) >= 4) {
                keybuffer_push(keybuffer, 0x1b);   
                keybuffer_push(keybuffer, 0x5b);   
                keybuffer_push(keybuffer, 0x33);   
                keybuffer_push(keybuffer, 0x7e);   
            }
            break;
    */  default:
                letter = ((ascii >= 'a') && (ascii <= 'z'));
            capslock = (keyflags & PRESSED_CAPSLOCK) || (lockflags & LOCKED_CAPSLOCK);
            shift = keyflags & PRESSED_SHIFT;
            if (letter && capslock)
                shift = !shift;
            if (shift)
                map = sc_secondary_map;
            if (map[key] != SPECIAL)
                keybuffer_push(keybuffer, map[key]);   
            break;
    }
}
 
 
static void wait_ready(void) {
    while (i8042_status_read() & i8042_INPUT_FULL)
        ;
}
 
/** Register uspace irq handler
 * @return
 */
int kbd_arch_init(void)
{
    int rc1, i;
    int mouseenabled = 0;
 
    iospace_enable(task_get_id(),(void *)i8042_DATA, 5);
    /* Disable kbd, enable mouse */
    i8042_command_write(i8042_CMD_KBD);
    wait_ready();
    i8042_command_write(i8042_CMD_KBD);
    wait_ready();
    i8042_data_write(i8042_KBD_DISABLE);
    wait_ready();
 
    /* Flush all current IO */
    while (i8042_status_read() & i8042_OUTPUT_FULL)
        i8042_data_read();
    /* Initialize mouse */
    i8042_command_write(i8042_CMD_MOUSE);
    wait_ready();
    i8042_data_write(MOUSE_OUT_INIT);
    wait_ready();
   
    int mouseanswer = 0;
    for (i=0;i < 1000; i++) {
        int status = i8042_status_read();
        if (status & i8042_OUTPUT_FULL) {
            int data = i8042_data_read();
            if (status & i8042_MOUSE_DATA) {
                mouseanswer = data;
                break;
            }
        }
        usleep(1000);
    }
    if (mouseanswer == MOUSE_ACK) {
        /* enable mouse */
        mouseenabled = 1;
 
        ipc_register_irq(MOUSE_IRQ, &i8042_kbd);
    }
    /* Enable kbd */
    ipc_register_irq(KBD_IRQ, &i8042_kbd);
 
    int newcontrol = i8042_KBD_IE | i8042_KBD_TRANSLATE;
    if (mouseenabled)
        newcontrol |= i8042_MOUSE_IE;
   
    i8042_command_write(i8042_CMD_KBD);
    wait_ready();
    i8042_data_write(newcontrol);
    wait_ready();
   
    return 0;
}
 
/** Process keyboard & mouse events */
int kbd_arch_process(keybuffer_t *keybuffer, ipc_call_t *call)
{
    int status = IPC_GET_ARG1(*call);
 
    if ((status & i8042_MOUSE_DATA))
        return 0;
   
    int scan_code = IPC_GET_ARG2(*call);
   
    if (scan_code != IGNORE_CODE) {
        if (scan_code & KEY_RELEASE)
            key_released(keybuffer, scan_code ^ KEY_RELEASE);
        else
            key_pressed(keybuffer, scan_code);
 
    }
    return  1;
}
 
/**
 * @}
 */
 
 

Rev 1694	Rev 1707
1	/*	1	/*
2	* Copyright (C) 2001-2004 Jakub Jermar	2	* Copyright (C) 2001-2004 Jakub Jermar
3	* Copyright (C) 2006 Josef Cejka	3	* Copyright (C) 2006 Josef Cejka
4	* All rights reserved.	4	* All rights reserved.
5	*	5	*
6	* Redistribution and use in source and binary forms, with or without	6	* Redistribution and use in source and binary forms, with or without
7	* modification, are permitted provided that the following conditions	7	* modification, are permitted provided that the following conditions
8	* are met:	8	* are met:
9	*	9	*
10	* - Redistributions of source code must retain the above copyright	10	* - Redistributions of source code must retain the above copyright
11	* notice, this list of conditions and the following disclaimer.	11	* notice, this list of conditions and the following disclaimer.
12	* - Redistributions in binary form must reproduce the above copyright	12	* - Redistributions in binary form must reproduce the above copyright
13	* notice, this list of conditions and the following disclaimer in the	13	* notice, this list of conditions and the following disclaimer in the
14	* documentation and/or other materials provided with the distribution.	14	* documentation and/or other materials provided with the distribution.
15	* - The name of the author may not be used to endorse or promote products	15	* - The name of the author may not be used to endorse or promote products
16	* derived from this software without specific prior written permission.	16	* derived from this software without specific prior written permission.
17	*	17	*
18	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	18	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
19	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	19	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
20	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	20	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	21	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
22	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	22	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
23	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	23	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
24	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	24	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
25	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	25	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
26	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	26	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
27	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	27	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28	*/	28	*/
29		29
30	/** @addtogroup kbdia32 ia32	30	/** @addtogroup kbdia32 ia32
31	* @brief HelenOS ia32 / amd64 arch dependent parts of uspace keyboard handler.	31	* @brief HelenOS ia32 / amd64 arch dependent parts of uspace keyboard handler.
32	* @ingroup kbd	32	* @ingroup kbd
33	* @{	33	* @{
34	*/	34	*/
35	/** @file	35	/** @file
36	* @ingroup kbdamd64	36	* @ingroup kbdamd64
37	*/	37	*/
38		38
39	#include <arch/kbd.h>	39	#include <arch/kbd.h>
40	#include <ipc/ipc.h>	40	#include <ipc/ipc.h>
41	#include <unistd.h>	41	#include <unistd.h>
42	#include <kbd.h>	42	#include <kbd.h>
43	#include <keys.h>	43	#include <keys.h>
44		44
45	/* Interesting bits for status register */	45	/* Interesting bits for status register */
46	#define i8042_OUTPUT_FULL 0x1	46	#define i8042_OUTPUT_FULL 0x1
47	#define i8042_INPUT_FULL 0x2	47	#define i8042_INPUT_FULL 0x2
48	#define i8042_MOUSE_DATA 0x20	48	#define i8042_MOUSE_DATA 0x20
49		49
50	/* Command constants */	50	/* Command constants */
51	#define i8042_CMD_KBD 0x60	51	#define i8042_CMD_KBD 0x60
52	#define i8042_CMD_MOUSE 0xd4	52	#define i8042_CMD_MOUSE 0xd4
53		53
54	/* Keyboard cmd byte */	54	/* Keyboard cmd byte */
55	#define i8042_KBD_IE 0x1	55	#define i8042_KBD_IE 0x1
56	#define i8042_MOUSE_IE 0x2	56	#define i8042_MOUSE_IE 0x2
57	#define i8042_KBD_DISABLE 0x10	57	#define i8042_KBD_DISABLE 0x10
58	#define i8042_MOUSE_DISABLE 0x20	58	#define i8042_MOUSE_DISABLE 0x20
59	#define i8042_KBD_TRANSLATE 0x40	59	#define i8042_KBD_TRANSLATE 0x40
60		60
61	/* Mouse constants */	61	/* Mouse constants */
62	#define MOUSE_OUT_INIT 0xf4	62	#define MOUSE_OUT_INIT 0xf4
63	#define MOUSE_ACK 0xfa	63	#define MOUSE_ACK 0xfa
64		64
65		65
66	#define SPECIAL 255	66	#define SPECIAL 255
67	#define KEY_RELEASE 0x80	67	#define KEY_RELEASE 0x80
68		68
69	/**	69	/**
70	* These codes read from i8042 data register are silently ignored.	70	* These codes read from i8042 data register are silently ignored.
71	*/	71	*/
72	#define IGNORE_CODE 0x7f	72	#define IGNORE_CODE 0x7f
73		73
74	#define PRESSED_SHIFT (1<<0)	74	#define PRESSED_SHIFT (1<<0)
75	#define PRESSED_CAPSLOCK (1<<1)	75	#define PRESSED_CAPSLOCK (1<<1)
76	#define LOCKED_CAPSLOCK (1<<0)	76	#define LOCKED_CAPSLOCK (1<<0)
77		77
78	/** Scancodes. */	78	/** Scancodes. */
79	#define SC_ESC 0x01	79	#define SC_ESC 0x01
80	#define SC_BACKSPACE 0x0e	80	#define SC_BACKSPACE 0x0e
81	#define SC_LSHIFT 0x2a	81	#define SC_LSHIFT 0x2a
82	#define SC_RSHIFT 0x36	82	#define SC_RSHIFT 0x36
83	#define SC_CAPSLOCK 0x3a	83	#define SC_CAPSLOCK 0x3a
84	#define SC_SPEC_ESCAPE 0xe0	84	#define SC_SPEC_ESCAPE 0xe0
85	#define SC_LEFTARR 0x4b	85	#define SC_LEFTARR 0x4b
86	#define SC_RIGHTARR 0x4d	86	#define SC_RIGHTARR 0x4d
87	#define SC_UPARR 0x48	87	#define SC_UPARR 0x48
88	#define SC_DOWNARR 0x50	88	#define SC_DOWNARR 0x50
89	#define SC_DELETE 0x53	89	#define SC_DELETE 0x53
90	#define SC_HOME 0x47	90	#define SC_HOME 0x47
91	#define SC_END 0x4f	91	#define SC_END 0x4f
92		92
93	#define FUNCTION_KEYS 0x100	93	#define FUNCTION_KEYS 0x100
94		94
95	static volatile int keyflags; /*< Tracking of multiple keypresses. /	95	static volatile int keyflags; /*< Tracking of multiple keypresses. /
96	static volatile int lockflags; /*< Tracking of multiple keys lockings. /	96	static volatile int lockflags; /*< Tracking of multiple keys lockings. /
97		97
98	/** Primary meaning of scancodes. */	98	/** Primary meaning of scancodes. */
99	static int sc_primary_map[] = {	99	static int sc_primary_map[] = {
100	SPECIAL, /* 0x00 */	100	SPECIAL, /* 0x00 */
101	SPECIAL, /* 0x01 - Esc */	101	SPECIAL, /* 0x01 - Esc */
102	'1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '-', '=',	102	'1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '-', '=',
103	'\b', /* 0x0e - Backspace */	103	'\b', /* 0x0e - Backspace */
104	'\t', 'q', 'w', 'e', 'r', 't', 'y', 'u', 'i', 'o', 'p', '[', ']', '\n',	104	'\t', 'q', 'w', 'e', 'r', 't', 'y', 'u', 'i', 'o', 'p', '[', ']', '\n',
105	SPECIAL, /* 0x1d - LCtrl */	105	SPECIAL, /* 0x1d - LCtrl */
106	'a', 's', 'd', 'f', 'g', 'h', 'j', 'k', 'l', ';', '\'',	106	'a', 's', 'd', 'f', 'g', 'h', 'j', 'k', 'l', ';', '\'',
107	'`',	107	'`',
108	SPECIAL, /* 0x2a - LShift */	108	SPECIAL, /* 0x2a - LShift */
109	'\\',	109	'\\',
110	'z', 'x', 'c', 'v', 'b', 'n', 'm', ',', '.', '/',	110	'z', 'x', 'c', 'v', 'b', 'n', 'm', ',', '.', '/',
111	SPECIAL, /* 0x36 - RShift */	111	SPECIAL, /* 0x36 - RShift */
112	'*',	112	'*',
113	SPECIAL, /* 0x38 - LAlt */	113	SPECIAL, /* 0x38 - LAlt */
114	' ',	114	' ',
115	SPECIAL, /* 0x3a - CapsLock */	115	SPECIAL, /* 0x3a - CapsLock */
116	(FUNCTION_KEYS \| 1), /* 0x3b - F1 */	116	(FUNCTION_KEYS \| 1), /* 0x3b - F1 */
117	(FUNCTION_KEYS \| 2), /* 0x3c - F2 */	117	(FUNCTION_KEYS \| 2), /* 0x3c - F2 */
118	(FUNCTION_KEYS \| 3), /* 0x3d - F3 */	118	(FUNCTION_KEYS \| 3), /* 0x3d - F3 */
119	(FUNCTION_KEYS \| 4), /* 0x3e - F4 */	119	(FUNCTION_KEYS \| 4), /* 0x3e - F4 */
120	(FUNCTION_KEYS \| 5), /* 0x3f - F5 */	120	(FUNCTION_KEYS \| 5), /* 0x3f - F5 */
121	(FUNCTION_KEYS \| 6), /* 0x40 - F6 */	121	(FUNCTION_KEYS \| 6), /* 0x40 - F6 */
122	(FUNCTION_KEYS \| 7), /* 0x41 - F7 */	122	(FUNCTION_KEYS \| 7), /* 0x41 - F7 */
123	(FUNCTION_KEYS \| 8), /* 0x42 - F8 */	123	(FUNCTION_KEYS \| 8), /* 0x42 - F8 */
124	(FUNCTION_KEYS \| 9), /* 0x43 - F9 */	124	(FUNCTION_KEYS \| 9), /* 0x43 - F9 */
125	(FUNCTION_KEYS \| 10), /* 0x44 - F10 */	125	(FUNCTION_KEYS \| 10), /* 0x44 - F10 */
126	SPECIAL, /* 0x45 - NumLock */	126	SPECIAL, /* 0x45 - NumLock */
127	SPECIAL, /* 0x46 - ScrollLock */	127	SPECIAL, /* 0x46 - ScrollLock */
128	'7', '8', '9', '-',	128	'7', '8', '9', '-',
129	'4', '5', '6', '+',	129	'4', '5', '6', '+',
130	'1', '2', '3',	130	'1', '2', '3',
131	'0', '.',	131	'0', '.',
132	SPECIAL, /* 0x54 - Alt-SysRq */	132	SPECIAL, /* 0x54 - Alt-SysRq */
133	SPECIAL, /* 0x55 - F11/F12/PF1/FN */	133	SPECIAL, /* 0x55 - F11/F12/PF1/FN */
134	SPECIAL, /* 0x56 - unlabelled key next to LAlt */	134	SPECIAL, /* 0x56 - unlabelled key next to LAlt */
135	(FUNCTION_KEYS \| 11), /* 0x57 - F11 */	135	(FUNCTION_KEYS \| 11), /* 0x57 - F11 */
136	(FUNCTION_KEYS \| 12), /* 0x58 - F12 */	136	(FUNCTION_KEYS \| 12), /* 0x58 - F12 */
137	SPECIAL, /* 0x59 */	137	SPECIAL, /* 0x59 */
138	SPECIAL, /* 0x5a */	138	SPECIAL, /* 0x5a */
139	SPECIAL, /* 0x5b */	139	SPECIAL, /* 0x5b */
140	SPECIAL, /* 0x5c */	140	SPECIAL, /* 0x5c */
141	SPECIAL, /* 0x5d */	141	SPECIAL, /* 0x5d */
142	SPECIAL, /* 0x5e */	142	SPECIAL, /* 0x5e */
143	SPECIAL, /* 0x5f */	143	SPECIAL, /* 0x5f */
144	SPECIAL, /* 0x60 */	144	SPECIAL, /* 0x60 */
145	SPECIAL, /* 0x61 */	145	SPECIAL, /* 0x61 */
146	SPECIAL, /* 0x62 */	146	SPECIAL, /* 0x62 */
147	SPECIAL, /* 0x63 */	147	SPECIAL, /* 0x63 */
148	SPECIAL, /* 0x64 */	148	SPECIAL, /* 0x64 */
149	SPECIAL, /* 0x65 */	149	SPECIAL, /* 0x65 */
150	SPECIAL, /* 0x66 */	150	SPECIAL, /* 0x66 */
151	SPECIAL, /* 0x67 */	151	SPECIAL, /* 0x67 */
152	SPECIAL, /* 0x68 */	152	SPECIAL, /* 0x68 */
153	SPECIAL, /* 0x69 */	153	SPECIAL, /* 0x69 */
154	SPECIAL, /* 0x6a */	154	SPECIAL, /* 0x6a */
155	SPECIAL, /* 0x6b */	155	SPECIAL, /* 0x6b */
156	SPECIAL, /* 0x6c */	156	SPECIAL, /* 0x6c */
157	SPECIAL, /* 0x6d */	157	SPECIAL, /* 0x6d */
158	SPECIAL, /* 0x6e */	158	SPECIAL, /* 0x6e */
159	SPECIAL, /* 0x6f */	159	SPECIAL, /* 0x6f */
160	SPECIAL, /* 0x70 */	160	SPECIAL, /* 0x70 */
161	SPECIAL, /* 0x71 */	161	SPECIAL, /* 0x71 */
162	SPECIAL, /* 0x72 */	162	SPECIAL, /* 0x72 */
163	SPECIAL, /* 0x73 */	163	SPECIAL, /* 0x73 */
164	SPECIAL, /* 0x74 */	164	SPECIAL, /* 0x74 */
165	SPECIAL, /* 0x75 */	165	SPECIAL, /* 0x75 */
166	SPECIAL, /* 0x76 */	166	SPECIAL, /* 0x76 */
167	SPECIAL, /* 0x77 */	167	SPECIAL, /* 0x77 */
168	SPECIAL, /* 0x78 */	168	SPECIAL, /* 0x78 */
169	SPECIAL, /* 0x79 */	169	SPECIAL, /* 0x79 */
170	SPECIAL, /* 0x7a */	170	SPECIAL, /* 0x7a */
171	SPECIAL, /* 0x7b */	171	SPECIAL, /* 0x7b */
172	SPECIAL, /* 0x7c */	172	SPECIAL, /* 0x7c */
173	SPECIAL, /* 0x7d */	173	SPECIAL, /* 0x7d */
174	SPECIAL, /* 0x7e */	174	SPECIAL, /* 0x7e */
175	SPECIAL, /* 0x7f */	175	SPECIAL, /* 0x7f */
176	};	176	};
177		177
178	/** Secondary meaning of scancodes. */	178	/** Secondary meaning of scancodes. */
179	static int sc_secondary_map[] = {	179	static int sc_secondary_map[] = {
180	SPECIAL, /* 0x00 */	180	SPECIAL, /* 0x00 */
181	0x1b, /* 0x01 - Esc */	181	0x1b, /* 0x01 - Esc */
182	'!', '@', '#', '$', '%', '^', '&', '*', '(', ')', '_', '+',	182	'!', '@', '#', '$', '%', '^', '&', '*', '(', ')', '_', '+',
183	SPECIAL, /* 0x0e - Backspace */	183	SPECIAL, /* 0x0e - Backspace */
184	'\t', 'Q', 'W', 'E', 'R', 'T', 'Y', 'U', 'I', 'O', 'P', '{', '}', '\n',	184	'\t', 'Q', 'W', 'E', 'R', 'T', 'Y', 'U', 'I', 'O', 'P', '{', '}', '\n',
185	SPECIAL, /* 0x1d - LCtrl */	185	SPECIAL, /* 0x1d - LCtrl */
186	'A', 'S', 'D', 'F', 'G', 'H', 'J', 'K', 'L', ':', '"',	186	'A', 'S', 'D', 'F', 'G', 'H', 'J', 'K', 'L', ':', '"',
187	'~',	187	'~',
188	SPECIAL, /* 0x2a - LShift */	188	SPECIAL, /* 0x2a - LShift */
189	'\|',	189	'\|',
190	'Z', 'X', 'C', 'V', 'B', 'N', 'M', '<', '>', '?',	190	'Z', 'X', 'C', 'V', 'B', 'N', 'M', '<', '>', '?',
191	SPECIAL, /* 0x36 - RShift */	191	SPECIAL, /* 0x36 - RShift */
192	'*',	192	'*',
193	SPECIAL, /* 0x38 - LAlt */	193	SPECIAL, /* 0x38 - LAlt */
194	' ',	194	' ',
195	SPECIAL, /* 0x3a - CapsLock */	195	SPECIAL, /* 0x3a - CapsLock */
196	SPECIAL, /* 0x3b - F1 */	196	SPECIAL, /* 0x3b - F1 */
197	SPECIAL, /* 0x3c - F2 */	197	SPECIAL, /* 0x3c - F2 */
198	SPECIAL, /* 0x3d - F3 */	198	SPECIAL, /* 0x3d - F3 */
199	SPECIAL, /* 0x3e - F4 */	199	SPECIAL, /* 0x3e - F4 */
200	SPECIAL, /* 0x3f - F5 */	200	SPECIAL, /* 0x3f - F5 */
201	SPECIAL, /* 0x40 - F6 */	201	SPECIAL, /* 0x40 - F6 */
202	SPECIAL, /* 0x41 - F7 */	202	SPECIAL, /* 0x41 - F7 */
203	SPECIAL, /* 0x42 - F8 */	203	SPECIAL, /* 0x42 - F8 */
204	SPECIAL, /* 0x43 - F9 */	204	SPECIAL, /* 0x43 - F9 */
205	SPECIAL, /* 0x44 - F10 */	205	SPECIAL, /* 0x44 - F10 */
206	SPECIAL, /* 0x45 - NumLock */	206	SPECIAL, /* 0x45 - NumLock */
207	SPECIAL, /* 0x46 - ScrollLock */	207	SPECIAL, /* 0x46 - ScrollLock */
208	'7', '8', '9', '-',	208	'7', '8', '9', '-',
209	'4', '5', '6', '+',	209	'4', '5', '6', '+',
210	'1', '2', '3',	210	'1', '2', '3',
211	'0', '.',	211	'0', '.',
212	SPECIAL, /* 0x54 - Alt-SysRq */	212	SPECIAL, /* 0x54 - Alt-SysRq */
213	SPECIAL, /* 0x55 - F11/F12/PF1/FN */	213	SPECIAL, /* 0x55 - F11/F12/PF1/FN */
214	SPECIAL, /* 0x56 - unlabelled key next to LAlt */	214	SPECIAL, /* 0x56 - unlabelled key next to LAlt */
215	SPECIAL, /* 0x57 - F11 */	215	SPECIAL, /* 0x57 - F11 */
216	SPECIAL, /* 0x58 - F12 */	216	SPECIAL, /* 0x58 - F12 */
217	SPECIAL, /* 0x59 */	217	SPECIAL, /* 0x59 */
218	SPECIAL, /* 0x5a */	218	SPECIAL, /* 0x5a */
219	SPECIAL, /* 0x5b */	219	SPECIAL, /* 0x5b */
220	SPECIAL, /* 0x5c */	220	SPECIAL, /* 0x5c */
221	SPECIAL, /* 0x5d */	221	SPECIAL, /* 0x5d */
222	SPECIAL, /* 0x5e */	222	SPECIAL, /* 0x5e */
223	SPECIAL, /* 0x5f */	223	SPECIAL, /* 0x5f */
224	SPECIAL, /* 0x60 */	224	SPECIAL, /* 0x60 */
225	SPECIAL, /* 0x61 */	225	SPECIAL, /* 0x61 */
226	SPECIAL, /* 0x62 */	226	SPECIAL, /* 0x62 */
227	SPECIAL, /* 0x63 */	227	SPECIAL, /* 0x63 */
228	SPECIAL, /* 0x64 */	228	SPECIAL, /* 0x64 */
229	SPECIAL, /* 0x65 */	229	SPECIAL, /* 0x65 */
230	SPECIAL, /* 0x66 */	230	SPECIAL, /* 0x66 */
231	SPECIAL, /* 0x67 */	231	SPECIAL, /* 0x67 */
232	SPECIAL, /* 0x68 */	232	SPECIAL, /* 0x68 */
233	SPECIAL, /* 0x69 */	233	SPECIAL, /* 0x69 */
234	SPECIAL, /* 0x6a */	234	SPECIAL, /* 0x6a */
235	SPECIAL, /* 0x6b */	235	SPECIAL, /* 0x6b */
236	SPECIAL, /* 0x6c */	236	SPECIAL, /* 0x6c */
237	SPECIAL, /* 0x6d */	237	SPECIAL, /* 0x6d */
238	SPECIAL, /* 0x6e */	238	SPECIAL, /* 0x6e */
239	SPECIAL, /* 0x6f */	239	SPECIAL, /* 0x6f */
240	SPECIAL, /* 0x70 */	240	SPECIAL, /* 0x70 */
241	SPECIAL, /* 0x71 */	241	SPECIAL, /* 0x71 */
242	SPECIAL, /* 0x72 */	242	SPECIAL, /* 0x72 */
243	SPECIAL, /* 0x73 */	243	SPECIAL, /* 0x73 */
244	SPECIAL, /* 0x74 */	244	SPECIAL, /* 0x74 */
245	SPECIAL, /* 0x75 */	245	SPECIAL, /* 0x75 */
246	SPECIAL, /* 0x76 */	246	SPECIAL, /* 0x76 */
247	SPECIAL, /* 0x77 */	247	SPECIAL, /* 0x77 */
248	SPECIAL, /* 0x78 */	248	SPECIAL, /* 0x78 */
249	SPECIAL, /* 0x79 */	249	SPECIAL, /* 0x79 */
250	SPECIAL, /* 0x7a */	250	SPECIAL, /* 0x7a */
251	SPECIAL, /* 0x7b */	251	SPECIAL, /* 0x7b */
252	SPECIAL, /* 0x7c */	252	SPECIAL, /* 0x7c */
253	SPECIAL, /* 0x7d */	253	SPECIAL, /* 0x7d */
254	SPECIAL, /* 0x7e */	254	SPECIAL, /* 0x7e */
255	SPECIAL, /* 0x7f */	255	SPECIAL, /* 0x7f */
256	};	256	};
257		257
258	irq_cmd_t i8042_cmds[2] = {	258	irq_cmd_t i8042_cmds[2] = {
259	{ CMD_PORT_READ_1, (void *)0x64, 0, 1 },	259	{ CMD_PORT_READ_1, (void *)0x64, 0, 1 },
260	{ CMD_PORT_READ_1, (void *)0x60, 0, 2 }	260	{ CMD_PORT_READ_1, (void *)0x60, 0, 2 }
261	};	261	};
262		262
263	irq_code_t i8042_kbd = {	263	irq_code_t i8042_kbd = {
264	2,	264	2,
265	i8042_cmds	265	i8042_cmds
266	};	266	};
267		267
268	static int key_released(keybuffer_t *keybuffer, unsigned char key)	268	static int key_released(keybuffer_t *keybuffer, unsigned char key)
269	{	269	{
270	switch (key) {	270	switch (key) {
271	case SC_LSHIFT:	271	case SC_LSHIFT:
272	case SC_RSHIFT:	272	case SC_RSHIFT:
273	keyflags &= ~PRESSED_SHIFT;	273	keyflags &= ~PRESSED_SHIFT;
274	break;	274	break;
275	case SC_CAPSLOCK:	275	case SC_CAPSLOCK:
276	keyflags &= ~PRESSED_CAPSLOCK;	276	keyflags &= ~PRESSED_CAPSLOCK;
277	if (lockflags & LOCKED_CAPSLOCK)	277	if (lockflags & LOCKED_CAPSLOCK)
278	lockflags &= ~LOCKED_CAPSLOCK;	278	lockflags &= ~LOCKED_CAPSLOCK;
279	else	279	else
280	lockflags \|= LOCKED_CAPSLOCK;	280	lockflags \|= LOCKED_CAPSLOCK;
281	break;	281	break;
282	default:	282	default:
283	break;	283	break;
284	}	284	}
285	}	285	}
286		286
287	static int key_pressed(keybuffer_t *keybuffer, unsigned char key)	287	static int key_pressed(keybuffer_t *keybuffer, unsigned char key)
288	{	288	{
289	int *map = sc_primary_map;	289	int *map = sc_primary_map;
290	int ascii = sc_primary_map[key];	290	int ascii = sc_primary_map[key];
291	int shift, capslock;	291	int shift, capslock;
292	int letter = 0;	292	int letter = 0;
293		293
294	static int esc_count=0;	294	static int esc_count=0;
295		295
296		296
297	if ( key == SC_ESC ) {	297	if ( key == SC_ESC ) {
298	esc_count++;	298	esc_count++;
299	if ( esc_count == 3 ) {	299	if ( esc_count == 3 ) {
300	__SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE);	300	__SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE);
301	}	301	}
302	} else {	302	} else {
303	esc_count=0;	303	esc_count=0;
304	}	304	}
305		305
306		306
307		307
308	switch (key) {	308	switch (key) {
309	case SC_LSHIFT:	309	case SC_LSHIFT:
310	case SC_RSHIFT:	310	case SC_RSHIFT:
311	keyflags \|= PRESSED_SHIFT;	311	keyflags \|= PRESSED_SHIFT;
312	break;	312	break;
313	case SC_CAPSLOCK:	313	case SC_CAPSLOCK:
314	keyflags \|= PRESSED_CAPSLOCK;	314	keyflags \|= PRESSED_CAPSLOCK;
315	break;	315	break;
316	case SC_SPEC_ESCAPE:	316	case SC_SPEC_ESCAPE:
317	break;	317	break;
318	/* case SC_LEFTARR:	318	/* case SC_LEFTARR:
319	if (keybuffer_available(keybuffer) >= 3) {	319	if (keybuffer_available(keybuffer) >= 3) {
320	keybuffer_push(keybuffer, 0x1b);	320	keybuffer_push(keybuffer, 0x1b);
321	keybuffer_push(keybuffer, 0x5b);	321	keybuffer_push(keybuffer, 0x5b);
322	keybuffer_push(keybuffer, 0x44);	322	keybuffer_push(keybuffer, 0x44);
323	}	323	}
324	break;	324	break;
325	case SC_RIGHTARR:	325	case SC_RIGHTARR:
326	if (keybuffer_available(keybuffer) >= 3) {	326	if (keybuffer_available(keybuffer) >= 3) {
327	keybuffer_push(keybuffer, 0x1b);	327	keybuffer_push(keybuffer, 0x1b);
328	keybuffer_push(keybuffer, 0x5b);	328	keybuffer_push(keybuffer, 0x5b);
329	keybuffer_push(keybuffer, 0x43);	329	keybuffer_push(keybuffer, 0x43);
330	}	330	}
331	break;	331	break;
332	case SC_UPARR:	332	case SC_UPARR:
333	if (keybuffer_available(keybuffer) >= 3) {	333	if (keybuffer_available(keybuffer) >= 3) {
334	keybuffer_push(keybuffer, 0x1b);	334	keybuffer_push(keybuffer, 0x1b);
335	keybuffer_push(keybuffer, 0x5b);	335	keybuffer_push(keybuffer, 0x5b);
336	keybuffer_push(keybuffer, 0x41);	336	keybuffer_push(keybuffer, 0x41);
337	}	337	}
338	break;	338	break;
339	case SC_DOWNARR:	339	case SC_DOWNARR:
340	if (keybuffer_available(keybuffer) >= 3) {	340	if (keybuffer_available(keybuffer) >= 3) {
341	keybuffer_push(keybuffer, 0x1b);	341	keybuffer_push(keybuffer, 0x1b);
342	keybuffer_push(keybuffer, 0x5b);	342	keybuffer_push(keybuffer, 0x5b);
343	keybuffer_push(keybuffer, 0x42);	343	keybuffer_push(keybuffer, 0x42);
344	}	344	}
345	break;	345	break;
346	case SC_HOME:	346	case SC_HOME:
347	if (keybuffer_available(keybuffer) >= 3) {	347	if (keybuffer_available(keybuffer) >= 3) {
348	keybuffer_push(keybuffer, 0x1b);	348	keybuffer_push(keybuffer, 0x1b);
349	keybuffer_push(keybuffer, 0x4f);	349	keybuffer_push(keybuffer, 0x4f);
350	keybuffer_push(keybuffer, 0x48);	350	keybuffer_push(keybuffer, 0x48);
351	}	351	}
352	break;	352	break;
353	case SC_END:	353	case SC_END:
354	if (keybuffer_available(keybuffer) >= 3) {	354	if (keybuffer_available(keybuffer) >= 3) {
355	keybuffer_push(keybuffer, 0x1b);	355	keybuffer_push(keybuffer, 0x1b);
356	keybuffer_push(keybuffer, 0x4f);	356	keybuffer_push(keybuffer, 0x4f);
357	keybuffer_push(keybuffer, 0x46);	357	keybuffer_push(keybuffer, 0x46);
358	}	358	}
359	break;	359	break;
360	case SC_DELETE:	360	case SC_DELETE:
361	if (keybuffer_available(keybuffer) >= 4) {	361	if (keybuffer_available(keybuffer) >= 4) {
362	keybuffer_push(keybuffer, 0x1b);	362	keybuffer_push(keybuffer, 0x1b);
363	keybuffer_push(keybuffer, 0x5b);	363	keybuffer_push(keybuffer, 0x5b);
364	keybuffer_push(keybuffer, 0x33);	364	keybuffer_push(keybuffer, 0x33);
365	keybuffer_push(keybuffer, 0x7e);	365	keybuffer_push(keybuffer, 0x7e);
366	}	366	}
367	break;	367	break;
368	*/ default:	368	*/ default:
369	letter = ((ascii >= 'a') && (ascii <= 'z'));	369	letter = ((ascii >= 'a') && (ascii <= 'z'));
370	capslock = (keyflags & PRESSED_CAPSLOCK) \|\| (lockflags & LOCKED_CAPSLOCK);	370	capslock = (keyflags & PRESSED_CAPSLOCK) \|\| (lockflags & LOCKED_CAPSLOCK);
371	shift = keyflags & PRESSED_SHIFT;	371	shift = keyflags & PRESSED_SHIFT;
372	if (letter && capslock)	372	if (letter && capslock)
373	shift = !shift;	373	shift = !shift;
374	if (shift)	374	if (shift)
375	map = sc_secondary_map;	375	map = sc_secondary_map;
376	if (map[key] != SPECIAL)	376	if (map[key] != SPECIAL)
377	keybuffer_push(keybuffer, map[key]);	377	keybuffer_push(keybuffer, map[key]);
378	break;	378	break;
379	}	379	}
380	}	380	}
381		381
382		382
383	static void wait_ready(void) {	383	static void wait_ready(void) {
384	while (i8042_status_read() & i8042_INPUT_FULL)	384	while (i8042_status_read() & i8042_INPUT_FULL)
385	;	385	;
386	}	386	}
387		387
388	/** Register uspace irq handler	388	/** Register uspace irq handler
389	* @return	389	* @return
390	*/	390	*/
391	int kbd_arch_init(void)	391	int kbd_arch_init(void)
392	{	392	{
393	int rc1, i;	393	int rc1, i;
394	int mouseenabled = 0;	394	int mouseenabled = 0;
395		395
396	iospace_enable(task_get_id(),(void *)i8042_DATA, 5);	396	iospace_enable(task_get_id(),(void *)i8042_DATA, 5);
397	/* Disable kbd, enable mouse */	397	/* Disable kbd, enable mouse */
398	i8042_command_write(i8042_CMD_KBD);	398	i8042_command_write(i8042_CMD_KBD);
399	wait_ready();	399	wait_ready();
400	i8042_command_write(i8042_CMD_KBD);	400	i8042_command_write(i8042_CMD_KBD);
401	wait_ready();	401	wait_ready();
402	i8042_data_write(i8042_KBD_DISABLE);	402	i8042_data_write(i8042_KBD_DISABLE);
403	wait_ready();	403	wait_ready();
404		404
405	/* Flush all current IO */	405	/* Flush all current IO */
406	while (i8042_status_read() & i8042_OUTPUT_FULL)	406	while (i8042_status_read() & i8042_OUTPUT_FULL)
407	i8042_data_read();	407	i8042_data_read();
408	/* Initialize mouse */	408	/* Initialize mouse */
409	i8042_command_write(i8042_CMD_MOUSE);	409	i8042_command_write(i8042_CMD_MOUSE);
410	wait_ready();	410	wait_ready();
411	i8042_data_write(MOUSE_OUT_INIT);	411	i8042_data_write(MOUSE_OUT_INIT);
412	wait_ready();	412	wait_ready();
413		413
414	int mouseanswer = 0;	414	int mouseanswer = 0;
415	for (i=0;i < 1000; i++) {	415	for (i=0;i < 1000; i++) {
416	int status = i8042_status_read();	416	int status = i8042_status_read();
417	if (status & i8042_OUTPUT_FULL) {	417	if (status & i8042_OUTPUT_FULL) {
418	int data = i8042_data_read();	418	int data = i8042_data_read();
419	if (status & i8042_MOUSE_DATA) {	419	if (status & i8042_MOUSE_DATA) {
420	mouseanswer = data;	420	mouseanswer = data;
421	break;	421	break;
422	}	422	}
423	}	423	}
424	usleep(1000);	424	usleep(1000);
425	}	425	}
426	if (mouseanswer == MOUSE_ACK) {	426	if (mouseanswer == MOUSE_ACK) {
427	/* enable mouse */	427	/* enable mouse */
428	mouseenabled = 1;	428	mouseenabled = 1;
429		429
430	ipc_register_irq(MOUSE_IRQ, &i8042_kbd);	430	ipc_register_irq(MOUSE_IRQ, &i8042_kbd);
431	}	431	}
432	/* Enable kbd */	432	/* Enable kbd */
433	ipc_register_irq(KBD_IRQ, &i8042_kbd);	433	ipc_register_irq(KBD_IRQ, &i8042_kbd);
434		434
435	int newcontrol = i8042_KBD_IE \| i8042_KBD_TRANSLATE;	435	int newcontrol = i8042_KBD_IE \| i8042_KBD_TRANSLATE;
436	if (mouseenabled)	436	if (mouseenabled)
437	newcontrol \|= i8042_MOUSE_IE;	437	newcontrol \|= i8042_MOUSE_IE;
438		438
439	i8042_command_write(i8042_CMD_KBD);	439	i8042_command_write(i8042_CMD_KBD);
440	wait_ready();	440	wait_ready();
441	i8042_data_write(newcontrol);	441	i8042_data_write(newcontrol);
442	wait_ready();	442	wait_ready();
443		443
444	return 0;	444	return 0;
445	}	445	}
446		446
447	/** Process keyboard & mouse events */	447	/** Process keyboard & mouse events */
448	int kbd_arch_process(keybuffer_t keybuffer, ipc_call_t call)	448	int kbd_arch_process(keybuffer_t keybuffer, ipc_call_t call)
449	{	449	{
450	int status = IPC_GET_ARG1(*call);	450	int status = IPC_GET_ARG1(*call);
451		451
452	if ((status & i8042_MOUSE_DATA)) {	452	if ((status & i8042_MOUSE_DATA))
453	;	453	return 0;
454	} else {	454
455	int scan_code = IPC_GET_ARG2(*call);	455	int scan_code = IPC_GET_ARG2(*call);
456		456
457	if (scan_code != IGNORE_CODE) {	457	if (scan_code != IGNORE_CODE) {
458	if (scan_code & KEY_RELEASE)	458	if (scan_code & KEY_RELEASE)
459	key_released(keybuffer, scan_code ^ KEY_RELEASE);	459	key_released(keybuffer, scan_code ^ KEY_RELEASE);
460	else	460	else
461	key_pressed(keybuffer, scan_code);	461	key_pressed(keybuffer, scan_code);
462	}	-
463	}	462	}
464	return 1;	463	return 1;
465	}	464	}
466		465
467	/**	466	/**
468	* @}	467	* @}
469	*/	468	*/
470		469
471		470

Subversion Repositories HelenOS-historic

(root)/uspace/trunk/kbd/arch/ia32/src/kbd.c – Rev 1694 → 1707