WebSVN – HelenOS – Diff – /branches/dynload/uspace/srv/kbd/generic/kbd.c


/*
 * 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 kbdgen generic
 * @brief   HelenOS generic uspace keyboard handler.
 * @ingroup  kbd
 * @{
 */
/** @file
 */
 
#include <ipc/ipc.h>
#include <ipc/services.h>
#include <sysinfo.h>
#include <stdio.h>
#include <unistd.h>
#include <stdlib.h>
#include <stdio.h>
#include <ipc/ns.h>
#include <async.h>
#include <errno.h>
#include <libadt/fifo.h>
#include <kbd/kbd.h>
#include <kbd/keycode.h>
 
#include <kbd.h>
#include <key_buffer.h>
#include <kbd_port.h>
#include <kbd_ctl.h>
#include <layout.h>
 
#define NAME "kbd"
 
int cons_connected = 0;
int phone2cons = -1;
keybuffer_t keybuffer;
 
/** Currently active modifiers. */
static unsigned mods = KM_NUM_LOCK;
 
/** Currently pressed lock keys. We track these to tackle autorepeat. */
static unsigned lock_keys;
 
int cir_service = 0;
int cir_phone = -1;
 
void kbd_push_scancode(int scancode)
{
/*  printf("scancode: 0x%x\n", scancode);*/
    kbd_ctl_parse_scancode(scancode);
}
 
void kbd_push_ev(int type, unsigned int key)
{
    kbd_event_t ev;
    unsigned mod_mask;
 
    switch (key) {
    case KC_LCTRL: mod_mask = KM_LCTRL; break;
    case KC_RCTRL: mod_mask = KM_RCTRL; break;
    case KC_LSHIFT: mod_mask = KM_LSHIFT; break;
    case KC_RSHIFT: mod_mask = KM_RSHIFT; break;
    case KC_LALT: mod_mask = KM_LALT; break;
    case KC_RALT: mod_mask = KM_RALT; break;
    default: mod_mask = 0; break;
    }
 
    if (mod_mask != 0) {
        if (type == KE_PRESS)
            mods = mods | mod_mask;
        else
            mods = mods & ~mod_mask;
    }
 
    switch (key) {
    case KC_CAPS_LOCK: mod_mask = KM_CAPS_LOCK; break;
    case KC_NUM_LOCK: mod_mask = KM_NUM_LOCK; break;
    case KC_SCROLL_LOCK: mod_mask = KM_SCROLL_LOCK; break;
    default: mod_mask = 0; break;
    }
 
    if (mod_mask != 0) {
        if (type == KE_PRESS) {
            /*
             * Only change lock state on transition from released
             * to pressed. This prevents autorepeat from messing
             * up the lock state.
             */
            mods = mods ^ (mod_mask & ~lock_keys);
            lock_keys = lock_keys | mod_mask;
        } else {
            lock_keys = lock_keys & ~mod_mask;
        }
    }
/*
    printf("type: %d\n", type);
    printf("mods: 0x%x\n", mods);
    printf("keycode: %u\n", key);
*/
    ev.type = type;
    ev.key = key;
    ev.mods = mods;
 
    ev.c = layout_parse_ev(&ev);
 
    async_msg_4(phone2cons, KBD_EVENT, ev.type, ev.key, ev.mods, ev.c);
}
 
static void console_connection(ipc_callid_t iid, ipc_call_t *icall)
{
    ipc_callid_t callid;
    ipc_call_t call;
    int retval;
 
    if (cons_connected) {
        ipc_answer_0(iid, ELIMIT);
        return;
    }
    cons_connected = 1;
    ipc_answer_0(iid, EOK);
 
    while (1) {
        callid = async_get_call(&call);
        switch (IPC_GET_METHOD(call)) {
        case IPC_M_PHONE_HUNGUP:
            cons_connected = 0;
            ipc_hangup(phone2cons);
            phone2cons = -1;
            ipc_answer_0(callid, EOK);
            return;
        case IPC_M_CONNECT_TO_ME:
            if (phone2cons != -1) {
                retval = ELIMIT;
                break;
            }
            phone2cons = IPC_GET_ARG5(call);
            retval = 0;
            break;
        default:
            retval = EINVAL;
        }
        ipc_answer_0(callid, retval);
    }  
}
 
 
int main(int argc, char **argv)
{
    printf(NAME ": HelenOS Keyboard service\n");
   
    ipcarg_t phonead;
   
    if (sysinfo_value("kbd.cir.fhc") == 1)
        cir_service = SERVICE_FHC;
    else if (sysinfo_value("kbd.cir.obio") == 1)
        cir_service = SERVICE_OBIO;
   
    if (cir_service) {
        while (cir_phone < 0) {
            cir_phone = ipc_connect_me_to_blocking(PHONE_NS, cir_service,
                0, 0);
        }
    }
   
    /* Initialize port driver. */
    if (kbd_port_init())
        return -1;
   
    /* Initialize key buffer */
    keybuffer_init(&keybuffer);
   
    async_set_client_connection(console_connection);
 
    /* Register service at nameserver. */
    if (ipc_connect_to_me(PHONE_NS, SERVICE_KEYBOARD, 0, 0, &phonead) != 0)
        return -1;
   
    printf(NAME ": Accepting connections\n");
    async_manager();
 
    /* Not reached. */
    return 0;
}
 
