WebSVN – HelenOS – Diff – /branches/dd/uspace/srv/console/console.c


/*
 * 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.
 */
 
/** @addtogroup console
 * @{
 */
/** @file
 */
 
#include <libc.h>
#include <fb.h>
#include <ipc/ipc.h>
#include <kbd.h>
#include <io/keycode.h>
#include <ipc/fb.h>
#include <ipc/services.h>
#include <errno.h>
#include <keybuffer.h>
#include <ipc/console.h>
#include <unistd.h>
#include <async.h>
#include <adt/fifo.h>
#include <sys/mman.h>
#include <stdio.h>
#include <string.h>
#include <sysinfo.h>
#include <event.h>
#include <devmap.h>
#include <fibril_sync.h>
 
#include "console.h"
#include "gcons.h"
#include "screenbuffer.h"
 
#define NAME  "console"
 
#define MAX_DEVICE_NAME  32
 
/** Phone to the keyboard driver. */
static int kbd_phone;
 
/** Information about framebuffer */
struct {
    int phone;      /**< Framebuffer phone */
    ipcarg_t cols;  /**< Framebuffer columns */
    ipcarg_t rows;  /**< Framebuffer rows */
    int color_cap;  /**< Color capabilities (FB_CCAP_xxx) */
} fb_info;
 
typedef struct {
    size_t index;             /**< Console index */
    size_t refcount;          /**< Connection reference count */
    dev_handle_t dev_handle;  /**< Device handle */
    keybuffer_t keybuffer;    /**< Buffer for incoming keys. */
    screenbuffer_t scr;       /**< Screenbuffer for saving screen
                                   contents and related settings. */
} console_t;
 
/** Array of data for virtual consoles */
static console_t consoles[CONSOLE_COUNT];
 
static console_t *active_console = &consoles[0];
static console_t *prev_console = &consoles[0];
static console_t *kernel_console = &consoles[KERNEL_CONSOLE];
 
/** Pointer to memory shared with framebufer used for
    faster virtual console switching */
static keyfield_t *interbuffer = NULL;
 
/** Information on row-span yet unsent to FB driver. */
struct {
    size_t col;  /**< Leftmost column of the span. */
    size_t row;  /**< Row where the span lies. */
    size_t cnt;  /**< Width of the span. */
} fb_pending;
 
static FIBRIL_MUTEX_INITIALIZE(input_mutex);
static FIBRIL_CONDVAR_INITIALIZE(input_cv);
 
static void curs_visibility(bool visible)
{
    async_msg_1(fb_info.phone, FB_CURSOR_VISIBILITY, visible);
}
 
static void curs_hide_sync(void)
{
    ipc_call_sync_1_0(fb_info.phone, FB_CURSOR_VISIBILITY, false);
}
 
static void curs_goto(size_t x, size_t y)
{
    async_msg_2(fb_info.phone, FB_CURSOR_GOTO, x, y);
}
 
static void screen_clear(void)
{
    async_msg_0(fb_info.phone, FB_CLEAR);
}
 
static void screen_yield(void)
{
    ipc_call_sync_0_0(fb_info.phone, FB_SCREEN_YIELD);
}
 
static void screen_reclaim(void)
{
    ipc_call_sync_0_0(fb_info.phone, FB_SCREEN_RECLAIM);
}
 
static void kbd_yield(void)
{
    ipc_call_sync_0_0(kbd_phone, KBD_YIELD);
}
 
static void kbd_reclaim(void)
{
    ipc_call_sync_0_0(kbd_phone, KBD_RECLAIM);
}
 
static void set_style(int style)
{
    async_msg_1(fb_info.phone, FB_SET_STYLE, style);
}
 
static void set_color(int fgcolor, int bgcolor, int flags)
{
    async_msg_3(fb_info.phone, FB_SET_COLOR, fgcolor, bgcolor, flags);
}
 
static void set_rgb_color(int fgcolor, int bgcolor)
{
    async_msg_2(fb_info.phone, FB_SET_RGB_COLOR, fgcolor, bgcolor);
}
 
static void set_attrs(attrs_t *attrs)
{
    switch (attrs->t) {
    case at_style:
        set_style(attrs->a.s.style);
        break;
    case at_idx:
        set_color(attrs->a.i.fg_color, attrs->a.i.bg_color,
            attrs->a.i.flags);
        break;
    case at_rgb:
        set_rgb_color(attrs->a.r.fg_color, attrs->a.r.bg_color);
        break;
    }
}
 
static int ccap_fb_to_con(int ccap_fb, int *ccap_con)
{
    switch (ccap_fb) {
    case FB_CCAP_NONE: *ccap_con = CONSOLE_CCAP_NONE; break;
    case FB_CCAP_STYLE: *ccap_con = CONSOLE_CCAP_STYLE; break;
    case FB_CCAP_INDEXED: *ccap_con = CONSOLE_CCAP_INDEXED; break;
    case FB_CCAP_RGB: *ccap_con = CONSOLE_CCAP_RGB; break;
    default: return EINVAL;
    }
 
    return EOK;
}
 
/** Send an area of screenbuffer to the FB driver. */
static void fb_update_area(console_t *cons, ipcarg_t x0, ipcarg_t y0, ipcarg_t width, ipcarg_t height)
{
    if (interbuffer) {
        ipcarg_t x;
        ipcarg_t y;
       
        for (y = 0; y < height; y++) {
            for (x = 0; x < width; x++) {
                interbuffer[y * width + x] =
                    *get_field_at(&cons->scr, x0 + x, y0 + y);
            }
        }
       
        async_req_4_0(fb_info.phone, FB_DRAW_TEXT_DATA,
            x0, y0, width, height);
    }
}
 
/** Flush pending cells to FB. */
static void fb_pending_flush(void)
{
    if (fb_pending.cnt > 0) {
        fb_update_area(active_console, fb_pending.col,
            fb_pending.row, fb_pending.cnt, 1);
        fb_pending.cnt = 0;
    }
}
 
/** Mark a character cell as changed.
 *
 * This adds the cell to the pending rowspan if possible. Otherwise
 * the old span is flushed first.
 *
 */
static void cell_mark_changed(size_t col, size_t row)
{
    if (fb_pending.cnt != 0) {
        if ((col != fb_pending.col + fb_pending.cnt)
            || (row != fb_pending.row)) {
            fb_pending_flush();
        }
    }
   
    if (fb_pending.cnt == 0) {
        fb_pending.col = col;
        fb_pending.row = row;
    }
   
    fb_pending.cnt++;
}
 
/** Print a character to the active VC with buffering. */
static void fb_putchar(wchar_t c, ipcarg_t col, ipcarg_t row)
{
    async_msg_3(fb_info.phone, FB_PUTCHAR, c, col, row);
}
 
