WebSVN – HelenOS – Diff – /trunk/uspace/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>
#include <genarch/kbd.h>
#include <sysinfo.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 KEY_RELEASE 0x80
 
static volatile int keyflags;       /**< Tracking of multiple keypresses. */
static volatile int lockflags;      /**< Tracking of multiple keys lockings. */
 
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 void wait_ready(void) {
    while (i8042_status_read() & i8042_INPUT_FULL)
        ;
}
 
/** Register uspace irq handler
 * @return
 */
int kbd_arch_init(void)
{
    int 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(sysinfo_value("mouse.inr"), sysinfo_value("mouse.devno"), 0, &i8042_kbd);
    }
    /* Enable kbd */
    ipc_register_irq(sysinfo_value("kbd.inr"), sysinfo_value("kbd.devno"), 0, &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 & KEY_RELEASE)
        key_released(keybuffer, scan_code ^ KEY_RELEASE);
    else
        key_pressed(keybuffer, scan_code);
    return  1;
}
 
/**
 * @}
 */
 

Rev 1874	Rev 1939
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	#include <genarch/kbd.h>	44	#include <genarch/kbd.h>
-		45	#include <sysinfo.h>
45		46
46	/* Interesting bits for status register */	47	/* Interesting bits for status register */
47	#define i8042_OUTPUT_FULL 0x1	48	#define i8042_OUTPUT_FULL 0x1
48	#define i8042_INPUT_FULL 0x2	49	#define i8042_INPUT_FULL 0x2
49	#define i8042_MOUSE_DATA 0x20	50	#define i8042_MOUSE_DATA 0x20
50		51
51	/* Command constants */	52	/* Command constants */
52	#define i8042_CMD_KBD 0x60	53	#define i8042_CMD_KBD 0x60
53	#define i8042_CMD_MOUSE 0xd4	54	#define i8042_CMD_MOUSE 0xd4
54		55
55	/* Keyboard cmd byte */	56	/* Keyboard cmd byte */
56	#define i8042_KBD_IE 0x1	57	#define i8042_KBD_IE 0x1
57	#define i8042_MOUSE_IE 0x2	58	#define i8042_MOUSE_IE 0x2
58	#define i8042_KBD_DISABLE 0x10	59	#define i8042_KBD_DISABLE 0x10
59	#define i8042_MOUSE_DISABLE 0x20	60	#define i8042_MOUSE_DISABLE 0x20
60	#define i8042_KBD_TRANSLATE 0x40	61	#define i8042_KBD_TRANSLATE 0x40
61		62
62	/* Mouse constants */	63	/* Mouse constants */
63	#define MOUSE_OUT_INIT 0xf4	64	#define MOUSE_OUT_INIT 0xf4
64	#define MOUSE_ACK 0xfa	65	#define MOUSE_ACK 0xfa
65		66
66	#define KEY_RELEASE 0x80	67	#define KEY_RELEASE 0x80
67		68
68	static volatile int keyflags; /*< Tracking of multiple keypresses. /	69	static volatile int keyflags; /*< Tracking of multiple keypresses. /
69	static volatile int lockflags; /*< Tracking of multiple keys lockings. /	70	static volatile int lockflags; /*< Tracking of multiple keys lockings. /
70		71
71	irq_cmd_t i8042_cmds[2] = {	72	irq_cmd_t i8042_cmds[2] = {
72	{ CMD_PORT_READ_1, (void *)0x64, 0, 1 },	73	{ CMD_PORT_READ_1, (void *) 0x64, 0, 1 },
73	{ CMD_PORT_READ_1, (void *)0x60, 0, 2 }	74	{ CMD_PORT_READ_1, (void *) 0x60, 0, 2 }
74	};	75	};
75		76
76	irq_code_t i8042_kbd = {	77	irq_code_t i8042_kbd = {
77	2,	78	2,
78	i8042_cmds	79	i8042_cmds
79	};	80	};
80		81
81	static void wait_ready(void) {	82	static void wait_ready(void) {
82	while (i8042_status_read() & i8042_INPUT_FULL)	83	while (i8042_status_read() & i8042_INPUT_FULL)
83	;	84	;
84	}	85	}
85		86
86	/** Register uspace irq handler	87	/** Register uspace irq handler
87	* @return	88	* @return
88	*/	89	*/
89	int kbd_arch_init(void)	90	int kbd_arch_init(void)
90	{	91	{
91	int i;	92	int i;
92	int mouseenabled = 0;	93	int mouseenabled = 0;
93		94
94	iospace_enable(task_get_id(),(void *)i8042_DATA, 5);	95	iospace_enable(task_get_id(), (void *) i8042_DATA, 5);
95	/* Disable kbd, enable mouse */	96	/* Disable kbd, enable mouse */
96	i8042_command_write(i8042_CMD_KBD);	97	i8042_command_write(i8042_CMD_KBD);
97	wait_ready();	98	wait_ready();
98	i8042_command_write(i8042_CMD_KBD);	99	i8042_command_write(i8042_CMD_KBD);
99	wait_ready();	100	wait_ready();
100	i8042_data_write(i8042_KBD_DISABLE);	101	i8042_data_write(i8042_KBD_DISABLE);
101	wait_ready();	102	wait_ready();
102		103
103	/* Flush all current IO */	104	/* Flush all current IO */
104	while (i8042_status_read() & i8042_OUTPUT_FULL)	105	while (i8042_status_read() & i8042_OUTPUT_FULL)
105	i8042_data_read();	106	i8042_data_read();
106	/* Initialize mouse */	107	/* Initialize mouse */
107	i8042_command_write(i8042_CMD_MOUSE);	108	i8042_command_write(i8042_CMD_MOUSE);
108	wait_ready();	109	wait_ready();
109	i8042_data_write(MOUSE_OUT_INIT);	110	i8042_data_write(MOUSE_OUT_INIT);
110	wait_ready();	111	wait_ready();
111		112
112	int mouseanswer = 0;	113	int mouseanswer = 0;
113	for (i=0;i < 1000; i++) {	114	for (i=0;i < 1000; i++) {
114	int status = i8042_status_read();	115	int status = i8042_status_read();
115	if (status & i8042_OUTPUT_FULL) {	116	if (status & i8042_OUTPUT_FULL) {
116	int data = i8042_data_read();	117	int data = i8042_data_read();
117	if (status & i8042_MOUSE_DATA) {	118	if (status & i8042_MOUSE_DATA) {
118	mouseanswer = data;	119	mouseanswer = data;
119	break;	120	break;
120	}	121	}
121	}	122	}
122	usleep(1000);	123	usleep(1000);
123	}	124	}
124	if (mouseanswer == MOUSE_ACK) {	125	if (mouseanswer == MOUSE_ACK) {
125	/* enable mouse */	126	/* enable mouse */
126	mouseenabled = 1;	127	mouseenabled = 1;
127		128
128	ipc_register_irq(MOUSE_IRQ, &i8042_kbd);	129	ipc_register_irq(sysinfo_value("mouse.inr"), sysinfo_value("mouse.devno"), 0, &i8042_kbd);
129	}	130	}
130	/* Enable kbd */	131	/* Enable kbd */
131	ipc_register_irq(KBD_IRQ, &i8042_kbd);	132	ipc_register_irq(sysinfo_value("kbd.inr"), sysinfo_value("kbd.devno"), 0, &i8042_kbd);
132	/* Register for irq restart */	-
133	ipc_register_irq(IPC_IRQ_KBDRESTART, NULL);	-
134		133
135	int newcontrol = i8042_KBD_IE \| i8042_KBD_TRANSLATE;	134	int newcontrol = i8042_KBD_IE \| i8042_KBD_TRANSLATE;
136	if (mouseenabled)	135	if (mouseenabled)
137	newcontrol \|= i8042_MOUSE_IE;	136	newcontrol \|= i8042_MOUSE_IE;
138		137
139	i8042_command_write(i8042_CMD_KBD);	138	i8042_command_write(i8042_CMD_KBD);
140	wait_ready();	139	wait_ready();
141	i8042_data_write(newcontrol);	140	i8042_data_write(newcontrol);
142	wait_ready();	141	wait_ready();
143		142
144	return 0;	143	return 0;
145	}	144	}
146		145
147	/** Process keyboard & mouse events */	146	/** Process keyboard & mouse events */
148	int kbd_arch_process(keybuffer_t keybuffer, ipc_call_t call)	147	int kbd_arch_process(keybuffer_t keybuffer, ipc_call_t call)
149	{	148	{
150	int status = IPC_GET_ARG1(*call);	149	int status = IPC_GET_ARG1(*call);
151		150
152	if (IPC_GET_METHOD(*call) == IPC_IRQ_KBDRESTART) {	-
153	kbd_arch_init();	-
154	return 1;	-
155	}	-
156		-
157	if ((status & i8042_MOUSE_DATA))	151	if ((status & i8042_MOUSE_DATA))
158	return 0;	152	return 0;
159		153
160	int scan_code = IPC_GET_ARG2(*call);	154	int scan_code = IPC_GET_ARG2(*call);
161		155
162	if (scan_code & KEY_RELEASE)	156	if (scan_code & KEY_RELEASE)
163	key_released(keybuffer, scan_code ^ KEY_RELEASE);	157	key_released(keybuffer, scan_code ^ KEY_RELEASE);
164	else	158	else
165	key_pressed(keybuffer, scan_code);	159	key_pressed(keybuffer, scan_code);
166	return 1;	160	return 1;
167	}	161	}
168		162
169	/**	163	/**
170	* @}	164	* @}
171	*/	165	*/
172		166

Subversion Repositories HelenOS

(root)/trunk/uspace/kbd/arch/ia32/src/kbd.c @ 2071 – Rev 1874 → 1939