Subversion Repositories HelenOS

Rev

Rev 1578 | Rev 1610 | 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>
1487 cejka 41
#include <screenbuffer.h>
1512 cejka 42
#include <sys/mman.h>
1445 cejka 43
 
1522 palkovsky 44
#include "gcons.h"
45
 
1481 cejka 46
#define MAX_KEYREQUESTS_BUFFERED 32
1451 cejka 47
 
1445 cejka 48
#define NAME "CONSOLE"
49
 
1526 cejka 50
/** Index of currently used virtual console.
51
 */
1512 cejka 52
int active_console = 0;
1453 palkovsky 53
 
1526 cejka 54
/** Information about framebuffer
55
 */
1487 cejka 56
struct {
57
    int phone;      /**< Framebuffer phone */
1506 cejka 58
    ipcarg_t rows;      /**< Framebuffer rows */
59
    ipcarg_t cols;      /**< Framebuffer columns */
1487 cejka 60
} fb_info;
61
 
1526 cejka 62
 
1451 cejka 63
typedef struct {
1526 cejka 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. */
1451 cejka 70
} connection_t;
71
 
1552 palkovsky 72
static connection_t connections[CONSOLE_COUNT]; /**< Array of data for virtual consoles */
73
static keyfield_t *interbuffer = NULL;          /**< Pointer to memory shared with framebufer used for faster virt. console switching */
1506 cejka 74
 
1552 palkovsky 75
static int kernel_pixmap = -1;      /**< Number of fb pixmap, where kernel console is stored */
1506 cejka 76
 
1552 palkovsky 77
 
1526 cejka 78
/** Find unused virtual console.
79
 *
80
 */
1574 palkovsky 81
static int find_free_connection(void)
1451 cejka 82
{
83
    int i = 0;
84
 
1574 palkovsky 85
    for (i=0; i < CONSOLE_COUNT; i++) {
86
        if (!connections[i].used)
1451 cejka 87
            return i;
88
    }
1574 palkovsky 89
    return -1;
1451 cejka 90
}
91
 
1552 palkovsky 92
static void clrscr(void)
93
{
94
    nsend_call(fb_info.phone, FB_CLEAR, 0);
95
}
96
 
97
static void curs_visibility(int v)
98
{
99
    send_call(fb_info.phone, FB_CURSOR_VISIBILITY, v);
100
}
101
 
102
static void curs_goto(int row, int col)
103
{
104
    nsend_call_2(fb_info.phone, FB_CURSOR_GOTO, row, col);
105
 
106
}
107
 
108
static 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
 
113
static void set_style_col(int fgcolor, int bgcolor)
114
{
115
    nsend_call_2(fb_info.phone, FB_SET_STYLE, fgcolor, bgcolor);
116
}
117
 
118
static void prtchr(char c, int row, int col)
119
{
120
    nsend_call_3(fb_info.phone, FB_PUTCHAR, c, row, col);
121
 
122
}
123
 
1497 cejka 124
/** Check key and process special keys.
125
 *
126
 * */
127
static 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
 
1552 palkovsky 148
            if (console == active_console)
149
                prtchr(' ', scr->position_y, scr->position_x);
1497 cejka 150
 
151
            screenbuffer_putchar(scr, ' ');
152
 
153
            break;
154
        default:   
1552 palkovsky 155
            if (console == active_console)
156
                prtchr(key, scr->position_y, scr->position_x);
1497 cejka 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++);
1518 palkovsky 167
        if (console == active_console)
168
            nsend_call(fb_info.phone, FB_SCROLL, 1);
1497 cejka 169
    }
170
 
171
    scr->position_x = scr->position_x % scr->size_x;
172
 
1552 palkovsky 173
    if (console == active_console)
174
        curs_goto(scr->position_y, scr->position_x);
1504 cejka 175
 
1497 cejka 176
}
177
 
1552 palkovsky 178
/** Save current screen to pixmap, draw old pixmap
179
 *
180
 * @param oldpixmap Old pixmap
181
 * @return ID of pixmap of current screen
182
 */
