0,0 → 1,158 |
/* |
* 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. |
*/ |
|
#include <ipc/ipc.h> |
#include <ipc/services.h> |
#include <stdio.h> |
#include <unistd.h> |
#include <stdlib.h> |
#include <ipc/ns.h> |
#include <errno.h> |
#include <arch/kbd.h> |
#include <kbd.h> |
#include <key_buffer.h> |
#include <fifo.h> |
|
#define NAME "KBD" |
|
#define KBD_REQUEST_MAX 32 /**< Maximum requests buffered until keypress */ |
|
int main(int argc, char **argv) |
{ |
ipc_call_t call; |
ipc_callid_t callid; |
char connected = 0; |
int res; |
int c; |
ipcarg_t phonead; |
|
ipcarg_t retval, arg1, arg2; |
|
/* Counter of unsatisfied calls */ |
fifo_count_t callers_counter = 0; |
/* Fifo with callid's of unsatisfied calls requred for answer */ |
FIFO_INITIALIZE_STATIC(callers_buffer, ipc_callid_t, KBD_REQUEST_MAX); |
|
printf("Uspace kbd service started.\n"); |
|
/* Initialize arch dependent parts */ |
if (!(res = kbd_arch_init())) { |
printf("Kbd registration failed with retval %d.\n", res); |
return -1; |
}; |
|
/* Initialize key buffer */ |
key_buffer_init(); |
|
/* Register service at nameserver */ |
printf("%s: Registering at naming service.\n", NAME); |
|
if ((res = ipc_connect_to_me(PHONE_NS, SERVICE_KEYBOARD, 0, &phonead)) != 0) { |
printf("%s: Error: Registering at naming service failed.\n", NAME); |
return -1; |
}; |
|
while (1) { |
callid = ipc_wait_for_call(&call, 0); |
// printf("%s:Call phone=%lX..", NAME, call.in_phone_hash); |
switch (IPC_GET_METHOD(call)) { |
case IPC_M_PHONE_HUNGUP: |
if (connected) { |
/* If nobody's connected, clear keybuffer and dont store new keys */ |
if (--connected == 0) { |
callers_counter = 0; |
callers_buffer.head = callers_buffer.tail = 0; |
key_buffer_free(); |
} |
|
printf("%s: Phone hung up.\n", NAME); |
} else { |
printf("%s: Oops, got phone hung up, but nobody connected.\n", NAME); |
} |
|
retval = 0; |
break; |
case IPC_M_CONNECT_ME_TO: |
// printf("%s: Connect me (%P) to: %zd\n",NAME, IPC_GET_ARG3(call), IPC_GET_ARG1(call)); |
/* Only one connected client allowed */ |
if (connected) { |
retval = ELIMIT; |
} else { |
retval = 0; |
connected = 1; |
} |
break; |
case IPC_M_INTERRUPT: |
if (connected) { |
/* recode scancode and store it into key buffer */ |
kbd_arch_process(IPC_GET_ARG2(call)); |
//printf("%s: GOT INTERRUPT: %c\n", NAME, IPC_GET_ARG2(call)); |
|
/* Some callers could awaiting keypress - if its true, we have to send keys to them. |
* One interrupt can store more than one key into buffer. */ |
retval = 0; |
arg2 = 0xbeef; |
while ((callers_counter) && (!key_buffer_empty())) { |
callers_counter--; |
if (!key_buffer_pop((char *)&arg1)) { |
printf("%s: KeyBuffer empty but it should not be.\n"); |
break; |
} |
ipc_answer_fast(fifo_pop(callers_buffer), retval, arg1, arg2); |
} |
} |
break; |
case KBD_GETCHAR: |
// printf("%s: Getchar: ", NAME); |
retval = 0; |
arg1 = 0; |
if (!key_buffer_pop((char *)&arg1)) { |
if (callers_counter < KBD_REQUEST_MAX) { |
callers_counter++; |
fifo_push(callers_buffer, callid); |
} else { |
retval = ELIMIT; |
} |
continue; |
}; |
arg2 = 0xbeef; |
// printf("GetChar return %c\n", arg1); |
|
break; |
default: |
printf("%s: Unknown method: %zd\n", NAME, IPC_GET_METHOD(call)); |
retval = ENOENT; |
break; |
} |
|
if (! (callid & IPC_CALLID_NOTIFICATION)) { |
ipc_answer_fast(callid, retval, arg1, arg2); |
} |
} |
} |
|