WebSVN – HelenOS – Blame – /trunk/uspace/srv/kbd/port/i8042.c/

Rev	Author	Line No.	Line
3923	svoboda	1	/*
		2	* Copyright (c) 2001-2004 Jakub Jermar
		3	* Copyright (c) 2006 Josef Cejka
		4	* All rights reserved.
		5	*
		6	* Redistribution and use in source and binary forms, with or without
		7	* modification, are permitted provided that the following conditions
		8	* are met:
		9	*
		10	* - Redistributions of source code must retain the above copyright
		11	* notice, this list of conditions and the following disclaimer.
		12	* - Redistributions in binary form must reproduce the above copyright
		13	* notice, this list of conditions and the following disclaimer in the
		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
		16	* derived from this software without specific prior written permission.
		17	*
		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
		20	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
		21	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
		22	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
		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
		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
		27	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
		28	*/
		29
3924	svoboda	30	/** @addtogroup kbd_port
		31	* @ingroup kbd
3923	svoboda	32	* @{
		33	*/
		34	/** @file
3924	svoboda	35	* @brief i8042 port driver.
3923	svoboda	36	*/
		37
		38	#include <ipc/ipc.h>
		39	#include <async.h>
		40	#include <unistd.h>
		41	#include <sysinfo.h>
		42	#include <kbd_port.h>
		43	#include <kbd.h>
		44	#include "i8042.h"
		45
		46	/* Interesting bits for status register */
		47	#define i8042_OUTPUT_FULL 0x1
		48	#define i8042_INPUT_FULL 0x2
		49	#define i8042_MOUSE_DATA 0x20
		50
		51	/* Command constants */
		52	#define i8042_CMD_KBD 0x60
		53	#define i8042_CMD_MOUSE 0xd4
		54
		55	/* Keyboard cmd byte */
		56	#define i8042_KBD_IE 0x1
		57	#define i8042_MOUSE_IE 0x2
		58	#define i8042_KBD_DISABLE 0x10
		59	#define i8042_MOUSE_DISABLE 0x20
		60	#define i8042_KBD_TRANSLATE 0x40
		61
		62	/* Mouse constants */
		63	#define MOUSE_OUT_INIT 0xf4
		64	#define MOUSE_ACK 0xfa
		65
3947	jermar	66	static irq_cmd_t i8042_cmds[] = {
		67	{
		68	.cmd = CMD_PIO_READ_8,
		69	.addr = (void *) 0x64,
		70	.dstarg = 1
		71	},
		72	{
		73	.cmd = CMD_BTEST,
		74	.value = i8042_OUTPUT_FULL,
		75	.srcarg = 1,
		76	.dstarg = 3
		77	},
		78	{
		79	.cmd = CMD_PREDICATE,
		80	.value = 2,
		81	.srcarg = 3
		82	},
		83	{
		84	.cmd = CMD_PIO_READ_8,
		85	.addr = (void *) 0x60,
		86	.dstarg = 2
		87	},
		88	{
		89	.cmd = CMD_ACCEPT
		90	}
3923	svoboda	91	};
		92
		93	static irq_code_t i8042_kbd = {
3947	jermar	94	sizeof(i8042_cmds) / sizeof(irq_cmd_t),
3923	svoboda	95	i8042_cmds
		96	};
		97
		98	static void wait_ready(void) {
		99	while (i8042_status_read() & i8042_INPUT_FULL)
		100	;
		101	}
		102
		103	static void i8042_irq_handler(ipc_callid_t iid, ipc_call_t *call);
		104
		105	int kbd_port_init(void)
		106	{
		107	// int i;
		108	int mouseenabled = 0;
		109
		110	async_set_interrupt_received(i8042_irq_handler);
		111	iospace_enable(task_get_id(), (void *) i8042_DATA, 5);
		112
		113	/* Disable kbd, enable mouse */
		114	i8042_command_write(i8042_CMD_KBD);
		115	wait_ready();
		116	i8042_command_write(i8042_CMD_KBD);
		117	wait_ready();
		118	i8042_data_write(i8042_KBD_DISABLE);
		119	wait_ready();
		120
		121	/* Flush all current IO */
		122	while (i8042_status_read() & i8042_OUTPUT_FULL)
		123	i8042_data_read();
		124
		125	/* Initialize mouse */
		126	/* i8042_command_write(i8042_CMD_MOUSE);
		127	wait_ready();
		128	i8042_data_write(MOUSE_OUT_INIT);
		129	wait_ready();
		130
		131	int mouseanswer = 0;
		132	for (i=0;i < 1000; i++) {
		133	int status = i8042_status_read();
		134	if (status & i8042_OUTPUT_FULL) {
		135	int data = i8042_data_read();
		136	if (status & i8042_MOUSE_DATA) {
		137	mouseanswer = data;
		138	break;
		139	}
		140	}
		141	usleep(1000);
		142	}*/
		143	// if (mouseanswer == MOUSE_ACK) {
		144	// /* enable mouse */
		145	// mouseenabled = 1;
		146	//
		147	// ipc_register_irq(sysinfo_value("mouse.inr"), sysinfo_value("mouse.devno"), 0, &i8042_kbd);
		148	// }
		149
		150	/* Enable kbd */
		151	ipc_register_irq(sysinfo_value("kbd.inr"), sysinfo_value("kbd.devno"), 0, &i8042_kbd);
		152
		153	int newcontrol = i8042_KBD_IE \| i8042_KBD_TRANSLATE;
		154	if (mouseenabled)
		155	newcontrol \|= i8042_MOUSE_IE;
		156
		157	i8042_command_write(i8042_CMD_KBD);
		158	wait_ready();
		159	i8042_data_write(newcontrol);
		160	wait_ready();
		161
		162	return 0;
		163	}
		164
		165	static void i8042_irq_handler(ipc_callid_t iid, ipc_call_t *call)
		166	{
		167	int status = IPC_GET_ARG1(*call);
		168
		169	if ((status & i8042_MOUSE_DATA))
		170	return 0;
		171
		172	int scan_code = IPC_GET_ARG2(*call);
		173
		174	kbd_push_scancode(scan_code);
		175	return 1;
		176	}
		177
		178	/**
		179	* @}
		180	*/

Subversion Repositories HelenOS

(root)/trunk/uspace/srv/kbd/port/i8042.c/ – Rev 3947