183
static 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;
1497 cejka 191
 
1552 palkovsky 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 */
203
static void change_console(int newcons)
204
{
205
    connection_t *conn;
206
    static int console_pixmap = -1;
207
    int i, j;
1578 cejka 208
    keyfield_t *field;
209
    style_t *style;
1552 palkovsky 210
    char c;
211
 
212
    if (newcons == active_console)
213
        return;
214
 
1555 palkovsky 215
    if (newcons == KERNEL_CONSOLE) {
216
        if (active_console == KERNEL_CONSOLE)
1552 palkovsky 217
            return;
1555 palkovsky 218
        active_console = KERNEL_CONSOLE;
1552 palkovsky 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
 
1563 palkovsky 244
    set_style(&conn->screenbuffer.style);
245
    curs_goto(conn->screenbuffer.position_y, conn->screenbuffer.position_x);
1578 cejka 246
    curs_visibility(0);
247
 
1552 palkovsky 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);
1563 palkovsky 252
        /* This call can preempt, but we are already at the end */
1578 cejka 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);
1552 palkovsky 258
        clrscr();
1578 cejka 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);
1552 palkovsky 271
            }
272
    }
1578 cejka 273
 
274
    curs_visibility(conn->screenbuffer.is_cursor_visible);
1552 palkovsky 275
}
276
 
1526 cejka 277
/** Handler for keyboard */
1453 palkovsky 278
static void keyboard_events(ipc_callid_t iid, ipc_call_t *icall)
1445 cejka 279
{
1453 palkovsky 280
    ipc_callid_t callid;
1445 cejka 281
    ipc_call_t call;
1453 palkovsky 282
    int retval;
1560 vana 283
    int c;
1489 palkovsky 284
    connection_t *conn;
1506 cejka 285
 
1453 palkovsky 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 */
1465 cejka 296
 
1453 palkovsky 297
            retval = 0;
1520 cejka 298
            c = IPC_GET_ARG1(call);
1453 palkovsky 299
            /* switch to another virtual console */
1481 cejka 300
 
1489 palkovsky 301
            conn = &connections[active_console];
1490 palkovsky 302
//          if ((c >= KBD_KEY_F1) && (c < KBD_KEY_F1 + CONSOLE_COUNT)) {
1560 vana 303
            if ((c >= 0x101) && (c < 0x101 + CONSOLE_COUNT)) {
304
                if (c == 0x112)
1555 palkovsky 305
                    change_console(KERNEL_CONSOLE);
1552 palkovsky 306
                else
1560 vana 307
                    change_console(c - 0x101);
1453 palkovsky 308
                break;
309
            }
1481 cejka 310
 
311
            /* if client is awaiting key, send it */
1489 palkovsky 312
            if (conn->keyrequest_counter > 0) {    
313
                conn->keyrequest_counter--;
314
                ipc_answer_fast(fifo_pop(conn->keyrequests), 0, c, 0);
1481 cejka 315
                break;
316
            }
317
 
318
            /*FIXME: else store key to its buffer */
1489 palkovsky 319
            keybuffer_push(&conn->keybuffer, c);
1476 cejka 320
 
1453 palkovsky 321
            break;
322
        default:
1459 palkovsky 323
            retval = ENOENT;
1453 palkovsky 324
        }      
1459 palkovsky 325
        ipc_answer_fast(callid, retval, 0, 0);
1453 palkovsky 326
    }
327
}
328
 