/** Process a character from the client (TTY emulation). */
static void write_char(console_t *cons, wchar_t ch)
{
    bool flush_cursor = false;
 
    switch (ch) {
    case '\n':
        fb_pending_flush();
        flush_cursor = true;
        cons->scr.position_y++;
        cons->scr.position_x = 0;
        break;
    case '\r':
        break;
    case '\t':
        cons->scr.position_x += 8;
        cons->scr.position_x -= cons->scr.position_x % 8;
        break;
    case '\b':
        if (cons->scr.position_x == 0)
            break;
        cons->scr.position_x--;
        if (cons == active_console)
            cell_mark_changed(cons->scr.position_x, cons->scr.position_y);
        screenbuffer_putchar(&cons->scr, ' ');
        break;
    default:
        if (cons == active_console)
            cell_mark_changed(cons->scr.position_x, cons->scr.position_y);
       
        screenbuffer_putchar(&cons->scr, ch);
        cons->scr.position_x++;
    }
   
    if (cons->scr.position_x >= cons->scr.size_x) {
        flush_cursor = true;
        cons->scr.position_y++;
    }
   
    if (cons->scr.position_y >= cons->scr.size_y) {
        fb_pending_flush();
        cons->scr.position_y = cons->scr.size_y - 1;
        screenbuffer_clear_line(&cons->scr, cons->scr.top_line);
        cons->scr.top_line = (cons->scr.top_line + 1) % cons->scr.size_y;
       
        if (cons == active_console)
            async_msg_1(fb_info.phone, FB_SCROLL, 1);
    }
 
    if (cons == active_console && flush_cursor)
        curs_goto(cons->scr.position_x, cons->scr.position_y);
    cons->scr.position_x = cons->scr.position_x % cons->scr.size_x;
}
 
/** Switch to new console */
static void change_console(console_t *cons)
{
    if (cons == active_console)
        return;
   
    fb_pending_flush();
   
    if (cons == kernel_console) {
        async_serialize_start();
        curs_hide_sync();
        gcons_in_kernel();
        screen_yield();
        kbd_yield();
        async_serialize_end();
       
        if (__SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE)) {
            prev_console = active_console;
            active_console = kernel_console;
        } else
            cons = active_console;
    }
   
    if (cons != kernel_console) {
        size_t x;
        size_t y;
        int rc = 0;
       
        async_serialize_start();
       
        if (active_console == kernel_console) {
            screen_reclaim();
            kbd_reclaim();
            gcons_redraw_console();
        }
       
        active_console = cons;
        gcons_change_console(cons->index);
       
        set_attrs(&cons->scr.attrs);
        curs_visibility(false);
        if (interbuffer) {
            for (y = 0; y < cons->scr.size_y; y++) {
                for (x = 0; x < cons->scr.size_x; x++) {
                    interbuffer[y * cons->scr.size_x + x] =
                        *get_field_at(&cons->scr, x, y);
                }
            }
           
            /* This call can preempt, but we are already at the end */
            rc = async_req_4_0(fb_info.phone, FB_DRAW_TEXT_DATA,
                0, 0, cons->scr.size_x,
                cons->scr.size_y);
        }
       
        if ((!interbuffer) || (rc != 0)) {
            set_attrs(&cons->scr.attrs);
            screen_clear();
           
            for (y = 0; y < cons->scr.size_y; y++)
                for (x = 0; x < cons->scr.size_x; x++) {
                    keyfield_t *field = get_field_at(&cons->scr, x, y);
                   
                    if (!attrs_same(cons->scr.attrs, field->attrs))
                        set_attrs(&field->attrs);
                   
                    cons->scr.attrs = field->attrs;
                    if ((field->character == ' ') &&
                        (attrs_same(field->attrs, cons->scr.attrs)))
                        continue;
                   
                    fb_putchar(field->character, x, y);
                }
        }
       
        curs_goto(cons->scr.position_x, cons->scr.position_y);
        curs_visibility(cons->scr.is_cursor_visible);
       
        async_serialize_end();
    }
}
 
/** Handler for keyboard */
static void keyboard_events(ipc_callid_t iid, ipc_call_t *icall)
{
    /* Ignore parameters, the connection is already opened */
    while (true) {
       
        ipc_call_t call;
        ipc_callid_t callid = async_get_call(&call);
       
        int retval;
        console_event_t ev;
       
        switch (IPC_GET_METHOD(call)) {
        case IPC_M_PHONE_HUNGUP:
            /* TODO: Handle hangup */
            return;
        case KBD_EVENT:
            /* Got event from keyboard driver. */
            retval = 0;
            ev.type = IPC_GET_ARG1(call);
            ev.key = IPC_GET_ARG2(call);
            ev.mods = IPC_GET_ARG3(call);
            ev.c = IPC_GET_ARG4(call);
           
            if ((ev.key >= KC_F1) && (ev.key < KC_F1 +
                CONSOLE_COUNT) && ((ev.mods & KM_CTRL) == 0)) {
                if (ev.key == KC_F1 + KERNEL_CONSOLE)
                    change_console(kernel_console);
                else
                    change_console(&consoles[ev.key - KC_F1]);
                break;
            }
           
            fibril_mutex_lock(&input_mutex);
            keybuffer_push(&active_console->keybuffer, &ev);
            fibril_condvar_broadcast(&input_cv);
            fibril_mutex_unlock(&input_mutex);
            break;
        default:
            retval = ENOENT;
        }
        ipc_answer_0(callid, retval);
    }
}
 
static void cons_write(console_t *cons, ipc_callid_t rid, ipc_call_t *request)
{
    ipc_callid_t callid;
    size_t size;
    if (!ipc_data_write_receive(&callid, &size)) {
        ipc_answer_0(callid, EINVAL);
        ipc_answer_0(rid, EINVAL);
        return;
    }
   
    char *buf = (char *) malloc(size);
    if (buf == NULL) {
        ipc_answer_0(callid, ENOMEM);
        ipc_answer_0(rid, ENOMEM);
        return;
    }
   
    (void) ipc_data_write_finalize(callid, buf, size);
   
    async_serialize_start();
   
    size_t off = 0;
    while (off < size) {
        wchar_t ch = str_decode(buf, &off, size);
        write_char(cons, ch);
    }
   
    async_serialize_end();
   
    gcons_notify_char(cons->index);
    ipc_answer_1(rid, EOK, size);
   
    free(buf);
}
 
static void cons_read(console_t *cons, ipc_callid_t rid, ipc_call_t *request)
{
    ipc_callid_t callid;
    size_t size;
    if (!ipc_data_read_receive(&callid, &size)) {
        ipc_answer_0(callid, EINVAL);
        ipc_answer_0(rid, EINVAL);
        return;
    }
   
    char *buf = (char *) malloc(size);
    if (buf == NULL) {
        ipc_answer_0(callid, ENOMEM);
        ipc_answer_0(rid, ENOMEM);
        return;
    }
   
    size_t pos = 0;
    console_event_t ev;
    fibril_mutex_lock(&input_mutex);
recheck:
    while ((keybuffer_pop(&cons->keybuffer, &ev)) && (pos < size)) {
        if (ev.type == KEY_PRESS) {
            buf[pos] = ev.c;
            pos++;
        }
    }
   
    if (pos == size) {
        (void) ipc_data_read_finalize(callid, buf, size);
        ipc_answer_1(rid, EOK, size);
        free(buf);
    } else {
        fibril_condvar_wait(&input_cv, &input_mutex);
        goto recheck;
    }
    fibril_mutex_unlock(&input_mutex);
}
 
