38,9 → 38,67 |
#include <kbd.h> |
#include <libadt/fifo.h> |
#include <key_buffer.h> |
#include <async.h> |
|
#define NAME "KBD" |
|
int cons_connected = 0; |
int phone2cons = -1; |
keybuffer_t keybuffer; |
|
static void irq_handler(ipc_callid_t iid, ipc_call_t *call) |
{ |
int chr; |
|
if (cons_connected && phone2cons != -1) { |
/* recode to ASCII - one interrupt can produce more than one code so result is stored in fifo */ |
kbd_arch_process(&keybuffer, IPC_GET_ARG2(*call)); |
|
while (!keybuffer_empty(&keybuffer)) { |
if (!keybuffer_pop(&keybuffer, (int *)&chr)) |
break; |
|
async_msg(phone2cons, KBD_PUSHCHAR, chr); |
} |
} |
} |
|
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_fast(iid, ELIMIT, 0, 0); |
return; |
} |
cons_connected = 1; |
ipc_answer_fast(iid, 0, 0, 0); |
|
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_fast(callid, 0,0,0); |
return; |
case IPC_M_CONNECT_TO_ME: |
if (phone2cons != -1) { |
retval = ELIMIT; |
break; |
} |
phone2cons = IPC_GET_ARG3(call); |
retval = 0; |
break; |
} |
ipc_answer_fast(callid, retval, 0, 0); |
} |
} |
|
|
int main(int argc, char **argv) |
{ |
ipc_call_t call; |
49,12 → 107,8 |
ipcarg_t phonead; |
ipcarg_t phoneid; |
char connected = 0; |
keybuffer_t keybuffer; |
ipcarg_t retval, arg1, arg2; |
|
//open("null",0); |
//open("stdout",0); |
|
/* Initialize arch dependent parts */ |
if (!(res = kbd_arch_init())) { |
return -1; |
67,57 → 121,10 |
|
if ((res = ipc_connect_to_me(PHONE_NS, SERVICE_KEYBOARD, 0, &phonead)) != 0) { |
return -1; |
}; |
while (1) { |
callid = ipc_wait_for_call(&call); |
switch (IPC_GET_METHOD(call)) { |
case IPC_M_PHONE_HUNGUP: |
connected = 0; |
retval = 0; |
break; |
case IPC_M_CONNECT_ME_TO: |
/* Only one connected client allowed */ |
if (connected) { |
retval = ELIMIT; |
} else { |
retval = 0; |
connected = 1; |
} |
break; |
case IPC_M_CONNECT_TO_ME: |
phoneid = IPC_GET_ARG3(call); |
retval = 0; |
break; |
} |
|
case IPC_M_INTERRUPT: |
if (connected) { |
int chr; |
/* recode to ASCII - one interrupt can produce more than one code so result is stored in fifo */ |
kbd_arch_process(&keybuffer, IPC_GET_ARG2(call)); |
async_set_client_connection(console_connection); |
async_set_interrupt_received(irq_handler); |
async_manager(); |
|
retval = 0; |
|
|
while (!keybuffer_empty(&keybuffer)) { |
if (!keybuffer_pop(&keybuffer, (int *)&chr)) { |
break; |
} |
{ |
arg1=chr; |
send_call(phoneid, KBD_PUSHCHAR, arg1); |
} |
} |
|
} |
break; |
default: |
retval = ENOENT; |
break; |
} |
|
if (! (callid & IPC_CALLID_NOTIFICATION)) { |
ipc_answer_fast(callid, retval, arg1, arg2); |
} |
} |
} |
|