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

Subversion Repositories HelenOS-historic

(root)/uspace/trunk/console/console.c – Rev 1640 → 1647