source: mainline/console/console.c@ 41269bd

lfn serial ticket/834-toolchain-update topic/msim-upgrade topic/simplify-dev-export
Last change on this file since 41269bd was 41269bd, checked in by Ondrej Palkovsky <ondrap@…>, 19 years ago

Fixed race condition in async framework on phone disconnect.
  • Property mode set to 100644
File size: 13.1 KB
Line 
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/* TODO: remove */
29#include <stdio.h>
30
31
32#include <kbd.h>
33#include <fb.h>
34#include <ipc/ipc.h>
35#include <ipc/fb.h>
36#include <ipc/services.h>
37#include <errno.h>
38#include <key_buffer.h>
39#include <console.h>
40#include <unistd.h>
41#include <async.h>
42#include <libadt/fifo.h>
43#include <screenbuffer.h>
44#include <sys/mman.h>
45
46#include "gcons.h"
47
48#define MAX_KEYREQUESTS_BUFFERED 32
49
50#define NAME "CONSOLE"
51
52/** Index of currently used virtual console.
53 */
54int active_console = 0;
55
56/** Information about framebuffer
57 */
58struct {
59 int phone; /**< Framebuffer phone */
60 ipcarg_t rows; /**< Framebuffer rows */
61 ipcarg_t cols; /**< Framebuffer columns */
62} fb_info;
63
64
65typedef struct {
66 keybuffer_t keybuffer; /**< Buffer for incoming keys. */
67 FIFO_CREATE_STATIC(keyrequests, ipc_callid_t , MAX_KEYREQUESTS_BUFFERED); /**< Buffer for unsatisfied request for keys. */
68 int keyrequest_counter; /**< Number of requests in buffer. */
69 int client_phone; /**< Phone to connected client. */
70 int used; /**< 1 if this virtual console is connected to some client.*/
71 screenbuffer_t screenbuffer; /**< Screenbuffer for saving screen contents and related settings. */
72} connection_t;
73
74static connection_t connections[CONSOLE_COUNT]; /**< Array of data for virtual consoles */
75static keyfield_t *interbuffer = NULL; /**< Pointer to memory shared with framebufer used for faster virt. console switching */
76
77static int kernel_pixmap = -1; /**< Number of fb pixmap, where kernel console is stored */
78
79
80/** Find unused virtual console.
81 *
82 */
83static int find_free_connection(void)
84{
85 int i = 0;
86
87 for (i=0; i < CONSOLE_COUNT; i++) {
88 if (!connections[i].used)
89 return i;
90 }
91 return -1;
92}
93
94static void clrscr(void)
95{
96 async_msg(fb_info.phone, FB_CLEAR, 0);
97}
98
99static void curs_visibility(int v)
100{
101 async_msg(fb_info.phone, FB_CURSOR_VISIBILITY, v);
102}
103
104static void curs_goto(int row, int col)
105{
106 async_msg_2(fb_info.phone, FB_CURSOR_GOTO, row, col);
107
108}
109
110static void set_style(style_t *style)
111{
112 async_msg_2(fb_info.phone, FB_SET_STYLE, style->fg_color, style->bg_color);
113}
114
115static void set_style_col(int fgcolor, int bgcolor)
116{
117 async_msg_2(fb_info.phone, FB_SET_STYLE, fgcolor, bgcolor);
118}
119
120static void prtchr(char c, int row, int col)
121{
122 async_msg_3(fb_info.phone, FB_PUTCHAR, c, row, col);
123
124}
125
126/** Check key and process special keys.
127 *
128 * */
129static void write_char(int console, char key)
130{
131 screenbuffer_t *scr = &(connections[console].screenbuffer);
132
133 switch (key) {
134 case '\n':
135 scr->position_y += 1;
136 scr->position_x = 0;
137 break;
138 case '\r':
139 break;
140 case '\t':
141 scr->position_x += 8;
142 scr->position_x -= scr->position_x % 8;
143 break;
144 case '\b':
145 if (scr->position_x == 0)
146 break;
147
148 scr->position_x--;
149
150 if (console == active_console)
151 prtchr(' ', scr->position_y, scr->position_x);
152
153 screenbuffer_putchar(scr, ' ');
154
155 break;
156 default:
157 if (console == active_console)
158 prtchr(key, scr->position_y, scr->position_x);
159
160 screenbuffer_putchar(scr, key);
161 scr->position_x++;
162 }
163
164 scr->position_y += (scr->position_x >= scr->size_x);
165
166 if (scr->position_y >= scr->size_y) {
167 scr->position_y = scr->size_y - 1;
168 screenbuffer_clear_line(scr, scr->top_line++);
169 if (console == active_console)
170 async_msg(fb_info.phone, FB_SCROLL, 1);
171 }
172
173 scr->position_x = scr->position_x % scr->size_x;
174
175 if (console == active_console)
176 curs_goto(scr->position_y, scr->position_x);
177
178}
179
180/** Save current screen to pixmap, draw old pixmap
181 *
182 * @param oldpixmap Old pixmap
183 * @return ID of pixmap of current screen
184 */
185static int switch_screens(int oldpixmap)
186{
187 int newpmap;
188
189 /* Save screen */
190 newpmap = async_req(fb_info.phone, FB_VP2PIXMAP, 0, NULL);
191 if (newpmap < 0)
192 return -1;
193
194 if (oldpixmap != -1) {
195 /* Show old screen */
196 async_msg_2(fb_info.phone, FB_VP_DRAW_PIXMAP, 0, oldpixmap);
197 /* Drop old pixmap */
198 async_msg(fb_info.phone, FB_DROP_PIXMAP, oldpixmap);
199 }
200
201 return newpmap;
202}
203
204/** Switch to new console */
205static void change_console(int newcons)
206{
207 connection_t *conn;
208 static int console_pixmap = -1;
209 int i, j;
210 keyfield_t *field;
211 style_t *style;
212 char c;
213
214 if (newcons == active_console)
215 return;
216
217 if (newcons == KERNEL_CONSOLE) {
218 if (active_console == KERNEL_CONSOLE)
219 return;
220 active_console = KERNEL_CONSOLE;
221 curs_visibility(0);
222
223 if (kernel_pixmap == -1) {
224 /* store/restore unsupported */
225 set_style_col(DEFAULT_FOREGROUND, DEFAULT_BACKGROUND);
226 clrscr();
227 } else {
228 gcons_in_kernel();
229 console_pixmap = switch_screens(kernel_pixmap);
230 kernel_pixmap = -1;
231 }
232
233 __SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE);
234 return;
235 }
236
237 if (console_pixmap != -1) {
238 kernel_pixmap = switch_screens(console_pixmap);
239 console_pixmap = -1;
240 }
241 active_console = newcons;
242 gcons_change_console(newcons);
243 conn = &connections[active_console];
244
245 set_style(&conn->screenbuffer.style);
246 curs_visibility(0);
247 if (interbuffer) {
248 for (i = 0; i < conn->screenbuffer.size_x; i++)
249 for (j = 0; j < conn->screenbuffer.size_y; j++)
250 interbuffer[i + j*conn->screenbuffer.size_x] = *get_field_at(&(conn->screenbuffer),i, j);
251 /* This call can preempt, but we are already at the end */
252 j = async_req_2(fb_info.phone, FB_DRAW_TEXT_DATA, 0, 0, NULL, NULL);
253 };
254
255 if ((!interbuffer) || (j != 0)){
256 set_style(&conn->screenbuffer.style);
257 clrscr();
258 style = &conn->screenbuffer.style;
259
260 for (j = 0; j < conn->screenbuffer.size_y; j++)
261 for (i = 0; i < conn->screenbuffer.size_x; i++) {
262 field = get_field_at(&(conn->screenbuffer),i, j);
263 if (!style_same(*style, field->style))
264 set_style(&field->style);
265 style = &field->style;
266 if ((field->character == ' ') && (style_same(field->style, conn->screenbuffer.style)))
267 continue;
268
269 prtchr(field->character, j, i);
270 }
271 }
272
273 curs_goto(conn->screenbuffer.position_y, conn->screenbuffer.position_x);
274 curs_visibility(conn->screenbuffer.is_cursor_visible);
275}
276
277/** Handler for keyboard */
278static void keyboard_events(ipc_callid_t iid, ipc_call_t *icall)
279{
280 ipc_callid_t callid;
281 ipc_call_t call;
282 int retval;
283 int c;
284 connection_t *conn;
285
286 /* Ignore parameters, the connection is alread opened */
287 while (1) {
288 callid = async_get_call(&call);
289 switch (IPC_GET_METHOD(call)) {
290 case IPC_M_PHONE_HUNGUP:
291 /* TODO: Handle hangup */
292 return;
293 case KBD_PUSHCHAR:
294 /* got key from keyboard driver */
295
296 retval = 0;
297 c = IPC_GET_ARG1(call);
298 /* switch to another virtual console */
299
300 conn = &connections[active_console];
301// if ((c >= KBD_KEY_F1) && (c < KBD_KEY_F1 + CONSOLE_COUNT)) {
302 if ((c >= 0x101) && (c < 0x101 + CONSOLE_COUNT)) {
303 async_serialize_start();
304 if (c == 0x112)
305 change_console(KERNEL_CONSOLE);
306 else
307 change_console(c - 0x101);
308 async_serialize_end();
309 break;
310 }
311
312 /* if client is awaiting key, send it */
313 if (conn->keyrequest_counter > 0) {
314 conn->keyrequest_counter--;
315 ipc_answer_fast(fifo_pop(conn->keyrequests), 0, c, 0);
316 break;
317 }
318
319 /*FIXME: else store key to its buffer */
320 keybuffer_push(&conn->keybuffer, c);
321
322 break;
323 default:
324 retval = ENOENT;
325 }
326 ipc_answer_fast(callid, retval, 0, 0);
327 }
328}
329
330/** Default thread for new connections */
331static void client_connection(ipc_callid_t iid, ipc_call_t *icall)
332{
333 ipc_callid_t callid;
334 ipc_call_t call;
335 int consnum;
336 ipcarg_t arg1, arg2;
337 connection_t *conn;
338
339 if ((consnum = find_free_connection()) == -1) {
340 ipc_answer_fast(iid,ELIMIT,0,0);
341 return;
342 }
343 conn = &connections[consnum];
344 conn->used = 1;
345
346 async_serialize_start();
347 gcons_notify_connect(consnum);
348 conn->client_phone = IPC_GET_ARG3(call);
349 screenbuffer_clear(&conn->screenbuffer);
350
351 /* Accept the connection */
352 ipc_answer_fast(iid,0,0,0);
353
354 while (1) {
355 async_serialize_end();
356 callid = async_get_call(&call);
357 async_serialize_start();
358
359 arg1 = arg2 = 0;
360 switch (IPC_GET_METHOD(call)) {
361 case IPC_M_PHONE_HUNGUP:
362 gcons_notify_disconnect(consnum);
363
364 /* Answer all pending requests */
365 while (conn->keyrequest_counter > 0) {
366 conn->keyrequest_counter--;
367 ipc_answer_fast(fifo_pop(conn->keyrequests), ENOENT, 0, 0);
368 break;
369 }
370 conn->used = 0;
371 return;
372 case CONSOLE_PUTCHAR:
373 write_char(consnum, IPC_GET_ARG1(call));
374 gcons_notify_char(consnum);
375 break;
376 case CONSOLE_CLEAR:
377 /* Send message to fb */
378 if (consnum == active_console) {
379 async_msg(fb_info.phone, FB_CLEAR, 0);
380 }
381
382 screenbuffer_clear(&conn->screenbuffer);
383
384 break;
385 case CONSOLE_GOTO:
386
387 screenbuffer_goto(&conn->screenbuffer, IPC_GET_ARG2(call), IPC_GET_ARG1(call));
388 if (consnum == active_console)
389 curs_goto(IPC_GET_ARG1(call),IPC_GET_ARG2(call));
390
391 break;
392
393 case CONSOLE_GETSIZE:
394 arg1 = fb_info.rows;
395 arg2 = fb_info.cols;
396 break;
397 case CONSOLE_FLUSH:
398 async_req_2(fb_info.phone, FB_FLUSH, 0, 0, NULL, NULL);
399 break;
400 case CONSOLE_SET_STYLE:
401
402 arg1 = IPC_GET_ARG1(call);
403 arg2 = IPC_GET_ARG2(call);
404 screenbuffer_set_style(&conn->screenbuffer,arg1, arg2);
405 if (consnum == active_console)
406 set_style_col(arg1, arg2);
407
408 break;
409 case CONSOLE_CURSOR_VISIBILITY:
410 arg1 = IPC_GET_ARG1(call);
411 conn->screenbuffer.is_cursor_visible = arg1;
412 if (consnum == active_console)
413 curs_visibility(arg1);
414 break;
415 case CONSOLE_GETCHAR:
416 if (keybuffer_empty(&conn->keybuffer)) {
417 /* buffer is empty -> store request */
418 if (conn->keyrequest_counter < MAX_KEYREQUESTS_BUFFERED) {
419 fifo_push(conn->keyrequests, callid);
420 conn->keyrequest_counter++;
421 } else {
422 /* no key available and too many requests => fail */
423 ipc_answer_fast(callid, ELIMIT, 0, 0);
424 }
425 continue;
426 };
427 keybuffer_pop(&conn->keybuffer, (int *)&arg1);
428
429 break;
430 }
431 ipc_answer_fast(callid, 0, arg1, arg2);
432 }
433}
434
435int main(int argc, char *argv[])
436{
437 ipcarg_t phonehash;
438 int kbd_phone, fb_phone;
439 ipcarg_t retval, arg1 = 0xdead, arg2 = 0xbeef;
440 int i;
441
442 async_set_client_connection(client_connection);
443
444 /* Connect to keyboard driver */
445
446 while ((kbd_phone = ipc_connect_me_to(PHONE_NS, SERVICE_KEYBOARD, 0)) < 0) {
447 usleep(10000);
448 };
449
450 if (ipc_connect_to_me(kbd_phone, SERVICE_CONSOLE, 0, &phonehash) != 0) {
451 return -1;
452 };
453
454 /* Connect to framebuffer driver */
455
456 while ((fb_info.phone = ipc_connect_me_to(PHONE_NS, SERVICE_VIDEO, 0)) < 0) {
457 usleep(10000);
458 }
459
460 /* Save old kernel screen */
461 kernel_pixmap = switch_screens(-1);
462
463 /* Initialize gcons */
464 gcons_init(fb_info.phone);
465 /* Synchronize, the gcons can have something in queue */
466 async_req(fb_info.phone, FB_FLUSH, 0, NULL);
467
468
469 async_req_2(fb_info.phone, FB_GET_CSIZE, 0, 0, &(fb_info.rows), &(fb_info.cols));
470 set_style_col(DEFAULT_FOREGROUND, DEFAULT_BACKGROUND);
471 clrscr();
472
473 /* Init virtual consoles */
474 for (i = 0; i < CONSOLE_COUNT; i++) {
475 connections[i].used = 0;
476 keybuffer_init(&(connections[i].keybuffer));
477
478 connections[i].keyrequests.head = connections[i].keyrequests.tail = 0;
479 connections[i].keyrequests.items = MAX_KEYREQUESTS_BUFFERED;
480 connections[i].keyrequest_counter = 0;
481
482 if (screenbuffer_init(&(connections[i].screenbuffer), fb_info.cols, fb_info.rows ) == NULL) {
483 /*FIXME: handle error */
484 return -1;
485 }
486 }
487 connections[KERNEL_CONSOLE].used = 1;
488
489 if ((interbuffer = mmap(NULL, sizeof(keyfield_t) * fb_info.cols * fb_info.rows , PROTO_READ|PROTO_WRITE, MAP_ANONYMOUS|MAP_PRIVATE, 0 ,0 )) != NULL) {
490 if (async_req_3(fb_info.phone, IPC_M_AS_AREA_SEND, (ipcarg_t)interbuffer, 0, AS_AREA_READ, NULL, NULL, NULL) != 0) {
491 munmap(interbuffer, sizeof(keyfield_t) * fb_info.cols * fb_info.rows);
492 interbuffer = NULL;
493 }
494 }
495
496 async_new_connection(phonehash, 0, NULL, keyboard_events);
497
498 curs_goto(0,0);
499 curs_visibility(connections[active_console].screenbuffer.is_cursor_visible);
500
501 /* Register at NS */
502 if (ipc_connect_to_me(PHONE_NS, SERVICE_CONSOLE, 0, &phonehash) != 0) {
503 return -1;
504 };
505
506 async_manager();
507
508 return 0;
509}
510
Note: See TracBrowser for help on using the repository browser.