Rev 1476 | Rev 1487 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed
Rev | Author | Line No. | Line |
---|---|---|---|
1445 | cejka | 1 | /* |
2 | * Copyright (C) 2006 Josef Cejka |
||
3 | * All rights reserved. |
||
4 | * |
||
5 | * Redistribution and use in source and binary forms, with or without |
||
6 | * modification, are permitted provided that the following conditions |
||
7 | * are met: |
||
8 | * |
||
9 | * - Redistributions of source code must retain the above copyright |
||
10 | * notice, this list of conditions and the following disclaimer. |
||
11 | * - Redistributions in binary form must reproduce the above copyright |
||
12 | * notice, this list of conditions and the following disclaimer in the |
||
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 |
||
15 | * derived from this software without specific prior written permission. |
||
16 | * |
||
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 |
||
19 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
||
20 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
||
21 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
||
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 |
||
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 |
||
26 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
||
27 | */ |
||
28 | |||
29 | |||
30 | #include <kbd.h> |
||
1451 | cejka | 31 | #include <fb.h> |
1445 | cejka | 32 | #include <ipc/ipc.h> |
1451 | cejka | 33 | #include <ipc/fb.h> |
1445 | cejka | 34 | #include <ipc/services.h> |
35 | #include <errno.h> |
||
1451 | cejka | 36 | #include <key_buffer.h> |
37 | #include <console.h> |
||
1453 | palkovsky | 38 | #include <unistd.h> |
39 | #include <async.h> |
||
1481 | cejka | 40 | #include <libadt/fifo.h> |
1445 | cejka | 41 | |
1466 | palkovsky | 42 | static void sysput(char c) |
43 | { |
||
44 | __SYSCALL3(SYS_IO, 1, &c, 1); |
||
45 | |||
46 | } |
||
1451 | cejka | 47 | //#define CONSOLE_COUNT VFB_CONNECTIONS |
1476 | cejka | 48 | #define CONSOLE_COUNT 8 |
1481 | cejka | 49 | #define MAX_KEYREQUESTS_BUFFERED 32 |
1451 | cejka | 50 | |
1445 | cejka | 51 | #define NAME "CONSOLE" |
52 | |||
1476 | cejka | 53 | int active_console = 1; |
1453 | palkovsky | 54 | |
1451 | cejka | 55 | typedef struct { |
56 | keybuffer_t keybuffer; |
||
1481 | cejka | 57 | FIFO_CREATE_STATIC(keyrequests, ipc_callid_t , MAX_KEYREQUESTS_BUFFERED); |
58 | int keyrequest_counter; |
||
1451 | cejka | 59 | int client_phone; |
60 | int vfb_phone; |
||
61 | int used; |
||
62 | } connection_t; |
||
63 | |||
64 | connection_t connections[CONSOLE_COUNT]; |
||
65 | |||
66 | static int find_free_connection() |
||
67 | { |
||
68 | int i = 0; |
||
69 | |||
70 | while (i < CONSOLE_COUNT) { |
||
71 | if (connections[i].used == 0) |
||
72 | return i; |
||
73 | ++i; |
||
74 | } |
||
75 | return CONSOLE_COUNT; |
||
76 | } |
||
77 | |||
78 | |||
79 | static int find_connection(int client_phone) |
||
80 | { |
||
81 | int i = 0; |
||
82 | |||
83 | while (i < CONSOLE_COUNT) { |
||
84 | if (connections[i].client_phone == client_phone) |
||
85 | return i; |
||
86 | ++i; |
||
87 | } |
||
88 | return CONSOLE_COUNT; |
||
89 | } |
||
90 | |||
1453 | palkovsky | 91 | /* Handler for keyboard */ |
92 | static void keyboard_events(ipc_callid_t iid, ipc_call_t *icall) |
||
1445 | cejka | 93 | { |
1453 | palkovsky | 94 | ipc_callid_t callid; |
1445 | cejka | 95 | ipc_call_t call; |
1453 | palkovsky | 96 | int retval; |
97 | int i; |
||
1476 | cejka | 98 | char c; |
1453 | palkovsky | 99 | |
100 | /* Ignore parameters, the connection is alread opened */ |
||
101 | while (1) { |
||
102 | callid = async_get_call(&call); |
||
103 | switch (IPC_GET_METHOD(call)) { |
||
104 | case IPC_M_PHONE_HUNGUP: |
||
105 | ipc_answer_fast(callid,0,0,0); |
||
106 | /* TODO: Handle hangup */ |
||
107 | return; |
||
108 | case KBD_PUSHCHAR: |
||
109 | /* got key from keyboard driver */ |
||
1465 | cejka | 110 | |
1453 | palkovsky | 111 | retval = 0; |
1476 | cejka | 112 | c = IPC_GET_ARG1(call); |
113 | // ipc_call_sync_2(connections[3].vfb_phone, FB_PUTCHAR, 0, c,NULL,NULL); |
||
1481 | cejka | 114 | |
1453 | palkovsky | 115 | /* switch to another virtual console */ |
1481 | cejka | 116 | |
1476 | cejka | 117 | if ((c >= KBD_KEY_F1) && (c < KBD_KEY_F1 + CONSOLE_COUNT)) { |
118 | active_console = c - KBD_KEY_F1; |
||
1453 | palkovsky | 119 | break; |
120 | } |
||
1481 | cejka | 121 | |
122 | /* if client is awaiting key, send it */ |
||
123 | if (connections[active_console].keyrequest_counter > 0) { |
||
124 | connections[active_console].keyrequest_counter--; |
||
125 | ipc_answer_fast(fifo_pop(connections[active_console].keyrequests), 0, c, 0); |
||
126 | break; |
||
127 | } |
||
128 | |||
129 | /*FIXME: else store key to its buffer */ |
||
1476 | cejka | 130 | keybuffer_push(&(connections[active_console].keybuffer), c); |
131 | |||
1453 | palkovsky | 132 | /* Send it to first FB, DEBUG */ |
1459 | palkovsky | 133 | // ipc_call_async_2(connections[0].vfb_phone, FB_PUTCHAR, 0, IPC_GET_ARG1(call),NULL,NULL); |
1476 | cejka | 134 | // ipc_call_sync_2(connections[4].vfb_phone, FB_PUTCHAR, 0, c,NULL,NULL); |
1459 | palkovsky | 135 | |
1453 | palkovsky | 136 | break; |
137 | default: |
||
1459 | palkovsky | 138 | retval = ENOENT; |
1453 | palkovsky | 139 | } |
1459 | palkovsky | 140 | ipc_answer_fast(callid, retval, 0, 0); |
1453 | palkovsky | 141 | } |
142 | } |
||
143 | |||
144 | /** Default thread for new connections */ |
||
145 | void client_connection(ipc_callid_t iid, ipc_call_t *icall) |
||
146 | { |
||
1445 | cejka | 147 | ipc_callid_t callid; |
1453 | palkovsky | 148 | ipc_call_t call; |
149 | int consnum; |
||
150 | ipcarg_t arg1; |
||
151 | |||
152 | if ((consnum = find_free_connection()) == CONSOLE_COUNT) { |
||
153 | ipc_answer_fast(iid,ELIMIT,0,0); |
||
154 | return; |
||
155 | } |
||
156 | connections[consnum].used = 1; |
||
157 | connections[consnum].client_phone = IPC_GET_ARG3(call); |
||
158 | |||
159 | /* Accept the connection */ |
||
160 | ipc_answer_fast(iid,0,0,0); |
||
161 | |||
162 | while (1) { |
||
163 | callid = async_get_call(&call); |
||
164 | switch (IPC_GET_METHOD(call)) { |
||
165 | case IPC_M_PHONE_HUNGUP: |
||
166 | /* TODO */ |
||
167 | ipc_answer_fast(callid, 0,0,0); |
||
168 | return; |
||
169 | case CONSOLE_PUTCHAR: |
||
1476 | cejka | 170 | if (consnum != active_console) { |
171 | } |
||
1465 | cejka | 172 | /* Send message to fb */ |
1476 | cejka | 173 | ipc_call_sync_2(connections[consnum].vfb_phone, FB_PUTCHAR, IPC_GET_ARG1(call), IPC_GET_ARG2(call), NULL, NULL); |
174 | // ipc_call_sync_2(connections[6].vfb_phone, FB_PUTCHAR, 0, IPC_GET_ARG2(call),NULL,NULL); |
||
1453 | palkovsky | 175 | break; |
1476 | cejka | 176 | case CONSOLE_CLEAR: |
177 | break; |
||
178 | case CONSOLE_GOTO: |
||
179 | break; |
||
180 | |||
1453 | palkovsky | 181 | case CONSOLE_GETCHAR: |
1481 | cejka | 182 | if (keybuffer_empty(&(connections[consnum].keybuffer))) { |
183 | /* buffer is empty -> store request */ |
||
184 | if (connections[consnum].keyrequest_counter < MAX_KEYREQUESTS_BUFFERED) { |
||
185 | fifo_push(connections[consnum].keyrequests, callid); |
||
186 | connections[consnum].keyrequest_counter++; |
||
187 | } else { |
||
188 | /* no key available and too many requests => fail */ |
||
189 | ipc_answer_fast(callid, ELIMIT, 0, 0); |
||
190 | } |
||
191 | continue; |
||
1453 | palkovsky | 192 | }; |
1476 | cejka | 193 | keybuffer_pop(&(connections[consnum].keybuffer), (char *)&arg1); |
194 | // ipc_call_sync_2(connections[6].vfb_phone, FB_PUTCHAR, 0, arg1,NULL,NULL); |
||
1465 | cejka | 195 | |
1453 | palkovsky | 196 | break; |
197 | } |
||
1465 | cejka | 198 | ipc_answer_fast(callid, 0, arg1, 0); |
1453 | palkovsky | 199 | } |
200 | } |
||
201 | |||
202 | int main(int argc, char *argv[]) |
||
203 | { |
||
204 | ipcarg_t phonehash; |
||
1451 | cejka | 205 | int kbd_phone, fb_phone; |
1445 | cejka | 206 | ipcarg_t retval, arg1 = 0xdead, arg2 = 0xbeef; |
1451 | cejka | 207 | int i; |
1445 | cejka | 208 | |
209 | /* Connect to keyboard driver */ |
||
210 | |||
1451 | cejka | 211 | while ((kbd_phone = ipc_connect_me_to(PHONE_NS, SERVICE_KEYBOARD, 0)) < 0) { |
1453 | palkovsky | 212 | usleep(10000); |
1445 | cejka | 213 | }; |
214 | |||
1453 | palkovsky | 215 | if (ipc_connect_to_me(kbd_phone, SERVICE_CONSOLE, 0, &phonehash) != 0) { |
1445 | cejka | 216 | return -1; |
217 | }; |
||
1453 | palkovsky | 218 | async_new_connection(phonehash, 0, NULL, keyboard_events); |
1445 | cejka | 219 | |
220 | /* Connect to framebuffer driver */ |
||
221 | |||
1451 | cejka | 222 | for (i = 0; i < CONSOLE_COUNT; i++) { |
223 | connections[i].used = 0; |
||
224 | keybuffer_init(&(connections[i].keybuffer)); |
||
1481 | cejka | 225 | |
1451 | cejka | 226 | /* TODO: init key_buffer */ |
227 | while ((connections[i].vfb_phone = ipc_connect_me_to(PHONE_NS, SERVICE_VIDEO, 0)) < 0) { |
||
1465 | cejka | 228 | usleep(10000); |
1451 | cejka | 229 | } |
1481 | cejka | 230 | connections[i].keyrequests.head = connections[i].keyrequests.tail = 0; |
231 | connections[i].keyrequests.items = MAX_KEYREQUESTS_BUFFERED; |
||
232 | connections[i].keyrequest_counter = 0; |
||
1451 | cejka | 233 | } |
1445 | cejka | 234 | |
1453 | palkovsky | 235 | if (ipc_connect_to_me(PHONE_NS, SERVICE_CONSOLE, 0, &phonehash) != 0) { |
1445 | cejka | 236 | return -1; |
237 | }; |
||
238 | |||
1453 | palkovsky | 239 | async_manager(); |
1451 | cejka | 240 | |
1445 | cejka | 241 | return 0; |
242 | } |