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

Subversion Repositories HelenOS

(root)/branches/sparc/uspace/srv/console/console.c @ 3745 – Rev 1866 → 1867