WebSVN – HelenOS-historic – Diff – /uspace/trunk/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.
 */
 
 
#include <kbd.h>
#include <fb.h>
#include <ipc/ipc.h>
#include <ipc/fb.h>
#include <ipc/services.h>
#include <errno.h>
#include <key_buffer.h>
#include <console.h>
#include <unistd.h>
#include <async.h>
#include <libadt/fifo.h>
#include <screenbuffer.h>
#include <sys/mman.h>
 
#include "gcons.h"
 
#define MAX_KEYREQUESTS_BUFFERED 32
 
#define NAME "CONSOLE"
 
/** Index of currently used virtual console.
 */
int active_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. */
    FIFO_CREATE_STATIC(keyrequests, ipc_callid_t , MAX_KEYREQUESTS_BUFFERED);   /**< Buffer for unsatisfied request for keys. */
    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 virt. console switching */
 
static int kernel_pixmap = -1;      /**< Number of fb pixmap, where kernel console is stored */
 
 
/** Find unused virtual console.
 *
 */
static int find_free_connection(void)
{
    int i = 0;
   
    for (i=0; i < CONSOLE_COUNT; i++) {
        if (!connections[i].used)
            return i;
    }
    return -1;
}
 
static void clrscr(void)
{
    nsend_call(fb_info.phone, FB_CLEAR, 0);
}
 
static void curs_visibility(int v)
{
    send_call(fb_info.phone, FB_CURSOR_VISIBILITY, v);
}
 
static void curs_goto(int row, int col)
{
    nsend_call_2(fb_info.phone, FB_CURSOR_GOTO, row, col);
   
}
 
static void set_style(style_t *style)
{
    nsend_call_2(fb_info.phone, FB_SET_STYLE, style->fg_color, style->bg_color);
}
 
static void set_style_col(int fgcolor, int bgcolor)
{
    nsend_call_2(fb_info.phone, FB_SET_STYLE, fgcolor, bgcolor);
}
 
static void prtchr(char c, int row, int col)
{
    nsend_call_3(fb_info.phone, FB_PUTCHAR, c, row, col);
   
}
 
/** Check key and process special keys.
 *
 * */
static void write_char(int console, char key)
{
    screenbuffer_t *scr = &(connections[console].screenbuffer);
   
    switch (key) {
        case '\n':
            scr->position_y += 1;
            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)
                prtchr(' ', scr->position_y, scr->position_x);
   
            screenbuffer_putchar(scr, ' ');
           
            break;
        default:   
            if (console == active_console)
                prtchr(key, scr->position_y, scr->position_x);
   
            screenbuffer_putchar(scr, key);
            scr->position_x++;
    }
   
    scr->position_y += (scr->position_x >= scr->size_x);
   
    if (scr->position_y >= scr->size_y) {
        scr->position_y = scr->size_y - 1;
        screenbuffer_clear_line(scr, scr->top_line++);
        if (console == active_console)
            nsend_call(fb_info.phone, FB_SCROLL, 1);
    }
   
    scr->position_x = scr->position_x % scr->size_x;
   
    if (console == active_console)
        curs_goto(scr->position_y, scr->position_x);
   
}
 
/** Save current screen to pixmap, draw old pixmap
 *
 * @param oldpixmap Old pixmap
 * @return ID of pixmap of current screen
 */
static int switch_screens(int oldpixmap)
{
    int newpmap;
       
    /* Save screen */
    newpmap = sync_send(fb_info.phone, FB_VP2PIXMAP, 0, NULL);
    if (newpmap < 0)
        return -1;
 
    if (oldpixmap != -1) {
        /* Show old screen */
        nsend_call_2(fb_info.phone, FB_VP_DRAW_PIXMAP, 0, oldpixmap);
        /* Drop old pixmap */
        nsend_call(fb_info.phone, FB_DROP_PIXMAP, oldpixmap);
    }
   
    return newpmap;
}
 
