WebSVN – HelenOS – Diff – /trunk/uspace/srv/console/console.c


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

Subversion Repositories HelenOS

(root)/trunk/uspace/srv/console/console.c @ 3818 – Rev 1674 → 1689