WebSVN – HelenOS – Diff – /trunk/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 <kbd/keycode.h>
#include <ipc/fb.h>
#include <ipc/services.h>
#include <errno.h>
#include <key_buffer.h>
#include <ipc/console.h>
#include <unistd.h>
#include <async.h>
#include <libadt/fifo.h>
#include <screenbuffer.h>
#include <sys/mman.h>
#include <stdio.h>
#include <sysinfo.h>
 
#include "console.h"
#include "gcons.h"
 
#define MAX_KEYREQUESTS_BUFFERED 32
 
#define NAME "console"
 
/** Index of currently used virtual console.
 */
int active_console = 0;
int prev_console = 0;
 
/** Information about framebuffer */
struct {
    int phone;      /**< Framebuffer phone */
    ipcarg_t rows;      /**< Framebuffer rows */
    ipcarg_t cols;      /**< Framebuffer columns */
} fb_info;
 
typedef struct {
    keybuffer_t keybuffer;      /**< Buffer for incoming keys. */
    /** Buffer for unsatisfied request for keys. */
    FIFO_CREATE_STATIC(keyrequests, ipc_callid_t,
        MAX_KEYREQUESTS_BUFFERED); 
    int keyrequest_counter;     /**< Number of requests in buffer. */
    int client_phone;       /**< Phone to connected client. */
    int used;           /**< 1 if this virtual console is
                     * connected to some client.*/
    screenbuffer_t screenbuffer;    /**< Screenbuffer for saving screen
                     * contents and related settings. */
} connection_t;
 
static connection_t connections[CONSOLE_COUNT]; /**< Array of data for virtual
                         * consoles */
static keyfield_t *interbuffer = NULL;      /**< Pointer to memory shared
                         * with framebufer used for
                         * faster virtual console
                         * switching */
 
/** Information on row-span yet unsent to FB driver. */
struct {
    int row;        /**< Row where the span lies. */
    int col;        /**< Leftmost column of the span. */
    int n;          /**< Width of the span. */
} fb_pending;
 
/** Size of cwrite_buf. */
#define CWRITE_BUF_SIZE 256
 
/** Buffer for receiving data via the CONSOLE_WRITE call from the client. */
static char cwrite_buf[CWRITE_BUF_SIZE];
 
static void fb_putchar(char c, int row, int col);
 
 
/** Find unused virtual console.
 *
 */
static int find_free_connection(void)
{
    int i;
   
    for (i = 0; i < CONSOLE_COUNT; i++) {
        if (!connections[i].used)
            return i;
    }
    return -1;
}
 
static void clrscr(void)
{
    async_msg_0(fb_info.phone, FB_CLEAR);
}
 
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(int row, int col)
{
    async_msg_2(fb_info.phone, FB_CURSOR_GOTO, row, col);
}
 
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;
    }
}
 
/** Send an area of screenbuffer to the FB driver. */
static void fb_update_area(connection_t *conn, int x, int y, int w, int h)
{
    int i, j;
    int rc;
    attrs_t *attrs;
    keyfield_t *field;
 
    if (interbuffer) {
        for (j = 0; j < h; j++) {
            for (i = 0; i < w; i++) {
                interbuffer[i + j * w] =
                    *get_field_at(&conn->screenbuffer,
                    x + i, y + j);
            }
        }
 
        rc = async_req_4_0(fb_info.phone, FB_DRAW_TEXT_DATA,
            x, y, w, h);
    } else {
        rc = ENOTSUP;
    }
 
    if (rc != 0) {
        attrs = &conn->screenbuffer.attrs;
 
        for (j = 0; j < h; j++) {
            for (i = 0; i < w; i++) {
                field = get_field_at(&conn->screenbuffer,
                    x + i, y + j);
                if (!attrs_same(*attrs, field->attrs))
                    set_attrs(&field->attrs);
                attrs = &field->attrs;
 
                fb_putchar(field->character, y + j, x + i);
            }
        }
    }
}
 