/** Switch to new console */
static void change_console(int newcons)
{
    connection_t *conn;
    static int console_pixmap = -1;
    int i, j;
    keyfield_t *field;
    style_t *style;
    char c;
 
    if (newcons == active_console)
        return;
 
    if (newcons == KERNEL_CONSOLE) {
        if (active_console == KERNEL_CONSOLE)
            return;
        active_console = KERNEL_CONSOLE;
        curs_visibility(0);
 
        if (kernel_pixmap == -1) {
            /* store/restore unsupported */
            set_style_col(DEFAULT_FOREGROUND, DEFAULT_BACKGROUND);
            clrscr();
        } else {
            gcons_in_kernel();
            console_pixmap = switch_screens(kernel_pixmap);
            kernel_pixmap = -1;
        }
 
        __SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE);
        return;
    }
   
    if (console_pixmap != -1) {
        kernel_pixmap = switch_screens(console_pixmap);
        console_pixmap = -1;
    }
   
    active_console = newcons;
    gcons_change_console(newcons);
    conn = &connections[active_console];
 
    set_style(&conn->screenbuffer.style);
    curs_goto(conn->screenbuffer.position_y, conn->screenbuffer.position_x);
    curs_visibility(0);
   
    if (interbuffer) {
        for (i = 0; i < conn->screenbuffer.size_x; i++)
            for (j = 0; j < conn->screenbuffer.size_y; j++)
                interbuffer[i + j*conn->screenbuffer.size_x] = *get_field_at(&(conn->screenbuffer),i, j);
        /* This call can preempt, but we are already at the end */
        j = sync_send_2(fb_info.phone, FB_DRAW_TEXT_DATA, 0, 0, NULL, NULL);       
    };
   
    if ((!interbuffer) || (j != 0)){
        set_style(&conn->screenbuffer.style);
        clrscr();
        style = &conn->screenbuffer.style;
 
        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 (!style_same(*style, field->style))
                    set_style(&field->style);
                style = &field->style;
                if ((field->character == ' ') && (style_same(field->style, conn->screenbuffer.style)))
                    continue;
 
                prtchr(field->character, j, i);
            }
    }
   
    curs_visibility(conn->screenbuffer.is_cursor_visible);
}
 
/** 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;
    int c;
    connection_t *conn;
   
    /* Ignore parameters, the connection is alread opened */
    while (1) {
        callid = async_get_call(&call);
        switch (IPC_GET_METHOD(call)) {
        case IPC_M_PHONE_HUNGUP:
            ipc_answer_fast(callid,0,0,0);
            /* TODO: Handle hangup */
            return;
        case KBD_PUSHCHAR:
            /* got key from keyboard driver */
           
            retval = 0;
            c = IPC_GET_ARG1(call);
            /* switch to another virtual console */
           
            conn = &connections[active_console];
//          if ((c >= KBD_KEY_F1) && (c < KBD_KEY_F1 + CONSOLE_COUNT)) {
            if ((c >= 0x101) && (c < 0x101 + CONSOLE_COUNT)) {
                if (c == 0x112)
                    change_console(KERNEL_CONSOLE);
                else
                    change_console(c - 0x101);
                break;
            }
           
            /* if client is awaiting key, send it */
            if (conn->keyrequest_counter > 0) {    
                conn->keyrequest_counter--;
                ipc_answer_fast(fifo_pop(conn->keyrequests), 0, c, 0);
                break;
            }
           
            /*FIXME: else store key to its buffer */
            keybuffer_push(&conn->keybuffer, c);
           
            break;
        default:
            retval = ENOENT;
        }      
        ipc_answer_fast(callid, retval, 0, 0);
    }
}
 