329
/** Default thread for new connections */
1518 palkovsky 330
static void client_connection(ipc_callid_t iid, ipc_call_t *icall)
1453 palkovsky 331
{
1445 cejka 332
    ipc_callid_t callid;
1453 palkovsky 333
    ipc_call_t call;
334
    int consnum;
1521 cejka 335
    ipcarg_t arg1, arg2;
1592 palkovsky 336
    connection_t *conn;
1453 palkovsky 337
 
1574 palkovsky 338
    if ((consnum = find_free_connection()) == -1) {
1453 palkovsky 339
        ipc_answer_fast(iid,ELIMIT,0,0);
340
        return;
341
    }
1592 palkovsky 342
    conn = &connections[consnum];
1555 palkovsky 343
 
344
    gcons_notify_connect(consnum);
1592 palkovsky 345
    conn->used = 1;
346
    conn->client_phone = IPC_GET_ARG3(call);
347
    screenbuffer_clear(&conn->screenbuffer);
1497 cejka 348
 
1453 palkovsky 349
    /* Accept the connection */
350
    ipc_answer_fast(iid,0,0,0);
351
 
352
    while (1) {
353
        callid = async_get_call(&call);
1521 cejka 354
        arg1 = arg2 = 0;
1453 palkovsky 355
        switch (IPC_GET_METHOD(call)) {
356
        case IPC_M_PHONE_HUNGUP:
1592 palkovsky 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 */
1453 palkovsky 366
            ipc_answer_fast(callid, 0,0,0);
367
            return;
368
        case CONSOLE_PUTCHAR:
1497 cejka 369
            write_char(consnum, IPC_GET_ARG1(call));
1528 palkovsky 370
            gcons_notify_char(consnum);
1453 palkovsky 371
            break;
1476 cejka 372
        case CONSOLE_CLEAR:
1487 cejka 373
            /* Send message to fb */
374
            if (consnum == active_console) {
1518 palkovsky 375
                send_call(fb_info.phone, FB_CLEAR, 0);
1487 cejka 376
            }
377
 
1592 palkovsky 378
            screenbuffer_clear(&conn->screenbuffer);
1487 cejka 379
 
1476 cejka 380
            break;
381
        case CONSOLE_GOTO:
1487 cejka 382
 
1592 palkovsky 383
            screenbuffer_goto(&conn->screenbuffer, IPC_GET_ARG2(call), IPC_GET_ARG1(call));
1567 palkovsky 384
            if (consnum == active_console)
385
                curs_goto(IPC_GET_ARG1(call),IPC_GET_ARG2(call));
1487 cejka 386
 
1476 cejka 387
            break;
1523 cejka 388
 
1521 cejka 389
        case CONSOLE_GETSIZE:
1528 palkovsky 390
            arg1 = fb_info.rows;
391
            arg2 = fb_info.cols;
1521 cejka 392
            break;
1523 cejka 393
        case CONSOLE_FLUSH:
394
            sync_send_2(fb_info.phone, FB_FLUSH, 0, 0, NULL, NULL);    
395
            break;
1525 cejka 396
        case CONSOLE_SET_STYLE:
397
 
398
            arg1 = IPC_GET_ARG1(call);
399
            arg2 = IPC_GET_ARG2(call);
1592 palkovsky 400
            screenbuffer_set_style(&conn->screenbuffer,arg1, arg2);
1525 cejka 401
            if (consnum == active_console)
1552 palkovsky 402
                set_style_col(arg1, arg2);
1525 cejka 403
 
404
            break;
1575 cejka 405
        case CONSOLE_CURSOR_VISIBILITY:
406
            arg1 = IPC_GET_ARG1(call);
1592 palkovsky 407
            conn->screenbuffer.is_cursor_visible = arg1;
1575 cejka 408
            if (consnum == active_console)
409
                curs_visibility(arg1);
410
            break;
1453 palkovsky 411
        case CONSOLE_GETCHAR:
1592 palkovsky 412
            if (keybuffer_empty(&conn->keybuffer)) {
1481 cejka 413
                /* buffer is empty -> store request */
1592 palkovsky 414
                if (conn->keyrequest_counter < MAX_KEYREQUESTS_BUFFERED) {     
415
                    fifo_push(conn->keyrequests, callid);
416
                    conn->keyrequest_counter++;
1481 cejka 417
                } else {
418
                    /* no key available and too many requests => fail */
419
                    ipc_answer_fast(callid, ELIMIT, 0, 0);
420
                }
421
                continue;
1453 palkovsky 422
            };
1592 palkovsky 423
            keybuffer_pop(&conn->keybuffer, (int *)&arg1);
1465 cejka 424
 
1453 palkovsky 425
            break;
426
        }
1521 cejka 427
        ipc_answer_fast(callid, 0, arg1, arg2);
1453 palkovsky 428
    }
429
}
430
 