/** Flush pending cells to FB. */
static void fb_pending_flush(void)
{
    screenbuffer_t *scr;
 
    scr = &(connections[active_console].screenbuffer);
 
    if (fb_pending.n > 0) {
        fb_update_area(&connections[active_console], fb_pending.col,
            fb_pending.row, fb_pending.n, 1);
        fb_pending.n = 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(int row, int col)
{
    if (fb_pending.n != 0) {
        if (row != fb_pending.row ||
            col != fb_pending.col + fb_pending.n) {
            fb_pending_flush();
        }
    }
 
    if (fb_pending.n == 0) {
        fb_pending.row = row;
        fb_pending.col = col;
    }
 
    ++fb_pending.n;
}
 
 
/** Print a character to the active VC with buffering. */
static void fb_putchar(char c, int row, int col)
{
    async_msg_3(fb_info.phone, FB_PUTCHAR, c, row, col);
}
 
/** Process a character from the client (TTY emulation). */
static void write_char(int console, char key)
{
    bool flush_cursor = false;
    screenbuffer_t *scr = &(connections[console].screenbuffer);
 
    switch (key) {
    case '\n':
        fb_pending_flush();
        flush_cursor = true;
        scr->position_y++;
        scr->position_x = 0;
        break;
    case '\r':
        break;
    case '\t':
        scr->position_x += 8;
        scr->position_x -= scr->position_x % 8;
        break;
    case '\b':
        if (scr->position_x == 0)
            break;
        scr->position_x--;
        if (console == active_console)
            cell_mark_changed(scr->position_y, scr->position_x);
        screenbuffer_putchar(scr, ' ');
        break;
    default:   
        if (console == active_console)
            cell_mark_changed(scr->position_y, scr->position_x);
 
        screenbuffer_putchar(scr, key);
        scr->position_x++;
    }
 
    if (scr->position_x >= scr->size_x) {
        flush_cursor = true;
        scr->position_y++;
    }
   
    if (scr->position_y >= scr->size_y) {
        fb_pending_flush();
        scr->position_y = scr->size_y - 1;
        screenbuffer_clear_line(scr, scr->top_line);
        scr->top_line = (scr->top_line + 1) % scr->size_y;
        if (console == active_console)
            async_msg_1(fb_info.phone, FB_SCROLL, 1);
    }
 
    scr->position_x = scr->position_x % scr->size_x;
 
    if (console == active_console && flush_cursor)
        curs_goto(scr->position_y, scr->position_x);
}
 
/** Switch to new console */
static void change_console(int newcons)
{
    connection_t *conn;
    int i, j, rc;
    keyfield_t *field;
    attrs_t *attrs;
   
    if (newcons == active_console)
        return;
 
    fb_pending_flush();
 
    if (newcons == KERNEL_CONSOLE) {
        async_serialize_start();
        curs_hide_sync();
        gcons_in_kernel();
        async_serialize_end();
       
        if (__SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE)) {
            prev_console = active_console;
            active_console = KERNEL_CONSOLE;
        } else
            newcons = active_console;
    }
   
    if (newcons != KERNEL_CONSOLE) {
        async_serialize_start();
       
        if (active_console == KERNEL_CONSOLE)
            gcons_redraw_console();
       
        active_console = newcons;
        gcons_change_console(newcons);
        conn = &connections[active_console];
       
        set_attrs(&conn->screenbuffer.attrs);
        curs_visibility(false);
        if (interbuffer) {
            for (j = 0; j < conn->screenbuffer.size_y; j++) {
                for (i = 0; i < conn->screenbuffer.size_x; i++) {
                    unsigned int size_x;
                   
                    size_x = conn->screenbuffer.size_x;
                    interbuffer[j * size_x + i] =
                        *get_field_at(&conn->screenbuffer, i, j);
                }
            }
            /* 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, conn->screenbuffer.size_x,
                conn->screenbuffer.size_y);
        }
       
        if ((!interbuffer) || (rc != 0)) {
            set_attrs(&conn->screenbuffer.attrs);
            clrscr();
            attrs = &conn->screenbuffer.attrs;
           
            for (j = 0; j < conn->screenbuffer.size_y; j++)
                for (i = 0; i < conn->screenbuffer.size_x; i++) {
                    field = get_field_at(&conn->screenbuffer, i, j);
                    if (!attrs_same(*attrs, field->attrs))
                        set_attrs(&field->attrs);
                    attrs = &field->attrs;
                    if ((field->character == ' ') &&
                        (attrs_same(field->attrs,
                        conn->screenbuffer.attrs)))
                        continue;
 
                    fb_putchar(field->character, j, i);
                }
        }
       
        curs_goto(conn->screenbuffer.position_y,
            conn->screenbuffer.position_x);
        curs_visibility(conn->screenbuffer.is_cursor_visible);
       
        async_serialize_end();
    }
}
 
/** Handler for keyboard */
static void keyboard_events(ipc_callid_t iid, ipc_call_t *icall)
{
    ipc_callid_t callid;
    ipc_call_t call;
    int retval;
    kbd_event_t ev;
    connection_t *conn;
    int newcon;
   
    /* Ignore parameters, the connection is alread opened */
    while (1) {
        callid = async_get_call(&call);
        switch (IPC_GET_METHOD(call)) {
        case IPC_M_PHONE_HUNGUP:
            /* TODO: Handle hangup */
            return;
        case KBD_MS_LEFT:
            newcon = gcons_mouse_btn(IPC_GET_ARG1(call));
            if (newcon != -1)
                change_console(newcon);
            retval = 0;
            break;
        case KBD_MS_MOVE:
            gcons_mouse_move(IPC_GET_ARG1(call),
                IPC_GET_ARG2(call));
            retval = 0;
            break;
        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);
           
            /* switch to another virtual console */
           
            conn = &connections[active_console];
 
            if ((ev.key >= KC_F1) && (ev.key < KC_F1 +
                CONSOLE_COUNT)) {
                if (ev.key == KC_F12)
                    change_console(KERNEL_CONSOLE);
                else
                    change_console(ev.key - KC_F1);
                break;
            }
           
            /* if client is awaiting key, send it */
            if (conn->keyrequest_counter > 0) {    
                conn->keyrequest_counter--;
                ipc_answer_4(fifo_pop(conn->keyrequests), EOK,
                    ev.type, ev.key, ev.mods, ev.c);
                break;
            }
 
            keybuffer_push(&conn->keybuffer, &ev);
            retval = 0;
 
            break;
        default:
            retval = ENOENT;
        }
        ipc_answer_0(callid, retval);
    }
}
 
/** Handle CONSOLE_WRITE call. */
static void cons_write(int consnum, ipc_callid_t rid, ipc_call_t *request)
{
    ipc_callid_t callid;
    size_t len;
    size_t i;
 
    if (!ipc_data_write_receive(&callid, &len)) {
        ipc_answer_0(callid, EINVAL);
        ipc_answer_0(rid, EINVAL);
    }
 
    if (len > CWRITE_BUF_SIZE)
        len = CWRITE_BUF_SIZE;
 
    (void) ipc_data_write_finalize(callid, cwrite_buf, len);
 
    for (i = 0; i < len; i++) {
        write_char(consnum, cwrite_buf[i]);
    }
 
    gcons_notify_char(consnum);
    ipc_answer_1(rid, EOK, len);
}
 
/** Default thread for new connections */
static void client_connection(ipc_callid_t iid, ipc_call_t *icall)
{
    ipc_callid_t callid;
    ipc_call_t call;
    int consnum;
    ipcarg_t arg1, arg2, arg3, arg4;
    connection_t *conn;
    screenbuffer_t *scr;
   
    if ((consnum = find_free_connection()) == -1) {
        ipc_answer_0(iid, ELIMIT);
        return;
    }
    conn = &connections[consnum];
    conn->used = 1;
   
    async_serialize_start();
    gcons_notify_connect(consnum);
    conn->client_phone = IPC_GET_ARG5(*icall);
    screenbuffer_clear(&conn->screenbuffer);
   
    /* Accept the connection */
    ipc_answer_0(iid, EOK);
   
    while (1) {
        async_serialize_end();
        callid = async_get_call(&call);
        async_serialize_start();
       
        arg1 = 0;
        arg2 = 0;
        arg3 = 0;
        arg4 = 0;
 
        switch (IPC_GET_METHOD(call)) {
        case IPC_M_PHONE_HUNGUP:
            gcons_notify_disconnect(consnum);
           
            /* Answer all pending requests */
            while (conn->keyrequest_counter > 0) {
                conn->keyrequest_counter--;
                ipc_answer_0(fifo_pop(conn->keyrequests),
                    ENOENT);
                break;
            }
            conn->used = 0;
            return;
        case CONSOLE_PUTCHAR:
            write_char(consnum, IPC_GET_ARG1(call));
            gcons_notify_char(consnum);
            break;
        case CONSOLE_WRITE:
            cons_write(consnum, callid, &call);
            continue;
        case CONSOLE_CLEAR:
            /* Send message to fb */
            if (consnum == active_console) {
                async_msg_0(fb_info.phone, FB_CLEAR);
            }
           
            screenbuffer_clear(&conn->screenbuffer);
           
            break;
        case CONSOLE_GOTO:
            screenbuffer_goto(&conn->screenbuffer,
                IPC_GET_ARG2(call), IPC_GET_ARG1(call));
            if (consnum == active_console)
                curs_goto(IPC_GET_ARG1(call),
                    IPC_GET_ARG2(call));
            break;
        case CONSOLE_GETSIZE:
            arg1 = fb_info.rows;
            arg2 = fb_info.cols;
            break;
        case CONSOLE_FLUSH:
            fb_pending_flush();
            if (consnum == active_console) {
                async_req_0_0(fb_info.phone, FB_FLUSH);
 
                scr = &(connections[consnum].screenbuffer);
                curs_goto(scr->position_y, scr->position_x);
            }
            break;
        case CONSOLE_SET_STYLE:
            fb_pending_flush();
            arg1 = IPC_GET_ARG1(call);
            screenbuffer_set_style(&conn->screenbuffer, arg1);
            if (consnum == 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(&conn->screenbuffer, arg1,
                arg2, arg3);
            if (consnum == 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(&conn->screenbuffer, arg1,
                arg2);
            if (consnum == active_console)
                set_rgb_color(arg1, arg2);
            break;
        case CONSOLE_CURSOR_VISIBILITY:
            fb_pending_flush();
            arg1 = IPC_GET_ARG1(call);
            conn->screenbuffer.is_cursor_visible = arg1;
            if (consnum == active_console)
                curs_visibility(arg1);
            break;
        case CONSOLE_GETKEY:
            if (keybuffer_empty(&conn->keybuffer)) {
                /* buffer is empty -> store request */
                if (conn->keyrequest_counter <
                    MAX_KEYREQUESTS_BUFFERED) {
                    fifo_push(conn->keyrequests, callid);
                    conn->keyrequest_counter++;
                } else {
                    /*
                     * No key available and too many
                     * requests => fail.
                    */
                    ipc_answer_0(callid, ELIMIT);
                }
                continue;
            }
            kbd_event_t ev;
            keybuffer_pop(&conn->keybuffer, &ev);
            arg1 = ev.type;
            arg2 = ev.key;
            arg3 = ev.mods;
            arg4 = ev.c;
            break;
        case CONSOLE_KCON_ENABLE:
            change_console(KERNEL_CONSOLE);
            break;
        }
        ipc_answer_4(callid, EOK, arg1, arg2, arg3, arg4);
    }
}
 
static void interrupt_received(ipc_callid_t callid, ipc_call_t *call)
{
    change_console(prev_console);
}
 
int main(int argc, char *argv[])
{
    printf(NAME ": HelenOS Console service\n");
   
    ipcarg_t phonehash;
    int kbd_phone;
    size_t ib_size;
    int i;
   
    async_set_client_connection(client_connection);
   
    /* 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 -1;
    }
   
    if (ipc_connect_to_me(kbd_phone, SERVICE_CONSOLE, 0, 0, &phonehash) != 0) {
        printf(NAME ": Failed to create callback from keyboard service\n");
        return -1;
    }
   
    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;
    }
   
    /* Disable kernel output to the console */
    __SYSCALL0(SYS_DEBUG_DISABLE_CONSOLE);
   
    /* Initialize gcons */
    gcons_init(fb_info.phone);
    /* Synchronize, the gcons can have something in queue */
    async_req_0_0(fb_info.phone, FB_FLUSH);
   
    async_req_0_2(fb_info.phone, FB_GET_CSIZE, &fb_info.rows,
        &fb_info.cols);
    set_rgb_color(DEFAULT_FOREGROUND, DEFAULT_BACKGROUND);
    clrscr();
   
    /* Init virtual consoles */
    for (i = 0; i < CONSOLE_COUNT; i++) {
        connections[i].used = 0;
        keybuffer_init(&connections[i].keybuffer);
       
        connections[i].keyrequests.head = 0;
        connections[i].keyrequests.tail = 0;
        connections[i].keyrequests.items = MAX_KEYREQUESTS_BUFFERED;
        connections[i].keyrequest_counter = 0;
       
        if (screenbuffer_init(&connections[i].screenbuffer,
            fb_info.cols, fb_info.rows) == NULL) {
            /* FIXME: handle error */
            return -1;
        }
    }
    connections[KERNEL_CONSOLE].used = 1;
 
    /* Set up shared memory buffer. */
    ib_size = sizeof(keyfield_t) * fb_info.cols * fb_info.rows;
    interbuffer = as_get_mappable_page(ib_size);
 
    fb_pending.n = 0;
 
    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;
        }
    }
   
    curs_goto(0, 0);
    curs_visibility(
        connections[active_console].screenbuffer.is_cursor_visible);
   
    /* Register at NS */
    if (ipc_connect_to_me(PHONE_NS, SERVICE_CONSOLE, 0, 0, &phonehash) != 0)
        return -1;
   
    /* Receive kernel notifications */
//  if (sysinfo_value("kconsole.present")) {
//      int inr = sysinfo_value("kconsole.inr");
//      if (ipc_register_irq(inr, device_assign_devno(), 0, NULL) != EOK)
//          printf(NAME ": Error registering kconsole notifications\n");
//      
//      async_set_interrupt_received(interrupt_received);
//  }
   
    // FIXME: avoid connectiong to itself, keep using klog
    // printf(NAME ": Accepting connections\n");
    async_manager();
   
    return 0;
}
 
/** @}
 */
 

Rev 4167	Rev 4168
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 <kbd/keycode.h>	39	#include <kbd/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 <key_buffer.h>	43	#include <key_buffer.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 <libadt/fifo.h>	47	#include <libadt/fifo.h>
48	#include <screenbuffer.h>	48	#include <screenbuffer.h>
49	#include <sys/mman.h>	49	#include <sys/mman.h>
50	#include <stdio.h>	50	#include <stdio.h>
51	#include <sysinfo.h>	51	#include <sysinfo.h>
52		52
53	#include "console.h"	53	#include "console.h"
54	#include "gcons.h"	54	#include "gcons.h"
55		55
56	#define MAX_KEYREQUESTS_BUFFERED 32	56	#define MAX_KEYREQUESTS_BUFFERED 32
57		57
58	#define NAME "console"	58	#define NAME "console"
59		59
60	/** Index of currently used virtual console.	60	/** Index of currently used virtual console.
61	*/	61	*/
62	int active_console = 0;	62	int active_console = 0;
63	int prev_console = 0;	63	int prev_console = 0;
64		64
65	/** Information about framebuffer */	65	/** Information about framebuffer */
66	struct {	66	struct {
67	int phone; /*< Framebuffer phone /	67	int phone; /*< Framebuffer phone /
68	ipcarg_t rows; /*< Framebuffer rows /	68	ipcarg_t rows; /*< Framebuffer rows /
69	ipcarg_t cols; /*< Framebuffer columns /	69	ipcarg_t cols; /*< Framebuffer columns /
70	} fb_info;	70	} fb_info;
71		71
72	typedef struct {	72	typedef struct {
73	keybuffer_t keybuffer; /*< Buffer for incoming keys. /	73	keybuffer_t keybuffer; /*< Buffer for incoming keys. /
74	/** Buffer for unsatisfied request for keys. */	74	/** Buffer for unsatisfied request for keys. */
75	FIFO_CREATE_STATIC(keyrequests, ipc_callid_t,	75	FIFO_CREATE_STATIC(keyrequests, ipc_callid_t,
76	MAX_KEYREQUESTS_BUFFERED);	76	MAX_KEYREQUESTS_BUFFERED);
77	int keyrequest_counter; /*< Number of requests in buffer. /	77	int keyrequest_counter; /*< Number of requests in buffer. /
78	int client_phone; /*< Phone to connected client. /	78	int client_phone; /*< Phone to connected client. /
79	int used; /**< 1 if this virtual console is	79	int used; /**< 1 if this virtual console is
80	* connected to some client.*/	80	* connected to some client.*/
81	screenbuffer_t screenbuffer; /**< Screenbuffer for saving screen	81	screenbuffer_t screenbuffer; /**< Screenbuffer for saving screen
82	* contents and related settings. */	82	* contents and related settings. */
83	} connection_t;	83	} connection_t;
84		84
85	static connection_t connections[CONSOLE_COUNT]; /**< Array of data for virtual	85	static connection_t connections[CONSOLE_COUNT]; /**< Array of data for virtual
86	* consoles */	86	* consoles */
87	static keyfield_t interbuffer = NULL; /*< Pointer to memory shared	87	static keyfield_t interbuffer = NULL; /*< Pointer to memory shared
88	* with framebufer used for	88	* with framebufer used for
89	* faster virtual console	89	* faster virtual console
90	* switching */	90	* switching */
91		91
92	/** Information on row-span yet unsent to FB driver. */	92	/** Information on row-span yet unsent to FB driver. */
93	struct {	93	struct {
94	int row; /*< Row where the span lies. /	94	int row; /*< Row where the span lies. /
95	int col; /*< Leftmost column of the span. /	95	int col; /*< Leftmost column of the span. /
96	int n; /*< Width of the span. /	96	int n; /*< Width of the span. /
97	} fb_pending;	97	} fb_pending;
98		98
99	/** Size of cwrite_buf. */	99	/** Size of cwrite_buf. */
100	#define CWRITE_BUF_SIZE 256	100	#define CWRITE_BUF_SIZE 256
101		101
102	/** Buffer for receiving data via the CONSOLE_WRITE call from the client. */	102	/** Buffer for receiving data via the CONSOLE_WRITE call from the client. */
103	static char cwrite_buf[CWRITE_BUF_SIZE];	103	static char cwrite_buf[CWRITE_BUF_SIZE];
104		104
105	static void fb_putchar(char c, int row, int col);	105	static void fb_putchar(char c, int row, int col);
106		106
107		107
108	/** Find unused virtual console.	108	/** Find unused virtual console.
109	*	109	*
110	*/	110	*/
111	static int find_free_connection(void)	111	static int find_free_connection(void)
112	{	112	{
113	int i;	113	int i;
114		114
115	for (i = 0; i < CONSOLE_COUNT; i++) {	115	for (i = 0; i < CONSOLE_COUNT; i++) {
116	if (!connections[i].used)	116	if (!connections[i].used)
117	return i;	117	return i;
118	}	118	}
119	return -1;	119	return -1;
120	}	120	}
121		121
122	static void clrscr(void)	122	static void clrscr(void)
123	{	123	{
124	async_msg_0(fb_info.phone, FB_CLEAR);	124	async_msg_0(fb_info.phone, FB_CLEAR);
125	}	125	}
126		126
127	static void curs_visibility(bool visible)	127	static void curs_visibility(bool visible)
128	{	128	{
129	async_msg_1(fb_info.phone, FB_CURSOR_VISIBILITY, visible);	129	async_msg_1(fb_info.phone, FB_CURSOR_VISIBILITY, visible);
130	}	130	}
131		131
132	static void curs_hide_sync(void)	132	static void curs_hide_sync(void)
133	{	133	{
134	ipc_call_sync_1_0(fb_info.phone, FB_CURSOR_VISIBILITY, false);	134	ipc_call_sync_1_0(fb_info.phone, FB_CURSOR_VISIBILITY, false);
135	}	135	}
136		136
137	static void curs_goto(int row, int col)	137	static void curs_goto(int row, int col)
138	{	138	{
139	async_msg_2(fb_info.phone, FB_CURSOR_GOTO, row, col);	139	async_msg_2(fb_info.phone, FB_CURSOR_GOTO, row, col);
140	}	140	}
141		141
142	static void set_style(int style)	142	static void set_style(int style)
143	{	143	{
144	async_msg_1(fb_info.phone, FB_SET_STYLE, style);	144	async_msg_1(fb_info.phone, FB_SET_STYLE, style);
145	}	145	}
146		146
147	static void set_color(int fgcolor, int bgcolor, int flags)	147	static void set_color(int fgcolor, int bgcolor, int flags)
148	{	148	{
149	async_msg_3(fb_info.phone, FB_SET_COLOR, fgcolor, bgcolor, flags);	149	async_msg_3(fb_info.phone, FB_SET_COLOR, fgcolor, bgcolor, flags);
150	}	150	}
151		151
152	static void set_rgb_color(int fgcolor, int bgcolor)	152	static void set_rgb_color(int fgcolor, int bgcolor)
153	{	153	{
154	async_msg_2(fb_info.phone, FB_SET_RGB_COLOR, fgcolor, bgcolor);	154	async_msg_2(fb_info.phone, FB_SET_RGB_COLOR, fgcolor, bgcolor);
155	}	155	}
156		156
157	static void set_attrs(attrs_t *attrs)	157	static void set_attrs(attrs_t *attrs)
158	{	158	{
159	switch (attrs->t) {	159	switch (attrs->t) {
160	case at_style:	160	case at_style:
161	set_style(attrs->a.s.style);	161	set_style(attrs->a.s.style);
162	break;	162	break;
163		163
164	case at_idx:	164	case at_idx:
165	set_color(attrs->a.i.fg_color, attrs->a.i.bg_color,	165	set_color(attrs->a.i.fg_color, attrs->a.i.bg_color,
166	attrs->a.i.flags);	166	attrs->a.i.flags);
167	break;	167	break;
168		168
169	case at_rgb:	169	case at_rgb:
170	set_rgb_color(attrs->a.r.fg_color, attrs->a.r.bg_color);	170	set_rgb_color(attrs->a.r.fg_color, attrs->a.r.bg_color);
171	break;	171	break;
172	}	172	}
173	}	173	}
174		174
175	/** Send an area of screenbuffer to the FB driver. */	175	/** Send an area of screenbuffer to the FB driver. */
176	static void fb_update_area(connection_t *conn, int x, int y, int w, int h)	176	static void fb_update_area(connection_t *conn, int x, int y, int w, int h)
177	{	177	{
178	int i, j;	178	int i, j;
179	int rc;	179	int rc;
180	attrs_t *attrs;	180	attrs_t *attrs;
181	keyfield_t *field;	181	keyfield_t *field;
182		182
183	if (interbuffer) {	183	if (interbuffer) {
184	for (j = 0; j < h; j++) {	184	for (j = 0; j < h; j++) {
185	for (i = 0; i < w; i++) {	185	for (i = 0; i < w; i++) {
186	interbuffer[i + j * w] =	186	interbuffer[i + j * w] =
187	*get_field_at(&conn->screenbuffer,	187	*get_field_at(&conn->screenbuffer,
188	x + i, y + j);	188	x + i, y + j);
189	}	189	}
190	}	190	}
191		191
192	rc = async_req_4_0(fb_info.phone, FB_DRAW_TEXT_DATA,	192	rc = async_req_4_0(fb_info.phone, FB_DRAW_TEXT_DATA,
193	x, y, w, h);	193	x, y, w, h);
194	} else {	194	} else {
195	rc = ENOTSUP;	195	rc = ENOTSUP;
196	}	196	}
197		197
198	if (rc != 0) {	198	if (rc != 0) {
199	attrs = &conn->screenbuffer.attrs;	199	attrs = &conn->screenbuffer.attrs;
200		200
201	for (j = 0; j < h; j++) {	201	for (j = 0; j < h; j++) {
202	for (i = 0; i < w; i++) {	202	for (i = 0; i < w; i++) {
203	field = get_field_at(&conn->screenbuffer,	203	field = get_field_at(&conn->screenbuffer,
204	x + i, y + j);	204	x + i, y + j);
205	if (!attrs_same(*attrs, field->attrs))	205	if (!attrs_same(*attrs, field->attrs))
206	set_attrs(&field->attrs);	206	set_attrs(&field->attrs);
207	attrs = &field->attrs;	207	attrs = &field->attrs;
208		208
209	fb_putchar(field->character, y + j, x + i);	209	fb_putchar(field->character, y + j, x + i);
210	}	210	}
211	}	211	}
212	}	212	}
213	}	213	}
214		214
215	/** Flush pending cells to FB. */	215	/** Flush pending cells to FB. */
216	static void fb_pending_flush(void)	216	static void fb_pending_flush(void)
217	{	217	{
218	screenbuffer_t *scr;	218	screenbuffer_t *scr;
219		219
220	scr = &(connections[active_console].screenbuffer);	220	scr = &(connections[active_console].screenbuffer);
221		221
222	if (fb_pending.n > 0) {	222	if (fb_pending.n > 0) {
223	fb_update_area(&connections[active_console], fb_pending.col,	223	fb_update_area(&connections[active_console], fb_pending.col,
224	fb_pending.row, fb_pending.n, 1);	224	fb_pending.row, fb_pending.n, 1);
225	fb_pending.n = 0;	225	fb_pending.n = 0;
226	}	226	}
227	}	227	}
228		228
229	/** Mark a character cell as changed.	229	/** Mark a character cell as changed.
230	*	230	*
231	* This adds the cell to the pending rowspan if possible. Otherwise	231	* This adds the cell to the pending rowspan if possible. Otherwise
232	* the old span is flushed first.	232	* the old span is flushed first.
233	*/	233	*/
234	static void cell_mark_changed(int row, int col)	234	static void cell_mark_changed(int row, int col)
235	{	235	{
236	if (fb_pending.n != 0) {	236	if (fb_pending.n != 0) {
237	if (row != fb_pending.row \|\|	237	if (row != fb_pending.row \|\|
238	col != fb_pending.col + fb_pending.n) {	238	col != fb_pending.col + fb_pending.n) {
239	fb_pending_flush();	239	fb_pending_flush();
240	}	240	}
241	}	241	}
242		242
243	if (fb_pending.n == 0) {	243	if (fb_pending.n == 0) {
244	fb_pending.row = row;	244	fb_pending.row = row;
245	fb_pending.col = col;	245	fb_pending.col = col;
246	}	246	}
247		247
248	++fb_pending.n;	248	++fb_pending.n;
249	}	249	}
250		250
251		251
252	/** Print a character to the active VC with buffering. */	252	/** Print a character to the active VC with buffering. */
253	static void fb_putchar(char c, int row, int col)	253	static void fb_putchar(char c, int row, int col)
254	{	254	{
255	async_msg_3(fb_info.phone, FB_PUTCHAR, c, row, col);	255	async_msg_3(fb_info.phone, FB_PUTCHAR, c, row, col);
256	}	256	}
257		257
258	/** Process a character from the client (TTY emulation). */	258	/** Process a character from the client (TTY emulation). */
259	static void write_char(int console, char key)	259	static void write_char(int console, char key)
260	{	260	{
261	bool flush_cursor = false;	261	bool flush_cursor = false;
262	screenbuffer_t *scr = &(connections[console].screenbuffer);	262	screenbuffer_t *scr = &(connections[console].screenbuffer);
263		263
264	switch (key) {	264	switch (key) {
265	case '\n':	265	case '\n':
266	fb_pending_flush();	266	fb_pending_flush();
267	flush_cursor = true;	267	flush_cursor = true;
268	scr->position_y++;	268	scr->position_y++;
269	scr->position_x = 0;	269	scr->position_x = 0;
270	break;	270	break;
271	case '\r':	271	case '\r':
272	break;	272	break;
273	case '\t':	273	case '\t':
274	scr->position_x += 8;	274	scr->position_x += 8;
275	scr->position_x -= scr->position_x % 8;	275	scr->position_x -= scr->position_x % 8;
276	break;	276	break;
277	case '\b':	277	case '\b':
278	if (scr->position_x == 0)	278	if (scr->position_x == 0)
279	break;	279	break;
280	scr->position_x--;	280	scr->position_x--;
281	if (console == active_console)	281	if (console == active_console)
282	cell_mark_changed(scr->position_y, scr->position_x);	282	cell_mark_changed(scr->position_y, scr->position_x);
283	screenbuffer_putchar(scr, ' ');	283	screenbuffer_putchar(scr, ' ');
284	break;	284	break;
285	default:	285	default:
286	if (console == active_console)	286	if (console == active_console)
287	cell_mark_changed(scr->position_y, scr->position_x);	287	cell_mark_changed(scr->position_y, scr->position_x);
288		288
289	screenbuffer_putchar(scr, key);	289	screenbuffer_putchar(scr, key);
290	scr->position_x++;	290	scr->position_x++;
291	}	291	}
292		292
293	if (scr->position_x >= scr->size_x) {	293	if (scr->position_x >= scr->size_x) {
294	flush_cursor = true;	294	flush_cursor = true;
295	scr->position_y++;	295	scr->position_y++;
296	}	296	}
297		297
298	if (scr->position_y >= scr->size_y) {	298	if (scr->position_y >= scr->size_y) {
299	fb_pending_flush();	299	fb_pending_flush();
300	scr->position_y = scr->size_y - 1;	300	scr->position_y = scr->size_y - 1;
301	screenbuffer_clear_line(scr, scr->top_line);	301	screenbuffer_clear_line(scr, scr->top_line);
302	scr->top_line = (scr->top_line + 1) % scr->size_y;	302	scr->top_line = (scr->top_line + 1) % scr->size_y;
303	if (console == active_console)	303	if (console == active_console)
304	async_msg_1(fb_info.phone, FB_SCROLL, 1);	304	async_msg_1(fb_info.phone, FB_SCROLL, 1);
305	}	305	}
306		306
307	scr->position_x = scr->position_x % scr->size_x;	307	scr->position_x = scr->position_x % scr->size_x;
308		308
309	if (console == active_console && flush_cursor)	309	if (console == active_console && flush_cursor)
310	curs_goto(scr->position_y, scr->position_x);	310	curs_goto(scr->position_y, scr->position_x);
311	}	311	}
312		312
313	/** Switch to new console */	313	/** Switch to new console */
314	static void change_console(int newcons)	314	static void change_console(int newcons)
315	{	315	{
316	connection_t *conn;	316	connection_t *conn;
317	int i, j, rc;	317	int i, j, rc;
318	keyfield_t *field;	318	keyfield_t *field;
319	attrs_t *attrs;	319	attrs_t *attrs;
320		320
321	if (newcons == active_console)	321	if (newcons == active_console)
322	return;	322	return;
323		323
324	fb_pending_flush();	324	fb_pending_flush();
325		325
326	if (newcons == KERNEL_CONSOLE) {	326	if (newcons == KERNEL_CONSOLE) {
327	async_serialize_start();	327	async_serialize_start();
328	curs_hide_sync();	328	curs_hide_sync();
329	gcons_in_kernel();	329	gcons_in_kernel();
330	async_serialize_end();	330	async_serialize_end();
331		331
332	if (__SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE)) {	332	if (__SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE)) {
333	prev_console = active_console;	333	prev_console = active_console;
334	active_console = KERNEL_CONSOLE;	334	active_console = KERNEL_CONSOLE;
335	} else	335	} else
336	newcons = active_console;	336	newcons = active_console;
337	}	337	}
338		338
339	if (newcons != KERNEL_CONSOLE) {	339	if (newcons != KERNEL_CONSOLE) {
340	async_serialize_start();	340	async_serialize_start();
341		341
342	if (active_console == KERNEL_CONSOLE)	342	if (active_console == KERNEL_CONSOLE)
343	gcons_redraw_console();	343	gcons_redraw_console();
344		344
345	active_console = newcons;	345	active_console = newcons;
346	gcons_change_console(newcons);	346	gcons_change_console(newcons);
347	conn = &connections[active_console];	347	conn = &connections[active_console];
348		348
349	set_attrs(&conn->screenbuffer.attrs);	349	set_attrs(&conn->screenbuffer.attrs);
350	curs_visibility(false);	350	curs_visibility(false);
351	if (interbuffer) {	351	if (interbuffer) {
352	for (j = 0; j < conn->screenbuffer.size_y; j++) {	352	for (j = 0; j < conn->screenbuffer.size_y; j++) {
353	for (i = 0; i < conn->screenbuffer.size_x; i++) {	353	for (i = 0; i < conn->screenbuffer.size_x; i++) {
354	unsigned int size_x;	354	unsigned int size_x;
355		355
356	size_x = conn->screenbuffer.size_x;	356	size_x = conn->screenbuffer.size_x;
357	interbuffer[j * size_x + i] =	357	interbuffer[j * size_x + i] =
358	*get_field_at(&conn->screenbuffer, i, j);	358	*get_field_at(&conn->screenbuffer, i, j);
359	}	359	}
360	}	360	}
361	/* This call can preempt, but we are already at the end */	361	/* This call can preempt, but we are already at the end */
362	rc = async_req_4_0(fb_info.phone, FB_DRAW_TEXT_DATA,	362	rc = async_req_4_0(fb_info.phone, FB_DRAW_TEXT_DATA,
363	0, 0, conn->screenbuffer.size_x,	363	0, 0, conn->screenbuffer.size_x,
364	conn->screenbuffer.size_y);	364	conn->screenbuffer.size_y);
365	}	365	}
366		366
367	if ((!interbuffer) \|\| (rc != 0)) {	367	if ((!interbuffer) \|\| (rc != 0)) {
368	set_attrs(&conn->screenbuffer.attrs);	368	set_attrs(&conn->screenbuffer.attrs);
369	clrscr();	369	clrscr();
370	attrs = &conn->screenbuffer.attrs;	370	attrs = &conn->screenbuffer.attrs;
371		371
372	for (j = 0; j < conn->screenbuffer.size_y; j++)	372	for (j = 0; j < conn->screenbuffer.size_y; j++)
373	for (i = 0; i < conn->screenbuffer.size_x; i++) {	373	for (i = 0; i < conn->screenbuffer.size_x; i++) {
374	field = get_field_at(&conn->screenbuffer, i, j);	374	field = get_field_at(&conn->screenbuffer, i, j);
375	if (!attrs_same(*attrs, field->attrs))	375	if (!attrs_same(*attrs, field->attrs))
376	set_attrs(&field->attrs);	376	set_attrs(&field->attrs);
377	attrs = &field->attrs;	377	attrs = &field->attrs;
378	if ((field->character == ' ') &&	378	if ((field->character == ' ') &&
379	(attrs_same(field->attrs,	379	(attrs_same(field->attrs,
380	conn->screenbuffer.attrs)))	380	conn->screenbuffer.attrs)))
381	continue;	381	continue;
382		382
383	fb_putchar(field->character, j, i);	383	fb_putchar(field->character, j, i);
384	}	384	}
385	}	385	}
386		386
387	curs_goto(conn->screenbuffer.position_y,	387	curs_goto(conn->screenbuffer.position_y,
388	conn->screenbuffer.position_x);	388	conn->screenbuffer.position_x);
389	curs_visibility(conn->screenbuffer.is_cursor_visible);	389	curs_visibility(conn->screenbuffer.is_cursor_visible);
390		390
391	async_serialize_end();	391	async_serialize_end();
392	}	392	}
393	}	393	}
394		394
395	/** Handler for keyboard */	395	/** Handler for keyboard */
396	static void keyboard_events(ipc_callid_t iid, ipc_call_t *icall)	396	static void keyboard_events(ipc_callid_t iid, ipc_call_t *icall)
397	{	397	{
398	ipc_callid_t callid;	398	ipc_callid_t callid;
399	ipc_call_t call;	399	ipc_call_t call;
400	int retval;	400	int retval;
401	kbd_event_t ev;	401	kbd_event_t ev;
402	connection_t *conn;	402	connection_t *conn;
403	int newcon;	403	int newcon;
404		404
405	/* Ignore parameters, the connection is alread opened */	405	/* Ignore parameters, the connection is alread opened */
406	while (1) {	406	while (1) {
407	callid = async_get_call(&call);	407	callid = async_get_call(&call);
408	switch (IPC_GET_METHOD(call)) {	408	switch (IPC_GET_METHOD(call)) {
409	case IPC_M_PHONE_HUNGUP:	409	case IPC_M_PHONE_HUNGUP:
410	/* TODO: Handle hangup */	410	/* TODO: Handle hangup */
411	return;	411	return;
412	case KBD_MS_LEFT:	412	case KBD_MS_LEFT:
413	newcon = gcons_mouse_btn(IPC_GET_ARG1(call));	413	newcon = gcons_mouse_btn(IPC_GET_ARG1(call));
414	if (newcon != -1)	414	if (newcon != -1)
415	change_console(newcon);	415	change_console(newcon);
416	retval = 0;	416	retval = 0;
417	break;	417	break;
418	case KBD_MS_MOVE:	418	case KBD_MS_MOVE:
419	gcons_mouse_move(IPC_GET_ARG1(call),	419	gcons_mouse_move(IPC_GET_ARG1(call),
420	IPC_GET_ARG2(call));	420	IPC_GET_ARG2(call));
421	retval = 0;	421	retval = 0;
422	break;	422	break;
423	case KBD_EVENT:	423	case KBD_EVENT:
424	/* Got event from keyboard driver. */	424	/* Got event from keyboard driver. */
425	retval = 0;	425	retval = 0;
426	ev.type = IPC_GET_ARG1(call);	426	ev.type = IPC_GET_ARG1(call);
427	ev.key = IPC_GET_ARG2(call);	427	ev.key = IPC_GET_ARG2(call);
428	ev.mods = IPC_GET_ARG3(call);	428	ev.mods = IPC_GET_ARG3(call);
429	ev.c = IPC_GET_ARG4(call);	429	ev.c = IPC_GET_ARG4(call);
430		430
431	/* switch to another virtual console */	431	/* switch to another virtual console */
432		432
433	conn = &connections[active_console];	433	conn = &connections[active_console];
434		434
435	if ((ev.key >= KC_F1) && (ev.key < KC_F1 +	435	if ((ev.key >= KC_F1) && (ev.key < KC_F1 +
436	CONSOLE_COUNT)) {	436	CONSOLE_COUNT)) {
437	if (ev.key == KC_F12)	437	if (ev.key == KC_F12)
438	change_console(KERNEL_CONSOLE);	438	change_console(KERNEL_CONSOLE);
439	else	439	else
440	change_console(ev.key - KC_F1);	440	change_console(ev.key - KC_F1);
441	break;	441	break;
442	}	442	}
443		443
444	/* if client is awaiting key, send it */	444	/* if client is awaiting key, send it */
445	if (conn->keyrequest_counter > 0) {	445	if (conn->keyrequest_counter > 0) {
446	conn->keyrequest_counter--;	446	conn->keyrequest_counter--;
447	ipc_answer_4(fifo_pop(conn->keyrequests), EOK,	447	ipc_answer_4(fifo_pop(conn->keyrequests), EOK,
448	ev.type, ev.key, ev.mods, ev.c);	448	ev.type, ev.key, ev.mods, ev.c);
449	break;	449	break;
450	}	450	}
451		451
452	keybuffer_push(&conn->keybuffer, &ev);	452	keybuffer_push(&conn->keybuffer, &ev);
453	retval = 0;	453	retval = 0;
454		454
455	break;	455	break;
456	default:	456	default:
457	retval = ENOENT;	457	retval = ENOENT;
458	}	458	}
459	ipc_answer_0(callid, retval);	459	ipc_answer_0(callid, retval);
460	}	460	}
461	}	461	}
462		462
463	/** Handle CONSOLE_WRITE call. */	463	/** Handle CONSOLE_WRITE call. */
464	static void cons_write(int consnum, ipc_callid_t rid, ipc_call_t *request)	464	static void cons_write(int consnum, ipc_callid_t rid, ipc_call_t *request)
465	{	465	{
466	ipc_callid_t callid;	466	ipc_callid_t callid;
467	size_t len;	467	size_t len;
468	size_t i;	468	size_t i;
469		469
470	if (!ipc_data_write_receive(&callid, &len)) {	470	if (!ipc_data_write_receive(&callid, &len)) {
471	ipc_answer_0(callid, EINVAL);	471	ipc_answer_0(callid, EINVAL);
472	ipc_answer_0(rid, EINVAL);	472	ipc_answer_0(rid, EINVAL);
473	}	473	}
474		474
475	if (len > CWRITE_BUF_SIZE)	475	if (len > CWRITE_BUF_SIZE)
476	len = CWRITE_BUF_SIZE;	476	len = CWRITE_BUF_SIZE;
477		477
478	(void) ipc_data_write_finalize(callid, cwrite_buf, len);	478	(void) ipc_data_write_finalize(callid, cwrite_buf, len);
479		479
480	for (i = 0; i < len; i++) {	480	for (i = 0; i < len; i++) {
481	write_char(consnum, cwrite_buf[i]);	481	write_char(consnum, cwrite_buf[i]);
482	}	482	}
483		483
484	gcons_notify_char(consnum);	484	gcons_notify_char(consnum);
485	ipc_answer_1(rid, EOK, len);	485	ipc_answer_1(rid, EOK, len);
486	}	486	}
487		487
488	/** Default thread for new connections */	488	/** Default thread for new connections */
489	static void client_connection(ipc_callid_t iid, ipc_call_t *icall)	489	static void client_connection(ipc_callid_t iid, ipc_call_t *icall)
490	{	490	{
491	ipc_callid_t callid;	491	ipc_callid_t callid;
492	ipc_call_t call;	492	ipc_call_t call;
493	int consnum;	493	int consnum;
494	ipcarg_t arg1, arg2, arg3, arg4;	494	ipcarg_t arg1, arg2, arg3, arg4;
495	connection_t *conn;	495	connection_t *conn;
496	screenbuffer_t *scr;	496	screenbuffer_t *scr;
497		497
498	if ((consnum = find_free_connection()) == -1) {	498	if ((consnum = find_free_connection()) == -1) {
499	ipc_answer_0(iid, ELIMIT);	499	ipc_answer_0(iid, ELIMIT);
500	return;	500	return;

Subversion Repositories HelenOS

(root)/trunk/uspace/srv/console/console.c @ 4208 – Rev 4167 → 4168