/** 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;
    connection_t *conn;
 
    if ((consnum = find_free_connection()) == -1) {
        ipc_answer_fast(iid,ELIMIT,0,0);
        return;
    }
    conn = &connections[consnum];
   
    gcons_notify_connect(consnum);
    conn->used = 1;
    conn->client_phone = IPC_GET_ARG3(call);
    screenbuffer_clear(&conn->screenbuffer);
   
    /* Accept the connection */
    ipc_answer_fast(iid,0,0,0);
   
    while (1) {
        callid = async_get_call(&call);
        arg1 = arg2 = 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_fast(fifo_pop(conn->keyrequests), ENOENT, 0, 0);
                break;
            }
           
            /* Commit hangup */
            ipc_answer_fast(callid, 0,0,0);
            return;
        case CONSOLE_PUTCHAR:
            write_char(consnum, IPC_GET_ARG1(call));
            gcons_notify_char(consnum);
            break;
        case CONSOLE_CLEAR:
            /* Send message to fb */
            if (consnum == active_console) {
                send_call(fb_info.phone, FB_CLEAR, 0);
            }
           
            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:
            sync_send_2(fb_info.phone, FB_FLUSH, 0, 0, NULL, NULL);    
            break;
        case CONSOLE_SET_STYLE:
           
            arg1 = IPC_GET_ARG1(call);
            arg2 = IPC_GET_ARG2(call);
            screenbuffer_set_style(&conn->screenbuffer,arg1, arg2);
            if (consnum == active_console)
                set_style_col(arg1, arg2);
               
            break;
        case CONSOLE_CURSOR_VISIBILITY:
            arg1 = IPC_GET_ARG1(call);
            conn->screenbuffer.is_cursor_visible = arg1;
            if (consnum == active_console)
                curs_visibility(arg1);
            break;
        case CONSOLE_GETCHAR:
            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_fast(callid, ELIMIT, 0, 0);
                }
                continue;
            };
            keybuffer_pop(&conn->keybuffer, (int *)&arg1);
           
            break;
        }
        ipc_answer_fast(callid, 0, arg1, arg2);
    }
}
 
int main(int argc, char *argv[])
{
    ipcarg_t phonehash;
    int kbd_phone, fb_phone;
    ipcarg_t retval, arg1 = 0xdead, arg2 = 0xbeef;
    int i;
 
    async_set_client_connection(client_connection);
   
    /* Connect to keyboard driver */
 
    while ((kbd_phone = ipc_connect_me_to(PHONE_NS, SERVICE_KEYBOARD, 0)) < 0) {
        usleep(10000);
    };
   
    if (ipc_connect_to_me(kbd_phone, SERVICE_CONSOLE, 0, &phonehash) != 0) {
        return -1;
    };
 
    /* Connect to framebuffer driver */
   
    while ((fb_info.phone = ipc_connect_me_to(PHONE_NS, SERVICE_VIDEO, 0)) < 0) {
        usleep(10000);
    }
   
    /* Save old kernel screen */
    kernel_pixmap = switch_screens(-1);
 
    /* Initialize gcons */
    gcons_init(fb_info.phone);
    /* Synchronize, the gcons can have something in queue */
    sync_send(fb_info.phone, FB_FLUSH, 0, NULL);
 
   
    ipc_call_sync_2(fb_info.phone, FB_GET_CSIZE, 0, 0, &(fb_info.rows), &(fb_info.cols));
    set_style_col(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 = 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;
   
    if ((interbuffer = mmap(NULL, sizeof(keyfield_t) * fb_info.cols * fb_info.rows , PROTO_READ|PROTO_WRITE, MAP_ANONYMOUS|MAP_PRIVATE, 0 ,0 )) != NULL) {
        if (ipc_call_sync_3(fb_info.phone, IPC_M_AS_AREA_SEND, (ipcarg_t)interbuffer, 0, AS_AREA_READ, NULL, NULL, NULL) != 0) {
            munmap(interbuffer, sizeof(keyfield_t) * fb_info.cols * fb_info.rows);
            interbuffer = NULL;
        }
    }
 
    async_new_connection(phonehash, 0, NULL, keyboard_events);
   
    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, &phonehash) != 0) {
        return -1;
    };
   
    async_manager();
 
    return 0;  
}
 
 

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

Subversion Repositories HelenOS-historic

(root)/uspace/trunk/console/console.c – Rev 1578 → 1592