static void cons_get_event(console_t *cons, ipc_callid_t rid, ipc_call_t *request)
{
    console_event_t ev;
 
    fibril_mutex_lock(&input_mutex);
recheck:
    if (keybuffer_pop(&cons->keybuffer, &ev)) {
        ipc_answer_4(rid, EOK, ev.type, ev.key, ev.mods, ev.c);
    } else {
        fibril_condvar_wait(&input_cv, &input_mutex);
        goto recheck;
    }
    fibril_mutex_unlock(&input_mutex);
}
 
/** Default thread for new connections */
static void client_connection(ipc_callid_t iid, ipc_call_t *icall)
{
    console_t *cons = NULL;
   
    size_t i;
    for (i = 0; i < CONSOLE_COUNT; i++) {
        if (i == KERNEL_CONSOLE)
            continue;
       
        if (consoles[i].dev_handle == (dev_handle_t) IPC_GET_ARG1(*icall)) {
            cons = &consoles[i];
            break;
        }
    }
   
    if (cons == NULL) {
        ipc_answer_0(iid, ENOENT);
        return;
    }
   
    ipc_callid_t callid;
    ipc_call_t call;
    ipcarg_t arg1;
    ipcarg_t arg2;
    ipcarg_t arg3;
 
    int cons_ccap;
    int rc;
   
    async_serialize_start();
    if (cons->refcount == 0)
        gcons_notify_connect(cons->index);
   
    cons->refcount++;
   
    /* Accept the connection */
    ipc_answer_0(iid, EOK);
   
    while (true) {
        async_serialize_end();
        callid = async_get_call(&call);
        async_serialize_start();
       
        arg1 = 0;
        arg2 = 0;
        arg3 = 0;
       
        switch (IPC_GET_METHOD(call)) {
        case IPC_M_PHONE_HUNGUP:
            cons->refcount--;
            if (cons->refcount == 0)
                gcons_notify_disconnect(cons->index);
            return;
        case VFS_OUT_READ:
            async_serialize_end();
            cons_read(cons, callid, &call);
            async_serialize_start();
            continue;
        case VFS_OUT_WRITE:
            async_serialize_end();
            cons_write(cons, callid, &call);
            async_serialize_start();
            continue;
        case VFS_OUT_SYNC:
            fb_pending_flush();
            if (cons == active_console) {
                async_req_0_0(fb_info.phone, FB_FLUSH);
               
                curs_goto(cons->scr.position_x, cons->scr.position_y);
            }
            break;
        case CONSOLE_CLEAR:
            /* Send message to fb */
            if (cons == active_console)
                async_msg_0(fb_info.phone, FB_CLEAR);
           
            screenbuffer_clear(&cons->scr);
           
            break;
        case CONSOLE_GOTO:
            screenbuffer_goto(&cons->scr,
                IPC_GET_ARG1(call), IPC_GET_ARG2(call));
            if (cons == active_console)
                curs_goto(IPC_GET_ARG1(call),
                    IPC_GET_ARG2(call));
            break;
        case CONSOLE_GET_SIZE:
            arg1 = fb_info.cols;
            arg2 = fb_info.rows;
            break;
        case CONSOLE_GET_COLOR_CAP:
            rc = ccap_fb_to_con(fb_info.color_cap, &cons_ccap);
            if (rc != EOK) {
                ipc_answer_0(callid, rc);
                continue;
            }
            arg1 = cons_ccap;
            break;
        case CONSOLE_SET_STYLE:
            fb_pending_flush();
            arg1 = IPC_GET_ARG1(call);
            screenbuffer_set_style(&cons->scr, arg1);
            if (cons == active_console)
                set_style(arg1);
            break;
        case CONSOLE_SET_COLOR:
            fb_pending_flush();
            arg1 = IPC_GET_ARG1(call);
            arg2 = IPC_GET_ARG2(call);
            arg3 = IPC_GET_ARG3(call);
            screenbuffer_set_color(&cons->scr, arg1, arg2, arg3);
            if (cons == active_console)
                set_color(arg1, arg2, arg3);
            break;
        case CONSOLE_SET_RGB_COLOR:
            fb_pending_flush();
            arg1 = IPC_GET_ARG1(call);
            arg2 = IPC_GET_ARG2(call);
            screenbuffer_set_rgb_color(&cons->scr, arg1, arg2);
            if (cons == active_console)
                set_rgb_color(arg1, arg2);
            break;
        case CONSOLE_CURSOR_VISIBILITY:
            fb_pending_flush();
            arg1 = IPC_GET_ARG1(call);
            cons->scr.is_cursor_visible = arg1;
            if (cons == active_console)
                curs_visibility(arg1);
            break;
        case CONSOLE_GET_EVENT:
            async_serialize_end();
            cons_get_event(cons, callid, &call);
            async_serialize_start();
            continue;
        case CONSOLE_KCON_ENABLE:
            change_console(kernel_console);
            break;
        }
        ipc_answer_3(callid, EOK, arg1, arg2, arg3);
    }
}
 
static void interrupt_received(ipc_callid_t callid, ipc_call_t *call)
{
    change_console(prev_console);
}
 
