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

  * (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 <io/keycode.h>
 #include <ipc/fb.h>
 #include <ipc/services.h>
 #include <errno.h>
-#include <key_buffer.h>
+#include <keybuffer.h>
 #include <ipc/console.h>
 #include <unistd.h>
 #include <async.h>
-#include <libadt/fifo.h>
+#include <adt/fifo.h>
-#include <screenbuffer.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 MAX_KEYREQUESTS_BUFFERED 32
+#define NAME  "console"
-#define NAME "console"
+#define MAX_DEVICE_NAME  32
-/** Index of currently used virtual console.
- */
-int active_console = 0;
-int prev_console = 0;
 /** Phone to the keyboard driver. */
 static int kbd_phone;
 /** Information about framebuffer */
 struct {
-    int phone;      /**< Framebuffer phone */
+    int phone;      /**< Framebuffer phone */
-    ipcarg_t rows;      /**< Framebuffer rows */
+    ipcarg_t cols;  /**< Framebuffer columns */
-    ipcarg_t cols;      /**< Framebuffer columns */
+    ipcarg_t rows;  /**< Framebuffer rows */
+    int color_cap;  /**< Color capabilities (FB_CCAP_xxx) */
 } fb_info;
 typedef struct {
-    keybuffer_t keybuffer;      /**< Buffer for incoming keys. */
+    size_t index;             /**< Console index */
-    /** Buffer for unsatisfied request for keys. */
-    FIFO_CREATE_STATIC(keyrequests, ipc_callid_t,
-        MAX_KEYREQUESTS_BUFFERED);
-    int keyrequest_counter;     /**< Number of requests in buffer. */
+    size_t refcount;          /**< Connection reference count */
-    int client_phone;       /**< Phone to connected client. */
+    dev_handle_t dev_handle;  /**< Device handle */
-    int used;           /**< 1 if this virtual console is
+    keybuffer_t keybuffer;    /**< Buffer for incoming keys. */
-                     * connected to some client.*/
-    screenbuffer_t screenbuffer;    /**< Screenbuffer for saving screen
+    screenbuffer_t scr;       /**< Screenbuffer for saving screen
-                     * contents and related settings. */
+                                   contents and related settings. */
-} connection_t;
+} console_t;
+/** Array of data for virtual consoles */
-static connection_t connections[CONSOLE_COUNT]; /**< Array of data for virtual
+static console_t consoles[CONSOLE_COUNT];
+static console_t *active_console = &consoles[0];
-                         * consoles */
+static console_t *prev_console = &consoles[0];
-static keyfield_t *interbuffer = NULL;      /**< Pointer to memory shared
+static console_t *kernel_console = &consoles[KERNEL_CONSOLE];
-                         * with framebufer used for
+/** Pointer to memory shared with framebufer used for
-                         * faster virtual console
+    faster virtual console switching */
-                         * switching */
+static keyfield_t *interbuffer = NULL;
 /** Information on row-span yet unsent to FB driver. */
 struct {
-    int row;        /**< Row where the span lies. */
+    size_t col;  /**< Leftmost column of the span. */
-    int col;        /**< Leftmost column of the span. */
+    size_t row;  /**< Row where the span lies. */
-    int n;          /**< Width of the span. */
+    size_t cnt;  /**< 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 FIBRIL_MUTEX_INITIALIZE(input_mutex);
-static void fb_putchar(wchar_t c, int row, int col);
+static FIBRIL_CONDVAR_INITIALIZE(input_cv);
-/** 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)
+static void curs_goto(size_t x, size_t y)
+{
-    async_msg_2(fb_info.phone, FB_CURSOR_GOTO, row, col);
+    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);
     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);
+{
     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)
+static int ccap_fb_to_con(int ccap_fb, int *ccap_con)
+{
-    int i, j;
-    int rc;
-    attrs_t *attrs;
-    keyfield_t *field;
-    if (interbuffer) {
+    switch (ccap_fb) {
-        for (j = 0; j < h; j++) {
+    case FB_CCAP_NONE: *ccap_con = CONSOLE_CCAP_NONE; break;
-            for (i = 0; i < w; i++) {
+    case FB_CCAP_STYLE: *ccap_con = CONSOLE_CCAP_STYLE; break;
-                interbuffer[i + j * w] =
-                    *get_field_at(&conn->screenbuffer,
+    case FB_CCAP_INDEXED: *ccap_con = CONSOLE_CCAP_INDEXED; break;
-                    x + i, y + j);
-            }
-        }
-        rc = async_req_4_0(fb_info.phone, FB_DRAW_TEXT_DATA,
+    case FB_CCAP_RGB: *ccap_con = CONSOLE_CCAP_RGB; break;
-            x, y, w, h);
+    default: return EINVAL;
-    } else {
-        rc = ENOTSUP;
+    }
-    if (rc != 0) {
+    return EOK;
-        /*
-        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;
+/** 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] =
-                fb_putchar(field->character, y + j, x + i);
+                    *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)
+{
-    screenbuffer_t *scr;
-    scr = &(connections[active_console].screenbuffer);
-    if (fb_pending.n > 0) {
+    if (fb_pending.cnt > 0) {
-        fb_update_area(&connections[active_console], fb_pending.col,
+        fb_update_area(active_console, fb_pending.col,
-            fb_pending.row, fb_pending.n, 1);
+            fb_pending.row, fb_pending.cnt, 1);
-        fb_pending.n = 0;
+        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(int row, int col)
+static void cell_mark_changed(size_t col, size_t row)
+{
-    if (fb_pending.n != 0) {
+    if (fb_pending.cnt != 0) {
-        if (row != fb_pending.row ||
+        if ((col != fb_pending.col + fb_pending.cnt)
-            col != fb_pending.col + fb_pending.n) {
+            || (row != fb_pending.row)) {
             fb_pending_flush();
+        }
+    }
-    if (fb_pending.n == 0) {
+    if (fb_pending.cnt == 0) {
-        fb_pending.row = row;
         fb_pending.col = col;
+        fb_pending.row = row;
+    }
-    ++fb_pending.n;
+    fb_pending.cnt++;
+}
 /** Print a character to the active VC with buffering. */
-static void fb_putchar(wchar_t c, int row, int col)
+static void fb_putchar(wchar_t c, ipcarg_t col, ipcarg_t row)
+{
-    async_msg_3(fb_info.phone, FB_PUTCHAR, c, row, col);
+    async_msg_3(fb_info.phone, FB_PUTCHAR, c, col, row);
+}
 /** Process a character from the client (TTY emulation). */
-static void write_char(int console, wchar_t ch)
+static void write_char(console_t *cons, wchar_t ch)
+{
     bool flush_cursor = false;
-    screenbuffer_t *scr = &(connections[console].screenbuffer);
     switch (ch) {
     case '\n':
         fb_pending_flush();
         flush_cursor = true;
-        scr->position_y++;
+        cons->scr.position_y++;
-        scr->position_x = 0;
+        cons->scr.position_x = 0;
         break;
     case '\r':
         break;
     case '\t':
-        scr->position_x += 8;
+        cons->scr.position_x += 8;
-        scr->position_x -= scr->position_x % 8;
+        cons->scr.position_x -= cons->scr.position_x % 8;
         break;
     case '\b':
-        if (scr->position_x == 0)
+        if (cons->scr.position_x == 0)
             break;
-        scr->position_x--;
+        cons->scr.position_x--;
-        if (console == active_console)
+        if (cons == active_console)
-            cell_mark_changed(scr->position_y, scr->position_x);
+            cell_mark_changed(cons->scr.position_x, cons->scr.position_y);
-        screenbuffer_putchar(scr, ' ');
+        screenbuffer_putchar(&cons->scr, ' ');
         break;
     default:
-        if (console == active_console)
+        if (cons == active_console)
-            cell_mark_changed(scr->position_y, scr->position_x);
+            cell_mark_changed(cons->scr.position_x, cons->scr.position_y);
-        screenbuffer_putchar(scr, ch);
+        screenbuffer_putchar(&cons->scr, ch);
-        scr->position_x++;
+        cons->scr.position_x++;
+    }
-    if (scr->position_x >= scr->size_x) {
+    if (cons->scr.position_x >= cons->scr.size_x) {
         flush_cursor = true;
-        scr->position_y++;
+        cons->scr.position_y++;
+    }
-    if (scr->position_y >= scr->size_y) {
+    if (cons->scr.position_y >= cons->scr.size_y) {
         fb_pending_flush();
-        scr->position_y = scr->size_y - 1;
+        cons->scr.position_y = cons->scr.size_y - 1;
-        screenbuffer_clear_line(scr, scr->top_line);
+        screenbuffer_clear_line(&cons->scr, cons->scr.top_line);
-        scr->top_line = (scr->top_line + 1) % scr->size_y;
+        cons->scr.top_line = (cons->scr.top_line + 1) % cons->scr.size_y;
-        if (console == active_console)
+        if (cons == 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)
+    if (cons == active_console && flush_cursor)
-        curs_goto(scr->position_y, scr->position_x);
+        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(int newcons)
+static void change_console(console_t *cons)
+{
-    connection_t *conn;
-    int i, j, rc;
-    keyfield_t *field;
-    attrs_t *attrs;
-    if (newcons == active_console)
+    if (cons == active_console)
         return;
     fb_pending_flush();
-    if (newcons == KERNEL_CONSOLE) {
+    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;
+            active_console = kernel_console;
         } else
-            newcons = active_console;
+            cons = active_console;
+    }
-    if (newcons != KERNEL_CONSOLE) {
+    if (cons != kernel_console) {
+        size_t x;
+        size_t y;
+        int rc = 0;
         async_serialize_start();
-        if (active_console == KERNEL_CONSOLE) {
+        if (active_console == kernel_console) {
             screen_reclaim();
             kbd_reclaim();
             gcons_redraw_console();
+        }
-        active_console = newcons;
+        active_console = cons;
-        gcons_change_console(newcons);
+        gcons_change_console(cons->index);
-        conn = &connections[active_console];
-        set_attrs(&conn->screenbuffer.attrs);
+        set_attrs(&cons->scr.attrs);
         curs_visibility(false);
         if (interbuffer) {
-            for (j = 0; j < conn->screenbuffer.size_y; j++) {
+            for (y = 0; y < cons->scr.size_y; y++) {
-                for (i = 0; i < conn->screenbuffer.size_x; i++) {
+                for (x = 0; x < cons->scr.size_x; x++) {
-                    unsigned int size_x;
-                    size_x = conn->screenbuffer.size_x;
-                    interbuffer[j * size_x + i] =
+                    interbuffer[y * cons->scr.size_x + x] =
-                        *get_field_at(&conn->screenbuffer, i, j);
+                        *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, conn->screenbuffer.size_x,
+, 0, cons->scr.size_x,
-                conn->screenbuffer.size_y);
+                cons->scr.size_y);
+        }
         if ((!interbuffer) || (rc != 0)) {
-            set_attrs(&conn->screenbuffer.attrs);
+            set_attrs(&cons->scr.attrs);
-            clrscr();
+            screen_clear();
-            attrs = &conn->screenbuffer.attrs;
-            for (j = 0; j < conn->screenbuffer.size_y; j++)
+            for (y = 0; y < cons->scr.size_y; y++)
-                for (i = 0; i < conn->screenbuffer.size_x; i++) {
+                for (x = 0; x < cons->scr.size_x; x++) {
-                    field = get_field_at(&conn->screenbuffer, i, j);
+                    keyfield_t *field = get_field_at(&cons->scr, x, y);
-                    if (!attrs_same(*attrs, field->attrs))
+                    if (!attrs_same(cons->scr.attrs, field->attrs))
                         set_attrs(&field->attrs);
-                    attrs = &field->attrs;
+                    cons->scr.attrs = field->attrs;
                     if ((field->character == ' ') &&
-                        (attrs_same(field->attrs,
+                        (attrs_same(field->attrs, cons->scr.attrs)))
-                        conn->screenbuffer.attrs)))
                         continue;
-                    fb_putchar(field->character, j, i);
+                    fb_putchar(field->character, x, y);
+                }
+        }
-        curs_goto(conn->screenbuffer.position_y,
+        curs_goto(cons->scr.position_x, cons->scr.position_y);
-            conn->screenbuffer.position_x);
-        curs_visibility(conn->screenbuffer.is_cursor_visible);
+        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 */
-    ipc_callid_t callid;
+    while (true) {
-    ipc_call_t call;
+        ipc_call_t call;
+        ipc_callid_t callid = async_get_call(&call);
-    int retval;
+        int retval;
-    kbd_event_t ev;
+        console_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) && ((ev.mods & KM_CTRL) == 0)) {
-                if (ev.key == KC_F12)
+                if (ev.key == KC_F1 + KERNEL_CONSOLE)
-                    change_console(KERNEL_CONSOLE);
+                    change_console(kernel_console);
                 else
-                    change_console(ev.key - KC_F1);
+                    change_console(&consoles[ev.key - KC_F1]);
                 break;
+            }
-            /* if client is awaiting key, send it */
-            if (conn->keyrequest_counter > 0) {
-                conn->keyrequest_counter--;
+            fibril_mutex_lock(&input_mutex);
-                ipc_answer_4(fifo_pop(conn->keyrequests), EOK,
+            keybuffer_push(&active_console->keybuffer, &ev);
-                    ev.type, ev.key, ev.mods, ev.c);
+            fibril_condvar_broadcast(&input_cv);
-                break;
-            }
-            keybuffer_push(&conn->keybuffer, &ev);
+            fibril_mutex_unlock(&input_mutex);
-            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)
+static void cons_write(console_t *cons, ipc_callid_t rid, ipc_call_t *request)
+{
     ipc_callid_t callid;
     size_t size;
-    wchar_t ch;
-    size_t off;
     if (!ipc_data_write_receive(&callid, &size)) {
         ipc_answer_0(callid, EINVAL);
         ipc_answer_0(rid, EINVAL);
         return;
+    }
+    char *buf = (char *) malloc(size);
-    if (size > CWRITE_BUF_SIZE)
+    if (buf == NULL) {
+        ipc_answer_0(callid, ENOMEM);
-        size = CWRITE_BUF_SIZE;
+        ipc_answer_0(rid, ENOMEM);
+        return;
+    }
-    (void) ipc_data_write_finalize(callid, cwrite_buf, size);
+    (void) ipc_data_write_finalize(callid, buf, size);
     async_serialize_start();
-    off = 0;
+    size_t off = 0;
     while (off < size) {
-        ch = str_decode(cwrite_buf, &off, size);
+        wchar_t ch = str_decode(buf, &off, size);
-        write_char(consnum, ch);
+        write_char(cons, ch);
+    }
     async_serialize_end();
-    gcons_notify_char(consnum);
+    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)
+{
-    ipc_callid_t callid;
+    console_t *cons = NULL;
-    ipc_call_t call;
+    size_t i;
+    for (i = 0; i < CONSOLE_COUNT; i++) {
+        if (i == KERNEL_CONSOLE)
-    int consnum;
+            continue;
-    ipcarg_t arg1, arg2, arg3, arg4;
+        if (consoles[i].dev_handle == (dev_handle_t) IPC_GET_ARG1(*icall)) {
-    connection_t *conn;
+            cons = &consoles[i];
-    screenbuffer_t *scr;
+            break;
+        }
+    }
-    if ((consnum = find_free_connection()) == -1) {
+    if (cons == NULL) {
-        ipc_answer_0(iid, ELIMIT);
+        ipc_answer_0(iid, ENOENT);
         return;
+    }
-    conn = &connections[consnum];
+    ipc_callid_t callid;
+    ipc_call_t call;
-    conn->used = 1;
+    ipcarg_t arg1;
+    ipcarg_t arg2;
+    ipcarg_t arg3;
+    int cons_ccap;
+    int rc;
     async_serialize_start();
-    gcons_notify_connect(consnum);
+    if (cons->refcount == 0)
-    conn->client_phone = IPC_GET_ARG5(*icall);
-    screenbuffer_clear(&conn->screenbuffer);
+        gcons_notify_connect(cons->index);
-    if (consnum == active_console)
-        clrscr();
+    cons->refcount++;
     /* Accept the connection */
     ipc_answer_0(iid, EOK);
-    while (1) {
+    while (true) {
         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);
+            cons->refcount--;
-            /* Answer all pending requests */
-            while (conn->keyrequest_counter > 0) {
+            if (cons->refcount == 0)
-                conn->keyrequest_counter--;
+                gcons_notify_disconnect(cons->index);
-                ipc_answer_0(fifo_pop(conn->keyrequests),
-                    ENOENT);
-                break;
-            }
-            conn->used = 0;
             return;
-        case CONSOLE_PUTCHAR:
+        case VFS_OUT_READ:
+            async_serialize_end();
-            write_char(consnum, IPC_GET_ARG1(call));
+            cons_read(cons, callid, &call);
-            gcons_notify_char(consnum);
+            async_serialize_start();
-            break;
+            continue;
-        case CONSOLE_WRITE:
+        case VFS_OUT_WRITE:
             async_serialize_end();
-            cons_write(consnum, callid, &call);
+            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 (consnum == active_console) {
+            if (cons == active_console)
                 async_msg_0(fb_info.phone, FB_CLEAR);
-            }
-            screenbuffer_clear(&conn->screenbuffer);
+            screenbuffer_clear(&cons->scr);
             break;
         case CONSOLE_GOTO:
-            screenbuffer_goto(&conn->screenbuffer,
+            screenbuffer_goto(&cons->scr,
-                IPC_GET_ARG2(call), IPC_GET_ARG1(call));
+                IPC_GET_ARG1(call), IPC_GET_ARG2(call));
-            if (consnum == active_console)
+            if (cons == active_console)
                 curs_goto(IPC_GET_ARG1(call),
                     IPC_GET_ARG2(call));
             break;
-        case CONSOLE_GETSIZE:
+        case CONSOLE_GET_SIZE:
-            arg1 = fb_info.rows;
+            arg1 = fb_info.cols;
-            arg2 = fb_info.cols;
+            arg2 = fb_info.rows;
             break;
-        case CONSOLE_FLUSH:
+        case CONSOLE_GET_COLOR_CAP:
-            fb_pending_flush();
+            rc = ccap_fb_to_con(fb_info.color_cap, &cons_ccap);
-            if (consnum == active_console) {
+            if (rc != EOK) {
-                async_req_0_0(fb_info.phone, FB_FLUSH);
+                ipc_answer_0(callid, rc);
-                scr = &(connections[consnum].screenbuffer);
+                continue;
-                curs_goto(scr->position_y, scr->position_x);
+            }
+            arg1 = cons_ccap;
             break;
         case CONSOLE_SET_STYLE:
             fb_pending_flush();
             arg1 = IPC_GET_ARG1(call);
-            screenbuffer_set_style(&conn->screenbuffer, arg1);
+            screenbuffer_set_style(&cons->scr, arg1);
-            if (consnum == active_console)
+            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(&conn->screenbuffer, arg1,
+            screenbuffer_set_color(&cons->scr, arg1, arg2, arg3);
-                arg2, arg3);
-            if (consnum == active_console)
+            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(&conn->screenbuffer, arg1,
+            screenbuffer_set_rgb_color(&cons->scr, arg1, arg2);
-                arg2);
-            if (consnum == active_console)
+            if (cons == 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;
+            cons->scr.is_cursor_visible = arg1;
-            if (consnum == active_console)
+            if (cons == active_console)
                 curs_visibility(arg1);
             break;
-        case CONSOLE_GETKEY:
+        case CONSOLE_GET_EVENT:
-            if (keybuffer_empty(&conn->keybuffer)) {
-                /* buffer is empty -> store request */
-                if (conn->keyrequest_counter <
+            async_serialize_end();
-                    MAX_KEYREQUESTS_BUFFERED) {
-                    fifo_push(conn->keyrequests, callid);
+            cons_get_event(cons, callid, &call);
-                    conn->keyrequest_counter++;
-                } else {
-                    /*
-                     * No key available and too many
-                     * requests => fail.
-                    */
-                    ipc_answer_0(callid, ELIMIT);
+            async_serialize_start();
-                }
-                continue;
+            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);
+            change_console(kernel_console);
             break;
+        }
-        ipc_answer_4(callid, EOK, arg1, arg2, arg3, arg4);
+        ipc_answer_3(callid, EOK, arg1, arg2, arg3);
+    }
+}
 static void interrupt_received(ipc_callid_t callid, ipc_call_t *call)
+{
     change_console(prev_console);
+}
-int main(int argc, char *argv[])
+static bool console_init(void)
+{
-    printf(NAME ": HelenOS Console service\n");
-    ipcarg_t phonehash;
+    ipcarg_t color_cap;
-    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;
+        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 -1;
+        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;
+    }
-    /* Disable kernel output to the console */
+    /* Register driver */
-    __SYSCALL0(SYS_DEBUG_DISABLE_CONSOLE);
+    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 can have something in queue */
-    async_req_0_0(fb_info.phone, FB_FLUSH);
+    /* Synchronize, the gcons could put something in queue */
-    async_req_0_2(fb_info.phone, FB_GET_CSIZE, &fb_info.rows,
+    async_req_0_0(fb_info.phone, FB_FLUSH);
-        &fb_info.cols);
+    async_req_0_2(fb_info.phone, FB_GET_CSIZE, &fb_info.cols, &fb_info.rows);
-    set_rgb_color(DEFAULT_FOREGROUND, DEFAULT_BACKGROUND);
+    async_req_0_1(fb_info.phone, FB_GET_COLOR_CAP, &color_cap);
-    clrscr();
+    fb_info.color_cap = color_cap;
-    /* 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;
+    size_t 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) {
+        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);
+    fb_pending.cnt = 0;
-    curs_visibility(
-        connections[active_console].screenbuffer.is_cursor_visible);
-    /* Register at NS */
+    /* 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 (ipc_connect_to_me(PHONE_NS, SERVICE_CONSOLE, 0, 0, &phonehash) != 0)
+            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 -1;
+                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[])
+{
-    // FIXME: avoid connectiong to itself, keep using klog
+    printf(NAME ": HelenOS Console service\n");
+    if (!console_init())
+        return -1;
-    // printf(NAME ": Accepting connections\n");
+    printf(NAME ": Accepting connections\n");
     async_manager();
     return 0;
+}

Subversion Repositories HelenOS

(root)/branches/tracing/uspace/srv/console/console.c – Rev 4377 → 4692