/**
 * @}
 */
 

Rev 4344	Rev 4345
1	/*	1	/*
2	* Copyright (c) 2006 Josef Cejka	2	* Copyright (c) 2006 Josef Cejka
3	* All rights reserved.	3	* All rights reserved.
4	*	4	*
5	* Redistribution and use in source and binary forms, with or without	5	* Redistribution and use in source and binary forms, with or without
6	* modification, are permitted provided that the following conditions	6	* modification, are permitted provided that the following conditions
7	* are met:	7	* are met:
8	*	8	*
9	* - Redistributions of source code must retain the above copyright	9	* - Redistributions of source code must retain the above copyright
10	* notice, this list of conditions and the following disclaimer.	10	* notice, this list of conditions and the following disclaimer.
11	* - Redistributions in binary form must reproduce the above copyright	11	* - Redistributions in binary form must reproduce the above copyright
12	* notice, this list of conditions and the following disclaimer in the	12	* notice, this list of conditions and the following disclaimer in the
13	* documentation and/or other materials provided with the distribution.	13	* documentation and/or other materials provided with the distribution.
14	* - The name of the author may not be used to endorse or promote products	14	* - The name of the author may not be used to endorse or promote products
15	* derived from this software without specific prior written permission.	15	* derived from this software without specific prior written permission.
16	*	16	*
17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27	*/	27	*/
28		28
29	/**	29	/**
30	* @addtogroup kbdgen generic	30	* @addtogroup kbdgen generic
31	* @brief HelenOS generic uspace keyboard handler.	31	* @brief HelenOS generic uspace keyboard handler.
32	* @ingroup kbd	32	* @ingroup kbd
33	* @{	33	* @{
34	*/	34	*/
35	/** @file	35	/** @file
36	*/	36	*/
37		37
38	#include <ipc/ipc.h>	38	#include <ipc/ipc.h>
39	#include <ipc/services.h>	39	#include <ipc/services.h>
40	#include <sysinfo.h>	40	#include <sysinfo.h>
41	#include <stdio.h>	41	#include <stdio.h>
42	#include <unistd.h>	42	#include <unistd.h>
43	#include <stdlib.h>	43	#include <stdlib.h>
44	#include <stdio.h>	44	#include <stdio.h>
45	#include <ipc/ns.h>	45	#include <ipc/ns.h>
46	#include <async.h>	46	#include <async.h>
47	#include <errno.h>	47	#include <errno.h>
48	#include <libadt/fifo.h>	48	#include <libadt/fifo.h>
49	#include <kbd/kbd.h>	49	#include <kbd/kbd.h>
50	#include <kbd/keycode.h>	50	#include <kbd/keycode.h>
51		51
52	#include <kbd.h>	52	#include <kbd.h>
53	#include <key_buffer.h>	53	#include <key_buffer.h>
54	#include <kbd_port.h>	54	#include <kbd_port.h>
55	#include <kbd_ctl.h>	55	#include <kbd_ctl.h>
56	#include <layout.h>	56	#include <layout.h>
57		57
58	#define NAME "kbd"	58	#define NAME "kbd"
59		59
60	int cons_connected = 0;	60	int cons_connected = 0;
61	int phone2cons = -1;	61	int phone2cons = -1;
62	keybuffer_t keybuffer;	62	keybuffer_t keybuffer;
63		63
64	/** Currently active modifiers. */	64	/** Currently active modifiers. */
65	static unsigned mods = KM_NUM_LOCK;	65	static unsigned mods = KM_NUM_LOCK;
66		66
67	/** Currently pressed lock keys. We track these to tackle autorepeat. */	67	/** Currently pressed lock keys. We track these to tackle autorepeat. */
68	static unsigned lock_keys;	68	static unsigned lock_keys;
69		69
70	int cir_service = 0;	70	int cir_service = 0;
71	int cir_phone = -1;	71	int cir_phone = -1;
72		72
73	void kbd_push_scancode(int scancode)	73	void kbd_push_scancode(int scancode)
74	{	74	{
75	/* printf("scancode: 0x%x\n", scancode);*/	75	/* printf("scancode: 0x%x\n", scancode);*/
76	kbd_ctl_parse_scancode(scancode);	76	kbd_ctl_parse_scancode(scancode);
77	}	77	}
78		78
79	void kbd_push_ev(int type, unsigned int key)	79	void kbd_push_ev(int type, unsigned int key)
80	{	80	{
81	kbd_event_t ev;	81	kbd_event_t ev;
82	unsigned mod_mask;	82	unsigned mod_mask;
83		83
84	switch (key) {	84	switch (key) {
85	case KC_LCTRL: mod_mask = KM_LCTRL; break;	85	case KC_LCTRL: mod_mask = KM_LCTRL; break;
86	case KC_RCTRL: mod_mask = KM_RCTRL; break;	86	case KC_RCTRL: mod_mask = KM_RCTRL; break;
87	case KC_LSHIFT: mod_mask = KM_LSHIFT; break;	87	case KC_LSHIFT: mod_mask = KM_LSHIFT; break;
88	case KC_RSHIFT: mod_mask = KM_RSHIFT; break;	88	case KC_RSHIFT: mod_mask = KM_RSHIFT; break;
89	case KC_LALT: mod_mask = KM_LALT; break;	89	case KC_LALT: mod_mask = KM_LALT; break;
90	case KC_RALT: mod_mask = KM_RALT; break;	90	case KC_RALT: mod_mask = KM_RALT; break;
91	default: mod_mask = 0; break;	91	default: mod_mask = 0; break;
92	}	92	}
93		93
94	if (mod_mask != 0) {	94	if (mod_mask != 0) {
95	if (type == KE_PRESS)	95	if (type == KE_PRESS)
96	mods = mods \| mod_mask;	96	mods = mods \| mod_mask;
97	else	97	else
98	mods = mods & ~mod_mask;	98	mods = mods & ~mod_mask;
99	}	99	}
100		100
101	switch (key) {	101	switch (key) {
102	case KC_CAPS_LOCK: mod_mask = KM_CAPS_LOCK; break;	102	case KC_CAPS_LOCK: mod_mask = KM_CAPS_LOCK; break;
103	case KC_NUM_LOCK: mod_mask = KM_NUM_LOCK; break;	103	case KC_NUM_LOCK: mod_mask = KM_NUM_LOCK; break;
104	case KC_SCROLL_LOCK: mod_mask = KM_SCROLL_LOCK; break;	104	case KC_SCROLL_LOCK: mod_mask = KM_SCROLL_LOCK; break;
105	default: mod_mask = 0; break;	105	default: mod_mask = 0; break;
106	}	106	}
107		107
108	if (mod_mask != 0) {	108	if (mod_mask != 0) {
109	if (type == KE_PRESS) {	109	if (type == KE_PRESS) {
110	/*	110	/*
111	* Only change lock state on transition from released	111	* Only change lock state on transition from released
112	* to pressed. This prevents autorepeat from messing	112	* to pressed. This prevents autorepeat from messing
113	* up the lock state.	113	* up the lock state.
114	*/	114	*/
115	mods = mods ^ (mod_mask & ~lock_keys);	115	mods = mods ^ (mod_mask & ~lock_keys);
116	lock_keys = lock_keys \| mod_mask;	116	lock_keys = lock_keys \| mod_mask;
117	} else {	117	} else {
118	lock_keys = lock_keys & ~mod_mask;	118	lock_keys = lock_keys & ~mod_mask;
119	}	119	}
120	}	120	}
121	/*	121	/*
122	printf("type: %d\n", type);	122	printf("type: %d\n", type);
123	printf("mods: 0x%x\n", mods);	123	printf("mods: 0x%x\n", mods);
124	printf("keycode: %u\n", key);	124	printf("keycode: %u\n", key);
125	*/	125	*/
126	ev.type = type;	126	ev.type = type;
127	ev.key = key;	127	ev.key = key;
128	ev.mods = mods;	128	ev.mods = mods;
129		129
130	ev.c = layout_parse_ev(&ev);	130	ev.c = layout_parse_ev(&ev);
131		131
132	async_msg_4(phone2cons, KBD_EVENT, ev.type, ev.key, ev.mods, ev.c);	132	async_msg_4(phone2cons, KBD_EVENT, ev.type, ev.key, ev.mods, ev.c);
133	}	133	}
134		134
135	static void console_connection(ipc_callid_t iid, ipc_call_t *icall)	135	static void console_connection(ipc_callid_t iid, ipc_call_t *icall)
136	{	136	{
137	ipc_callid_t callid;	137	ipc_callid_t callid;
138	ipc_call_t call;	138	ipc_call_t call;
139	int retval;	139	int retval;
140		140
141	if (cons_connected) {	141	if (cons_connected) {
142	ipc_answer_0(iid, ELIMIT);	142	ipc_answer_0(iid, ELIMIT);
143	return;	143	return;
144	}	144	}
145	cons_connected = 1;	145	cons_connected = 1;
146	ipc_answer_0(iid, EOK);	146	ipc_answer_0(iid, EOK);
147		147
148	while (1) {	148	while (1) {
149	callid = async_get_call(&call);	149	callid = async_get_call(&call);
150	switch (IPC_GET_METHOD(call)) {	150	switch (IPC_GET_METHOD(call)) {
151	case IPC_M_PHONE_HUNGUP:	151	case IPC_M_PHONE_HUNGUP:
152	cons_connected = 0;	152	cons_connected = 0;
153	ipc_hangup(phone2cons);	153	ipc_hangup(phone2cons);
154	phone2cons = -1;	154	phone2cons = -1;
155	ipc_answer_0(callid, EOK);	155	ipc_answer_0(callid, EOK);
156	return;	156	return;
157	case IPC_M_CONNECT_TO_ME:	157	case IPC_M_CONNECT_TO_ME:
158	if (phone2cons != -1) {	158	if (phone2cons != -1) {
159	retval = ELIMIT;	159	retval = ELIMIT;
160	break;	160	break;
161	}	161	}
162	phone2cons = IPC_GET_ARG5(call);	162	phone2cons = IPC_GET_ARG5(call);
163	retval = 0;	163	retval = 0;
164	break;	164	break;
165	default:	165	default:
166	retval = EINVAL;	166	retval = EINVAL;
167	}	167	}
168	ipc_answer_0(callid, retval);	168	ipc_answer_0(callid, retval);
169	}	169	}
170	}	170	}
171		171
172		172
173	int main(int argc, char **argv)	173	int main(int argc, char **argv)
174	{	174	{
175	printf(NAME ": HelenOS Keyboard service\n");	175	printf(NAME ": HelenOS Keyboard service\n");
176		176
177	ipcarg_t phonead;	177	ipcarg_t phonead;
178		178
179	if (sysinfo_value("kbd.cir.fhc") == 1)	179	if (sysinfo_value("kbd.cir.fhc") == 1)
180	cir_service = SERVICE_FHC;	180	cir_service = SERVICE_FHC;
181	else if (sysinfo_value("kbd.cir.obio") == 1)	181	else if (sysinfo_value("kbd.cir.obio") == 1)
182	cir_service = SERVICE_OBIO;	182	cir_service = SERVICE_OBIO;
183		183
184	if (cir_service) {	184	if (cir_service) {
185	while (cir_phone < 0) {	185	while (cir_phone < 0) {
186	cir_phone = ipc_connect_me_to(PHONE_NS, cir_service,	186	cir_phone = ipc_connect_me_to_blocking(PHONE_NS, cir_service,
187	0, 0);	187	0, 0);
188	}	188	}
189	}	189	}
190		190
191	/* Initialize port driver. */	191	/* Initialize port driver. */
192	if (kbd_port_init())	192	if (kbd_port_init())
193	return -1;	193	return -1;
194		194
195	/* Initialize key buffer */	195	/* Initialize key buffer */
196	keybuffer_init(&keybuffer);	196	keybuffer_init(&keybuffer);
197		197
198	async_set_client_connection(console_connection);	198	async_set_client_connection(console_connection);
199		199
200	/* Register service at nameserver. */	200	/* Register service at nameserver. */
201	if (ipc_connect_to_me(PHONE_NS, SERVICE_KEYBOARD, 0, 0, &phonead) != 0)	201	if (ipc_connect_to_me(PHONE_NS, SERVICE_KEYBOARD, 0, 0, &phonead) != 0)
202	return -1;	202	return -1;
203		203
204	printf(NAME ": Accepting connections\n");	204	printf(NAME ": Accepting connections\n");
205	async_manager();	205	async_manager();
206		206
207	/* Not reached. */	207	/* Not reached. */
208	return 0;	208	return 0;
209	}	209	}
210		210
211	/**	211	/**
212	* @}	212	* @}
213	*/	213	*/
214		214

Subversion Repositories HelenOS

(root)/branches/dynload/uspace/srv/kbd/generic/kbd.c – Rev 4344 → 4345