431
int main(int argc, char *argv[])
432
{
433
    ipcarg_t phonehash;
1451 cejka 434
    int kbd_phone, fb_phone;
1445 cejka 435
    ipcarg_t retval, arg1 = 0xdead, arg2 = 0xbeef;
1451 cejka 436
    int i;
1490 palkovsky 437
 
438
    async_set_client_connection(client_connection);
1445 cejka 439
 
440
    /* Connect to keyboard driver */
441
 
1451 cejka 442
    while ((kbd_phone = ipc_connect_me_to(PHONE_NS, SERVICE_KEYBOARD, 0)) < 0) {
1453 palkovsky 443
        usleep(10000);
1445 cejka 444
    };
445
 
1453 palkovsky 446
    if (ipc_connect_to_me(kbd_phone, SERVICE_CONSOLE, 0, &phonehash) != 0) {
1445 cejka 447
        return -1;
448
    };
449
 
450
    /* Connect to framebuffer driver */
451
 
1487 cejka 452
    while ((fb_info.phone = ipc_connect_me_to(PHONE_NS, SERVICE_VIDEO, 0)) < 0) {
453
        usleep(10000);
454
    }
1552 palkovsky 455
 
456
    /* Save old kernel screen */
457
    kernel_pixmap = switch_screens(-1);
1522 palkovsky 458
 
459
    /* Initialize gcons */
460
    gcons_init(fb_info.phone);
461
    /* Synchronize, the gcons can have something in queue */
1574 palkovsky 462
    sync_send(fb_info.phone, FB_FLUSH, 0, NULL);
1522 palkovsky 463
 
1487 cejka 464
 
465
    ipc_call_sync_2(fb_info.phone, FB_GET_CSIZE, 0, 0, &(fb_info.rows), &(fb_info.cols));
1552 palkovsky 466
    set_style_col(DEFAULT_FOREGROUND, DEFAULT_BACKGROUND);
467
    clrscr();
1487 cejka 468
 
469
    /* Init virtual consoles */
1451 cejka 470
    for (i = 0; i < CONSOLE_COUNT; i++) {
471
        connections[i].used = 0;
472
        keybuffer_init(&(connections[i].keybuffer));
1481 cejka 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;
1487 cejka 477
 
478
        if (screenbuffer_init(&(connections[i].screenbuffer), fb_info.cols, fb_info.rows ) == NULL) {
479
            /*FIXME: handle error */
480
            return -1;
481
        }
1451 cejka 482
    }
1574 palkovsky 483
    connections[KERNEL_CONSOLE].used = 1;
1445 cejka 484
 
1512 cejka 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) {
1547 palkovsky 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) {
1512 cejka 487
            munmap(interbuffer, sizeof(keyfield_t) * fb_info.cols * fb_info.rows);
488
            interbuffer = NULL;
489
        }
490
    }
1520 cejka 491
 
1506 cejka 492
    async_new_connection(phonehash, 0, NULL, keyboard_events);
493
 
1575 cejka 494
    curs_goto(0,0);
495
    curs_visibility(connections[active_console].screenbuffer.is_cursor_visible);
1497 cejka 496
 
1518 palkovsky 497
    /* Register at NS */
1453 palkovsky 498
    if (ipc_connect_to_me(PHONE_NS, SERVICE_CONSOLE, 0, &phonehash) != 0) {
1445 cejka 499
        return -1;
500
    };
501
 
1453 palkovsky 502
    async_manager();
1451 cejka 503
 
1445 cejka 504
    return 0;  
505
}
1520 cejka 506