source: mainline/console/console.c@ 51dbadf3

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

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