static bool console_init(void)
{
    ipcarg_t color_cap;
 
    /* Connect to keyboard driver */
    kbd_phone = ipc_connect_me_to_blocking(PHONE_NS, SERVICE_KEYBOARD, 0, 0);
    if (kbd_phone < 0) {
        printf(NAME ": Failed to connect to keyboard service\n");
        return false;
    }
   
    ipcarg_t phonehash;
    if (ipc_connect_to_me(kbd_phone, SERVICE_CONSOLE, 0, 0, &phonehash) != 0) {
        printf(NAME ": Failed to create callback from keyboard service\n");
        return false;
    }
   
    async_new_connection(phonehash, 0, NULL, keyboard_events);
 
    /* Connect to framebuffer driver */
    fb_info.phone = ipc_connect_me_to_blocking(PHONE_NS, SERVICE_VIDEO, 0, 0);
    if (fb_info.phone < 0) {
        printf(NAME ": Failed to connect to video service\n");
        return -1;
    }
   
    /* Register driver */
    int rc = devmap_driver_register(NAME, client_connection);
    if (rc < 0) {
        printf(NAME ": Unable to register driver (%d)\n", rc);
        return false;
    }
   
    /* Initialize gcons */
    gcons_init(fb_info.phone);
   
    /* Synchronize, the gcons could put something in queue */
    async_req_0_0(fb_info.phone, FB_FLUSH);
    async_req_0_2(fb_info.phone, FB_GET_CSIZE, &fb_info.cols, &fb_info.rows);
    async_req_0_1(fb_info.phone, FB_GET_COLOR_CAP, &color_cap);
    fb_info.color_cap = color_cap;
   
    /* Set up shared memory buffer. */
    size_t ib_size = sizeof(keyfield_t) * fb_info.cols * fb_info.rows;
    interbuffer = as_get_mappable_page(ib_size);
   
    if (as_area_create(interbuffer, ib_size, AS_AREA_READ |
        AS_AREA_WRITE | AS_AREA_CACHEABLE) != interbuffer)
        interbuffer = NULL;
   
    if (interbuffer) {
        if (ipc_share_out_start(fb_info.phone, interbuffer,
            AS_AREA_READ) != EOK) {
            as_area_destroy(interbuffer);
            interbuffer = NULL;
        }
    }
   
    fb_pending.cnt = 0;
   
    /* Inititalize consoles */
    size_t i;
    for (i = 0; i < CONSOLE_COUNT; i++) {
        if (i != KERNEL_CONSOLE) {
            if (screenbuffer_init(&consoles[i].scr,
                fb_info.cols, fb_info.rows) == NULL) {
                printf(NAME ": Unable to allocate screen buffer %u\n", i);
                return false;
            }
            screenbuffer_clear(&consoles[i].scr);
            keybuffer_init(&consoles[i].keybuffer);
            consoles[i].index = i;
            consoles[i].refcount = 0;
           
            char vc[MAX_DEVICE_NAME];
            snprintf(vc, MAX_DEVICE_NAME, "vc%u", i);
           
            if (devmap_device_register(vc, &consoles[i].dev_handle) != EOK) {
                devmap_hangup_phone(DEVMAP_DRIVER);
                printf(NAME ": Unable to register device %s\n", vc);
                return false;
            }
        }
    }
   
    /* Disable kernel output to the console */
    __SYSCALL0(SYS_DEBUG_DISABLE_CONSOLE);
   
    /* Initialize the screen */
    async_serialize_start();
    gcons_redraw_console();
    set_rgb_color(DEFAULT_FOREGROUND, DEFAULT_BACKGROUND);
    screen_clear();
    curs_goto(0, 0);
    curs_visibility(active_console->scr.is_cursor_visible);
    async_serialize_end();
   
    /* Receive kernel notifications */
    if (event_subscribe(EVENT_KCONSOLE, 0) != EOK)
        printf(NAME ": Error registering kconsole notifications\n");
   
    async_set_interrupt_received(interrupt_received);
   
    return true;
}
 
int main(int argc, char *argv[])
{
    printf(NAME ": HelenOS Console service\n");
   
    if (!console_init())
        return -1;
   
    printf(NAME ": Accepting connections\n");
    async_manager();
   
    return 0;
}
 
/** @}
 */
 

Rev 4668	Rev 4688
1	/*	1	/*
2	* Copyright (c) 2006 Josef Cejka	2	* Copyright (c) 2006 Josef Cejka
3	* All rights reserved.	3	* All rights reserved.
4	*	4	*
5	* Redistribution and use in source and binary forms, with or without	5	* Redistribution and use in source and binary forms, with or without
6	* modification, are permitted provided that the following conditions	6	* modification, are permitted provided that the following conditions
7	* are met:	7	* are met:
8	*	8	*
9	* - Redistributions of source code must retain the above copyright	9	* - Redistributions of source code must retain the above copyright
10	* notice, this list of conditions and the following disclaimer.	10	* notice, this list of conditions and the following disclaimer.
11	* - Redistributions in binary form must reproduce the above copyright	11	* - Redistributions in binary form must reproduce the above copyright
12	* notice, this list of conditions and the following disclaimer in the	12	* notice, this list of conditions and the following disclaimer in the
13	* documentation and/or other materials provided with the distribution.	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	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.	15	* derived from this software without specific prior written permission.
16	*	16	*
17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	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	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	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	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	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	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.	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27	*/	27	*/
28		28
29	/** @addtogroup console	29	/** @addtogroup console
30	* @{	30	* @{
31	*/	31	*/
32	/** @file	32	/** @file
33	*/	33	*/
34		34
35	#include <libc.h>	35	#include <libc.h>
36	#include <fb.h>	36	#include <fb.h>
37	#include <ipc/ipc.h>	37	#include <ipc/ipc.h>
38	#include <kbd.h>	38	#include <kbd.h>
39	#include <io/keycode.h>	39	#include <io/keycode.h>
40	#include <ipc/fb.h>	40	#include <ipc/fb.h>
41	#include <ipc/services.h>	41	#include <ipc/services.h>
42	#include <errno.h>	42	#include <errno.h>
43	#include <keybuffer.h>	43	#include <keybuffer.h>
44	#include <ipc/console.h>	44	#include <ipc/console.h>
45	#include <unistd.h>	45	#include <unistd.h>
46	#include <async.h>	46	#include <async.h>
47	#include <adt/fifo.h>	47	#include <adt/fifo.h>
48	#include <sys/mman.h>	48	#include <sys/mman.h>
49	#include <stdio.h>	49	#include <stdio.h>
50	#include <string.h>	50	#include <string.h>
51	#include <sysinfo.h>	51	#include <sysinfo.h>
52	#include <event.h>	52	#include <event.h>
53	#include <devmap.h>	53	#include <devmap.h>
54	#include <fibril_sync.h>	54	#include <fibril_sync.h>
55		55
56	#include "console.h"	56	#include "console.h"
57	#include "gcons.h"	57	#include "gcons.h"
58	#include "screenbuffer.h"	58	#include "screenbuffer.h"
59		59
60	#define NAME "console"	60	#define NAME "console"
61		61
62	#define MAX_DEVICE_NAME 32	62	#define MAX_DEVICE_NAME 32
63		63
64	/** Phone to the keyboard driver. */	64	/** Phone to the keyboard driver. */
65	static int kbd_phone;	65	static int kbd_phone;
66		66
67	/** Information about framebuffer */	67	/** Information about framebuffer */
68	struct {	68	struct {
69	int phone; /*< Framebuffer phone /	69	int phone; /*< Framebuffer phone /
70	ipcarg_t cols; /*< Framebuffer columns /	70	ipcarg_t cols; /*< Framebuffer columns /
71	ipcarg_t rows; /*< Framebuffer rows /	71	ipcarg_t rows; /*< Framebuffer rows /
72	int color_cap; /*< Color capabilities (FB_CCAP_xxx) /	72	int color_cap; /*< Color capabilities (FB_CCAP_xxx) /
73	} fb_info;	73	} fb_info;
74		74
75	typedef struct {	75	typedef struct {
76	size_t index; /*< Console index /	76	size_t index; /*< Console index /
77	size_t refcount; /*< Connection reference count /	77	size_t refcount; /*< Connection reference count /
78	dev_handle_t dev_handle; /*< Device handle /	78	dev_handle_t dev_handle; /*< Device handle /
79	keybuffer_t keybuffer; /*< Buffer for incoming keys. /	79	keybuffer_t keybuffer; /*< Buffer for incoming keys. /
80	screenbuffer_t scr; /**< Screenbuffer for saving screen	80	screenbuffer_t scr; /**< Screenbuffer for saving screen
81	contents and related settings. */	81	contents and related settings. */
82	} console_t;	82	} console_t;
83		83
84	/** Array of data for virtual consoles */	84	/** Array of data for virtual consoles */
85	static console_t consoles[CONSOLE_COUNT];	85	static console_t consoles[CONSOLE_COUNT];
86		86
87	static console_t *active_console = &consoles[0];	87	static console_t *active_console = &consoles[0];
88	static console_t *prev_console = &consoles[0];	88	static console_t *prev_console = &consoles[0];
89	static console_t *kernel_console = &consoles[KERNEL_CONSOLE];	89	static console_t *kernel_console = &consoles[KERNEL_CONSOLE];
90		90
91	/** Pointer to memory shared with framebufer used for	91	/** Pointer to memory shared with framebufer used for
92	faster virtual console switching */	92	faster virtual console switching */
93	static keyfield_t *interbuffer = NULL;	93	static keyfield_t *interbuffer = NULL;
94		94
95	/** Information on row-span yet unsent to FB driver. */	95	/** Information on row-span yet unsent to FB driver. */
96	struct {	96	struct {
97	size_t col; /*< Leftmost column of the span. /	97	size_t col; /*< Leftmost column of the span. /
98	size_t row; /*< Row where the span lies. /	98	size_t row; /*< Row where the span lies. /
99	size_t cnt; /*< Width of the span. /	99	size_t cnt; /*< Width of the span. /
100	} fb_pending;	100	} fb_pending;
101		101
102	static FIBRIL_MUTEX_INITIALIZE(input_mutex);	102	static FIBRIL_MUTEX_INITIALIZE(input_mutex);
103	static FIBRIL_CONDVAR_INITIALIZE(input_cv);	103	static FIBRIL_CONDVAR_INITIALIZE(input_cv);
104		104
105	static void curs_visibility(bool visible)	105	static void curs_visibility(bool visible)
106	{	106	{
107	async_msg_1(fb_info.phone, FB_CURSOR_VISIBILITY, visible);	107	async_msg_1(fb_info.phone, FB_CURSOR_VISIBILITY, visible);
108	}	108	}
109		109
110	static void curs_hide_sync(void)	110	static void curs_hide_sync(void)
111	{	111	{
112	ipc_call_sync_1_0(fb_info.phone, FB_CURSOR_VISIBILITY, false);	112	ipc_call_sync_1_0(fb_info.phone, FB_CURSOR_VISIBILITY, false);
113	}	113	}
114		114
115	static void curs_goto(size_t x, size_t y)	115	static void curs_goto(size_t x, size_t y)
116	{	116	{
117	async_msg_2(fb_info.phone, FB_CURSOR_GOTO, x, y);	117	async_msg_2(fb_info.phone, FB_CURSOR_GOTO, x, y);
118	}	118	}
119		119
120	static void screen_clear(void)	120	static void screen_clear(void)
121	{	121	{
122	async_msg_0(fb_info.phone, FB_CLEAR);	122	async_msg_0(fb_info.phone, FB_CLEAR);
123	}	123	}
124		124
125	static void screen_yield(void)	125	static void screen_yield(void)
126	{	126	{
127	ipc_call_sync_0_0(fb_info.phone, FB_SCREEN_YIELD);	127	ipc_call_sync_0_0(fb_info.phone, FB_SCREEN_YIELD);
128	}	128	}
129		129
130	static void screen_reclaim(void)	130	static void screen_reclaim(void)
131	{	131	{
132	ipc_call_sync_0_0(fb_info.phone, FB_SCREEN_RECLAIM);	132	ipc_call_sync_0_0(fb_info.phone, FB_SCREEN_RECLAIM);
133	}	133	}
134		134
135	static void kbd_yield(void)	135	static void kbd_yield(void)
136	{	136	{
137	ipc_call_sync_0_0(kbd_phone, KBD_YIELD);	137	ipc_call_sync_0_0(kbd_phone, KBD_YIELD);
138	}	138	}
139		139
140	static void kbd_reclaim(void)	140	static void kbd_reclaim(void)
141	{	141	{
142	ipc_call_sync_0_0(kbd_phone, KBD_RECLAIM);	142	ipc_call_sync_0_0(kbd_phone, KBD_RECLAIM);
143	}	143	}
144		144
145	static void set_style(int style)	145	static void set_style(int style)
146	{	146	{
147	async_msg_1(fb_info.phone, FB_SET_STYLE, style);	147	async_msg_1(fb_info.phone, FB_SET_STYLE, style);
148	}	148	}
149		149
150	static void set_color(int fgcolor, int bgcolor, int flags)	150	static void set_color(int fgcolor, int bgcolor, int flags)
151	{	151	{
152	async_msg_3(fb_info.phone, FB_SET_COLOR, fgcolor, bgcolor, flags);	152	async_msg_3(fb_info.phone, FB_SET_COLOR, fgcolor, bgcolor, flags);
153	}	153	}
154		154
155	static void set_rgb_color(int fgcolor, int bgcolor)	155	static void set_rgb_color(int fgcolor, int bgcolor)
156	{	156	{
157	async_msg_2(fb_info.phone, FB_SET_RGB_COLOR, fgcolor, bgcolor);	157	async_msg_2(fb_info.phone, FB_SET_RGB_COLOR, fgcolor, bgcolor);
158	}	158	}
159		159
160	static void set_attrs(attrs_t *attrs)	160	static void set_attrs(attrs_t *attrs)
161	{	161	{
162	switch (attrs->t) {	162	switch (attrs->t) {
163	case at_style:	163	case at_style:
164	set_style(attrs->a.s.style);	164	set_style(attrs->a.s.style);
165	break;	165	break;
166	case at_idx:	166	case at_idx:
167	set_color(attrs->a.i.fg_color, attrs->a.i.bg_color,	167	set_color(attrs->a.i.fg_color, attrs->a.i.bg_color,
168	attrs->a.i.flags);	168	attrs->a.i.flags);
169	break;	169	break;
170	case at_rgb:	170	case at_rgb:
171	set_rgb_color(attrs->a.r.fg_color, attrs->a.r.bg_color);	171	set_rgb_color(attrs->a.r.fg_color, attrs->a.r.bg_color);
172	break;	172	break;
173	}	173	}
174	}	174	}
175		175
176	int ccap_fb_to_con(int ccap_fb, int *ccap_con)	176	static int ccap_fb_to_con(int ccap_fb, int *ccap_con)
177	{	177	{
178	switch (ccap_fb) {	178	switch (ccap_fb) {
179	case FB_CCAP_NONE: *ccap_con = CONSOLE_CCAP_NONE; break;	179	case FB_CCAP_NONE: *ccap_con = CONSOLE_CCAP_NONE; break;
180	case FB_CCAP_STYLE: *ccap_con = CONSOLE_CCAP_STYLE; break;	180	case FB_CCAP_STYLE: *ccap_con = CONSOLE_CCAP_STYLE; break;
181	case FB_CCAP_INDEXED: *ccap_con = CONSOLE_CCAP_INDEXED; break;	181	case FB_CCAP_INDEXED: *ccap_con = CONSOLE_CCAP_INDEXED; break;
182	case FB_CCAP_RGB: *ccap_con = CONSOLE_CCAP_RGB; break;	182	case FB_CCAP_RGB: *ccap_con = CONSOLE_CCAP_RGB; break;
183	default: return EINVAL;	183	default: return EINVAL;
184	}	184	}
185		185
186	return EOK;	186	return EOK;
187	}	187	}
188		188
189	/** Send an area of screenbuffer to the FB driver. */	189	/** Send an area of screenbuffer to the FB driver. */
190	static void fb_update_area(console_t *cons, ipcarg_t x0, ipcarg_t y0, ipcarg_t width, ipcarg_t height)	190	static void fb_update_area(console_t *cons, ipcarg_t x0, ipcarg_t y0, ipcarg_t width, ipcarg_t height)
191	{	191	{
192	if (interbuffer) {	192	if (interbuffer) {
193	ipcarg_t x;	193	ipcarg_t x;
194	ipcarg_t y;	194	ipcarg_t y;
195		195
196	for (y = 0; y < height; y++) {	196	for (y = 0; y < height; y++) {
197	for (x = 0; x < width; x++) {	197	for (x = 0; x < width; x++) {
198	interbuffer[y * width + x] =	198	interbuffer[y * width + x] =
199	*get_field_at(&cons->scr, x0 + x, y0 + y);	199	*get_field_at(&cons->scr, x0 + x, y0 + y);
200	}	200	}
201	}	201	}
202		202
203	async_req_4_0(fb_info.phone, FB_DRAW_TEXT_DATA,	203	async_req_4_0(fb_info.phone, FB_DRAW_TEXT_DATA,
204	x0, y0, width, height);	204	x0, y0, width, height);
205	}	205	}
206	}	206	}
207		207
208	/** Flush pending cells to FB. */	208	/** Flush pending cells to FB. */
209	static void fb_pending_flush(void)	209	static void fb_pending_flush(void)
210	{	210	{
211	if (fb_pending.cnt > 0) {	211	if (fb_pending.cnt > 0) {
212	fb_update_area(active_console, fb_pending.col,	212	fb_update_area(active_console, fb_pending.col,
213	fb_pending.row, fb_pending.cnt, 1);	213	fb_pending.row, fb_pending.cnt, 1);
214	fb_pending.cnt = 0;	214	fb_pending.cnt = 0;
215	}	215	}
216	}	216	}
217		217
218	/** Mark a character cell as changed.	218	/** Mark a character cell as changed.
219	*	219	*
220	* This adds the cell to the pending rowspan if possible. Otherwise	220	* This adds the cell to the pending rowspan if possible. Otherwise
221	* the old span is flushed first.	221	* the old span is flushed first.
222	*	222	*
223	*/	223	*/
224	static void cell_mark_changed(size_t col, size_t row)	224	static void cell_mark_changed(size_t col, size_t row)
225	{	225	{
226	if (fb_pending.cnt != 0) {	226	if (fb_pending.cnt != 0) {
227	if ((col != fb_pending.col + fb_pending.cnt)	227	if ((col != fb_pending.col + fb_pending.cnt)
228	\|\| (row != fb_pending.row)) {	228	\|\| (row != fb_pending.row)) {
229	fb_pending_flush();	229	fb_pending_flush();
230	}	230	}
231	}	231	}
232		232
233	if (fb_pending.cnt == 0) {	233	if (fb_pending.cnt == 0) {
234	fb_pending.col = col;	234	fb_pending.col = col;
235	fb_pending.row = row;	235	fb_pending.row = row;
236	}	236	}
237		237
238	fb_pending.cnt++;	238	fb_pending.cnt++;
239	}	239	}
240		240
241	/** Print a character to the active VC with buffering. */	241	/** Print a character to the active VC with buffering. */
242	static void fb_putchar(wchar_t c, ipcarg_t col, ipcarg_t row)	242	static void fb_putchar(wchar_t c, ipcarg_t col, ipcarg_t row)
243	{	243	{
244	async_msg_3(fb_info.phone, FB_PUTCHAR, c, col, row);	244	async_msg_3(fb_info.phone, FB_PUTCHAR, c, col, row);
245	}	245	}
246		246
247	/** Process a character from the client (TTY emulation). */	247	/** Process a character from the client (TTY emulation). */
248	static void write_char(console_t *cons, wchar_t ch)	248	static void write_char(console_t *cons, wchar_t ch)
249	{	249	{
250	bool flush_cursor = false;	250	bool flush_cursor = false;
251		251
252	switch (ch) {	252	switch (ch) {
253	case '\n':	253	case '\n':
254	fb_pending_flush();	254	fb_pending_flush();
255	flush_cursor = true;	255	flush_cursor = true;
256	cons->scr.position_y++;	256	cons->scr.position_y++;
257	cons->scr.position_x = 0;	257	cons->scr.position_x = 0;
258	break;	258	break;
259	case '\r':	259	case '\r':
260	break;	260	break;
261	case '\t':	261	case '\t':
262	cons->scr.position_x += 8;	262	cons->scr.position_x += 8;
263	cons->scr.position_x -= cons->scr.position_x % 8;	263	cons->scr.position_x -= cons->scr.position_x % 8;
264	break;	264	break;
265	case '\b':	265	case '\b':
266	if (cons->scr.position_x == 0)	266	if (cons->scr.position_x == 0)
267	break;	267	break;
268	cons->scr.position_x--;	268	cons->scr.position_x--;
269	if (cons == active_console)	269	if (cons == active_console)
270	cell_mark_changed(cons->scr.position_x, cons->scr.position_y);	270	cell_mark_changed(cons->scr.position_x, cons->scr.position_y);
271	screenbuffer_putchar(&cons->scr, ' ');	271	screenbuffer_putchar(&cons->scr, ' ');
272	break;	272	break;
273	default:	273	default:
274	if (cons == active_console)	274	if (cons == active_console)
275	cell_mark_changed(cons->scr.position_x, cons->scr.position_y);	275	cell_mark_changed(cons->scr.position_x, cons->scr.position_y);
276		276
277	screenbuffer_putchar(&cons->scr, ch);	277	screenbuffer_putchar(&cons->scr, ch);
278	cons->scr.position_x++;	278	cons->scr.position_x++;
279	}	279	}
280		280
281	if (cons->scr.position_x >= cons->scr.size_x) {	281	if (cons->scr.position_x >= cons->scr.size_x) {
282	flush_cursor = true;	282	flush_cursor = true;
283	cons->scr.position_y++;	283	cons->scr.position_y++;
284	}	284	}
285		285
286	if (cons->scr.position_y >= cons->scr.size_y) {	286	if (cons->scr.position_y >= cons->scr.size_y) {
287	fb_pending_flush();	287	fb_pending_flush();
288	cons->scr.position_y = cons->scr.size_y - 1;	288	cons->scr.position_y = cons->scr.size_y - 1;
289	screenbuffer_clear_line(&cons->scr, cons->scr.top_line);	289	screenbuffer_clear_line(&cons->scr, cons->scr.top_line);
290	cons->scr.top_line = (cons->scr.top_line + 1) % cons->scr.size_y;	290	cons->scr.top_line = (cons->scr.top_line + 1) % cons->scr.size_y;
291		291
292	if (cons == active_console)	292	if (cons == active_console)
293	async_msg_1(fb_info.phone, FB_SCROLL, 1);	293	async_msg_1(fb_info.phone, FB_SCROLL, 1);
294	}	294	}
295		295
296	if (cons == active_console && flush_cursor)	296	if (cons == active_console && flush_cursor)
297	curs_goto(cons->scr.position_x, cons->scr.position_y);	297	curs_goto(cons->scr.position_x, cons->scr.position_y);
298	cons->scr.position_x = cons->scr.position_x % cons->scr.size_x;	298	cons->scr.position_x = cons->scr.position_x % cons->scr.size_x;
299	}	299	}
300		300
301	/** Switch to new console */	301	/** Switch to new console */
302	static void change_console(console_t *cons)	302	static void change_console(console_t *cons)
303	{	303	{
304	if (cons == active_console)	304	if (cons == active_console)
305	return;	305	return;
306		306
307	fb_pending_flush();	307	fb_pending_flush();
308		308
309	if (cons == kernel_console) {	309	if (cons == kernel_console) {
310	async_serialize_start();	310	async_serialize_start();
311	curs_hide_sync();	311	curs_hide_sync();
312	gcons_in_kernel();	312	gcons_in_kernel();
313	screen_yield();	313	screen_yield();
314	kbd_yield();	314	kbd_yield();
315	async_serialize_end();	315	async_serialize_end();
316		316
317	if (__SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE)) {	317	if (__SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE)) {
318	prev_console = active_console;	318	prev_console = active_console;
319	active_console = kernel_console;	319	active_console = kernel_console;
320	} else	320	} else
321	cons = active_console;	321	cons = active_console;
322	}	322	}
323		323
324	if (cons != kernel_console) {	324	if (cons != kernel_console) {
325	size_t x;	325	size_t x;
326	size_t y;	326	size_t y;
327	int rc = 0;	327	int rc = 0;
328		328
329	async_serialize_start();	329	async_serialize_start();
330		330
331	if (active_console == kernel_console) {	331	if (active_console == kernel_console) {
332	screen_reclaim();	332	screen_reclaim();
333	kbd_reclaim();	333	kbd_reclaim();
334	gcons_redraw_console();	334	gcons_redraw_console();
335	}	335	}
336		336
337	active_console = cons;	337	active_console = cons;
338	gcons_change_console(cons->index);	338	gcons_change_console(cons->index);
339		339
340	set_attrs(&cons->scr.attrs);	340	set_attrs(&cons->scr.attrs);
341	curs_visibility(false);	341	curs_visibility(false);
342	if (interbuffer) {	342	if (interbuffer) {
343	for (y = 0; y < cons->scr.size_y; y++) {	343	for (y = 0; y < cons->scr.size_y; y++) {
344	for (x = 0; x < cons->scr.size_x; x++) {	344	for (x = 0; x < cons->scr.size_x; x++) {
345	interbuffer[y * cons->scr.size_x + x] =	345	interbuffer[y * cons->scr.size_x + x] =
346	*get_field_at(&cons->scr, x, y);	346	*get_field_at(&cons->scr, x, y);
347	}	347	}
348	}	348	}
349		349
350	/* This call can preempt, but we are already at the end */	350	/* This call can preempt, but we are already at the end */
351	rc = async_req_4_0(fb_info.phone, FB_DRAW_TEXT_DATA,	351	rc = async_req_4_0(fb_info.phone, FB_DRAW_TEXT_DATA,
352	0, 0, cons->scr.size_x,	352	0, 0, cons->scr.size_x,
353	cons->scr.size_y);	353	cons->scr.size_y);
354	}	354	}
355		355
356	if ((!interbuffer) \|\| (rc != 0)) {	356	if ((!interbuffer) \|\| (rc != 0)) {
357	set_attrs(&cons->scr.attrs);	357	set_attrs(&cons->scr.attrs);
358	screen_clear();	358	screen_clear();
359		359
360	for (y = 0; y < cons->scr.size_y; y++)	360	for (y = 0; y < cons->scr.size_y; y++)
361	for (x = 0; x < cons->scr.size_x; x++) {	361	for (x = 0; x < cons->scr.size_x; x++) {
362	keyfield_t *field = get_field_at(&cons->scr, x, y);	362	keyfield_t *field = get_field_at(&cons->scr, x, y);
363		363
364	if (!attrs_same(cons->scr.attrs, field->attrs))	364	if (!attrs_same(cons->scr.attrs, field->attrs))
365	set_attrs(&field->attrs);	365	set_attrs(&field->attrs);
366		366
367	cons->scr.attrs = field->attrs;	367	cons->scr.attrs = field->attrs;
368	if ((field->character == ' ') &&	368	if ((field->character == ' ') &&
369	(attrs_same(field->attrs, cons->scr.attrs)))	369	(attrs_same(field->attrs, cons->scr.attrs)))
370	continue;	370	continue;
371		371
372	fb_putchar(field->character, x, y);	372	fb_putchar(field->character, x, y);
373	}	373	}
374	}	374	}
375		375
376	curs_goto(cons->scr.position_x, cons->scr.position_y);	376	curs_goto(cons->scr.position_x, cons->scr.position_y);
377	curs_visibility(cons->scr.is_cursor_visible);	377	curs_visibility(cons->scr.is_cursor_visible);
378		378
379	async_serialize_end();	379	async_serialize_end();
380	}	380	}
381	}	381	}
382		382
383	/** Handler for keyboard */	383	/** Handler for keyboard */
384	static void keyboard_events(ipc_callid_t iid, ipc_call_t *icall)	384	static void keyboard_events(ipc_callid_t iid, ipc_call_t *icall)
385	{	385	{
386	/* Ignore parameters, the connection is already opened */	386	/* Ignore parameters, the connection is already opened */
387	while (true) {	387	while (true) {
388		388
389	ipc_call_t call;	389	ipc_call_t call;
390	ipc_callid_t callid = async_get_call(&call);	390	ipc_callid_t callid = async_get_call(&call);
391		391
392	int retval;	392	int retval;
393	console_event_t ev;	393	console_event_t ev;
394		394
395	switch (IPC_GET_METHOD(call)) {	395	switch (IPC_GET_METHOD(call)) {
396	case IPC_M_PHONE_HUNGUP:	396	case IPC_M_PHONE_HUNGUP:
397	/* TODO: Handle hangup */	397	/* TODO: Handle hangup */
398	return;	398	return;
399	case KBD_EVENT:	399	case KBD_EVENT:
400	/* Got event from keyboard driver. */	400	/* Got event from keyboard driver. */
401	retval = 0;	401	retval = 0;
402	ev.type = IPC_GET_ARG1(call);	402	ev.type = IPC_GET_ARG1(call);
403	ev.key = IPC_GET_ARG2(call);	403	ev.key = IPC_GET_ARG2(call);
404	ev.mods = IPC_GET_ARG3(call);	404	ev.mods = IPC_GET_ARG3(call);
405	ev.c = IPC_GET_ARG4(call);	405	ev.c = IPC_GET_ARG4(call);
406		406
407	if ((ev.key >= KC_F1) && (ev.key < KC_F1 +	407	if ((ev.key >= KC_F1) && (ev.key < KC_F1 +
408	CONSOLE_COUNT) && ((ev.mods & KM_CTRL) == 0)) {	408	CONSOLE_COUNT) && ((ev.mods & KM_CTRL) == 0)) {
409	if (ev.key == KC_F1 + KERNEL_CONSOLE)	409	if (ev.key == KC_F1 + KERNEL_CONSOLE)
410	change_console(kernel_console);	410	change_console(kernel_console);
411	else	411	else
412	change_console(&consoles[ev.key - KC_F1]);	412	change_console(&consoles[ev.key - KC_F1]);
413	break;	413	break;
414	}	414	}
415		415
416	fibril_mutex_lock(&input_mutex);	416	fibril_mutex_lock(&input_mutex);
417	keybuffer_push(&active_console->keybuffer, &ev);	417	keybuffer_push(&active_console->keybuffer, &ev);
418	fibril_condvar_broadcast(&input_cv);	418	fibril_condvar_broadcast(&input_cv);
419	fibril_mutex_unlock(&input_mutex);	419	fibril_mutex_unlock(&input_mutex);
420	break;	420	break;
421	default:	421	default:
422	retval = ENOENT;	422	retval = ENOENT;
423	}	423	}
424	ipc_answer_0(callid, retval);	424	ipc_answer_0(callid, retval);
425	}	425	}
426	}	426	}
427		427
428	static void cons_write(console_t cons, ipc_callid_t rid, ipc_call_t request)	428	static void cons_write(console_t cons, ipc_callid_t rid, ipc_call_t request)
429	{	429	{
430	ipc_callid_t callid;	430	ipc_callid_t callid;
431	size_t size;	431	size_t size;
432	if (!ipc_data_write_receive(&callid, &size)) {	432	if (!ipc_data_write_receive(&callid, &size)) {
433	ipc_answer_0(callid, EINVAL);	433	ipc_answer_0(callid, EINVAL);
434	ipc_answer_0(rid, EINVAL);	434	ipc_answer_0(rid, EINVAL);
435	return;	435	return;
436	}	436	}
437		437
438	char buf = (char ) malloc(size);	438	char buf = (char ) malloc(size);
439	if (buf == NULL) {	439	if (buf == NULL) {
440	ipc_answer_0(callid, ENOMEM);	440	ipc_answer_0(callid, ENOMEM);
441	ipc_answer_0(rid, ENOMEM);	441	ipc_answer_0(rid, ENOMEM);
442	return;	442	return;
443	}	443	}
444		444
445	(void) ipc_data_write_finalize(callid, buf, size);	445	(void) ipc_data_write_finalize(callid, buf, size);
446		446
447	async_serialize_start();	447	async_serialize_start();
448		448
449	size_t off = 0;	449	size_t off = 0;
450	while (off < size) {	450	while (off < size) {
451	wchar_t ch = str_decode(buf, &off, size);	451	wchar_t ch = str_decode(buf, &off, size);
452	write_char(cons, ch);	452	write_char(cons, ch);
453	}	453	}
454		454
455	async_serialize_end();	455	async_serialize_end();
456		456
457	gcons_notify_char(cons->index);	457	gcons_notify_char(cons->index);
458	ipc_answer_1(rid, EOK, size);	458	ipc_answer_1(rid, EOK, size);
459		459
460	free(buf);	460	free(buf);
461	}	461	}
462		462
463	static void cons_read(console_t cons, ipc_callid_t rid, ipc_call_t request)	463	static void cons_read(console_t cons, ipc_callid_t rid, ipc_call_t request)
464	{	464	{
465	ipc_callid_t callid;	465	ipc_callid_t callid;
466	size_t size;	466	size_t size;
467	if (!ipc_data_read_receive(&callid, &size)) {	467	if (!ipc_data_read_receive(&callid, &size)) {
468	ipc_answer_0(callid, EINVAL);	468	ipc_answer_0(callid, EINVAL);
469	ipc_answer_0(rid, EINVAL);	469	ipc_answer_0(rid, EINVAL);
470	return;	470	return;
471	}	471	}
472		472
473	char buf = (char ) malloc(size);	473	char buf = (char ) malloc(size);
474	if (buf == NULL) {	474	if (buf == NULL) {
475	ipc_answer_0(callid, ENOMEM);	475	ipc_answer_0(callid, ENOMEM);
476	ipc_answer_0(rid, ENOMEM);	476	ipc_answer_0(rid, ENOMEM);
477	return;	477	return;
478	}	478	}
479		479
480	size_t pos = 0;	480	size_t pos = 0;
481	console_event_t ev;	481	console_event_t ev;
482	fibril_mutex_lock(&input_mutex);	482	fibril_mutex_lock(&input_mutex);
483	recheck:	483	recheck:
484	while ((keybuffer_pop(&cons->keybuffer, &ev)) && (pos < size)) {	484	while ((keybuffer_pop(&cons->keybuffer, &ev)) && (pos < size)) {
485	if (ev.type == KEY_PRESS) {	485	if (ev.type == KEY_PRESS) {
486	buf[pos] = ev.c;	486	buf[pos] = ev.c;
487	pos++;	487	pos++;
488	}	488	}
489	}	489	}
490		490
491	if (pos == size) {	491	if (pos == size) {
492	(void) ipc_data_read_finalize(callid, buf, size);	492	(void) ipc_data_read_finalize(callid, buf, size);
493	ipc_answer_1(rid, EOK, size);	493	ipc_answer_1(rid, EOK, size);
494	free(buf);	494	free(buf);
495	} else {	495	} else {
496	fibril_condvar_wait(&input_cv, &input_mutex);	496	fibril_condvar_wait(&input_cv, &input_mutex);
497	goto recheck;	497	goto recheck;
498	}	498	}
499	fibril_mutex_unlock(&input_mutex);	499	fibril_mutex_unlock(&input_mutex);
500	}	500	}

Subversion Repositories HelenOS

(root)/branches/dd/uspace/srv/console/console.c – Rev 4668 → 4688