WebSVN – HelenOS-historic – Diff – /uspace/trunk/console/console.c


/*
 * Copyright (C) 2006 Josef Cejka
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
 
 
#include <kbd.h>
#include <fb.h>
#include <ipc/ipc.h>
#include <ipc/fb.h>
#include <ipc/services.h>
#include <errno.h>
#include <key_buffer.h>
#include <console.h>
#include <unistd.h>
#include <async.h>
#include <libadt/fifo.h>
#include <screenbuffer.h>
#include <sys/mman.h>
 
#include "gcons.h"
 
#define MAX_KEYREQUESTS_BUFFERED 32
 
#define NAME "CONSOLE"
 
/** Index of currently used virtual console.
 */
int active_console = 0;
 
/** Information about framebuffer
 */
struct {
    int phone;      /**< Framebuffer phone */
    ipcarg_t rows;      /**< Framebuffer rows */
    ipcarg_t cols;      /**< Framebuffer columns */
} fb_info;
 
 
typedef struct {
    keybuffer_t keybuffer;      /**< Buffer for incoming keys. */
    FIFO_CREATE_STATIC(keyrequests, ipc_callid_t , MAX_KEYREQUESTS_BUFFERED);   /**< Buffer for unsatisfied request for keys. */
    int keyrequest_counter;     /**< Number of requests in buffer. */
    int client_phone;       /**< Phone to connected client. */
    int used;           /**< 1 if this virtual console is connected to some client.*/
    screenbuffer_t screenbuffer;    /**< Screenbuffer for saving screen contents and related settings. */
} connection_t;
 
connection_t connections[CONSOLE_COUNT];    /**< Array of data for virtual consoles */
keyfield_t *interbuffer = NULL;         /**< Pointer to memory shared with framebufer used for faster virt. console switching */
 
 
/** Find unused virtual console.
 *
 */
static int find_free_connection()
{
    int i = 0;
   
    while (i < CONSOLE_COUNT) {
        if (connections[i].used == 0)
            return i;
        ++i;
    }
    return CONSOLE_COUNT;
}
 
/** Find index of virtual console used by client with given phone.
 *
 */
static int find_connection(int client_phone)
{
    int i = 0;
   
    while (i < CONSOLE_COUNT) {
        if (connections[i].client_phone == client_phone)
            return i;
        ++i;
    }
    return  CONSOLE_COUNT;
}
 
/** 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) {
                nsend_call_3(fb_info.phone, FB_PUTCHAR, ' ', scr->position_y, scr->position_x);
            }
   
            screenbuffer_putchar(scr, ' ');
           
            break;
        default:   
            if (console == active_console) {
                nsend_call_3(fb_info.phone, FB_PUTCHAR, key, scr->position_y, scr->position_x);
            }
   
            screenbuffer_putchar(scr, key);
            scr->position_x++;
    }
   
    scr->position_y += (scr->position_x >= scr->size_x);
   
    if (scr->position_y >= scr->size_y) {
        scr->position_y = scr->size_y - 1;
        screenbuffer_clear_line(scr, scr->top_line++);
        if (console == active_console)
            nsend_call(fb_info.phone, FB_SCROLL, 1);
    }
   
    scr->position_x = scr->position_x % scr->size_x;
   
    if (console == active_console) 
        send_call_2(fb_info.phone, FB_CURSOR_GOTO, scr->position_y, scr->position_x);
   
}
 
 
/** 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 i, j;
    char c,d;
    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 >= '0') && (c < '0' + CONSOLE_COUNT)) {
                if (c == '0') {
                    /* switch to kernel console*/
                    nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 0);
                    nsend_call_2(fb_info.phone, FB_SET_STYLE, DEFAULT_FOREGROUND_COLOR, DEFAULT_BACKGROUND_COLOR);
                    nsend_call(fb_info.phone, FB_CLEAR, 0);
                    /* FIXME: restore kernel console */
                     __SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE);
                     break;
                     
                } else {
                    c = c - '1';
                    if (c == active_console)
                        break;
                    active_console = c;
                    gcons_change_console(c);
               
                }
               
                conn = &connections[active_console];
 
                nsend_call(fb_info.phone, FB_CURSOR_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);
                           
                    sync_send_2(fb_info.phone, FB_DRAW_TEXT_DATA, 0, 0, NULL, NULL);       
                } else {
                    nsend_call(fb_info.phone, FB_CLEAR, 0);
               
                   
                    for (i = 0; i < conn->screenbuffer.size_x; i++)
                        for (j = 0; j < conn->screenbuffer.size_y; j++) {
                            d = get_field_at(&(conn->screenbuffer),i, j)->character;
                            if (d && d != ' ')
                                nsend_call_3(fb_info.phone, FB_PUTCHAR, d, j, i);
                        }
 
                }
                nsend_call_2(fb_info.phone, FB_CURSOR_GOTO, conn->screenbuffer.position_y, conn->screenbuffer.position_x);
                nsend_call_2(fb_info.phone, FB_SET_STYLE, conn->screenbuffer.style.fg_color, \
                        conn->screenbuffer.style.bg_color);
                send_call(fb_info.phone, FB_CURSOR_VISIBILITY, 1);
 
                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;
 
    if ((consnum = find_free_connection()) == CONSOLE_COUNT) {
        ipc_answer_fast(iid,ELIMIT,0,0);
        return;
    }
 
    connections[consnum].used = 1;
    connections[consnum].client_phone = IPC_GET_ARG3(call);
    screenbuffer_clear(&(connections[consnum].screenbuffer));
   
    /* Accept the connection */
    ipc_answer_fast(iid,0,0,0);
   
    while (1) {
        callid = async_get_call(&call);
        arg1 = arg2 = 0;
        switch (IPC_GET_METHOD(call)) {
        case IPC_M_PHONE_HUNGUP:
            /* TODO */
            ipc_answer_fast(callid, 0,0,0);
            return;
        case CONSOLE_PUTCHAR:
            write_char(consnum, IPC_GET_ARG1(call));
            gcons_notify_char(consnum);
            break;
        case CONSOLE_CLEAR:
            /* Send message to fb */
            if (consnum == active_console) {
                send_call(fb_info.phone, FB_CLEAR, 0);
            }
           
            screenbuffer_clear(&(connections[consnum].screenbuffer));
           
            break;
        case CONSOLE_GOTO:
           
            screenbuffer_goto(&(connections[consnum].screenbuffer), IPC_GET_ARG2(call), IPC_GET_ARG1(call));
           
            break;
 
        case CONSOLE_GETSIZE:
            arg1 = fb_info.rows;
            arg2 = fb_info.cols;
            break;
        case CONSOLE_FLUSH:
            sync_send_2(fb_info.phone, FB_FLUSH, 0, 0, NULL, NULL);    
            break;
        case CONSOLE_SET_STYLE:
           
            arg1 = IPC_GET_ARG1(call);
            arg2 = IPC_GET_ARG2(call);
            screenbuffer_set_style(&(connections[consnum]),arg1, arg2);
            if (consnum == active_console)
                nsend_call_2(fb_info.phone, FB_SET_STYLE, arg1, arg2);
               
            break;
        case CONSOLE_GETCHAR:
            if (keybuffer_empty(&(connections[consnum].keybuffer))) {
                /* buffer is empty -> store request */
                if (connections[consnum].keyrequest_counter < MAX_KEYREQUESTS_BUFFERED) {      
                    fifo_push(connections[consnum].keyrequests, callid);
                    connections[consnum].keyrequest_counter++;
                } else {
                    /* no key available and too many requests => fail */
                    ipc_answer_fast(callid, ELIMIT, 0, 0);
                }
                continue;
            };
            keybuffer_pop(&(connections[consnum].keybuffer), (char *)&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);
    }
 
    /* Initialize gcons */
    gcons_init(fb_info.phone);
    /* Synchronize, the gcons can have something in queue */
    sync_send_2(fb_info.phone, FB_GET_CSIZE, 0, 0, NULL, NULL);
 
   
    ipc_call_sync_2(fb_info.phone, FB_GET_CSIZE, 0, 0, &(fb_info.rows), &(fb_info.cols));
    nsend_call_2(fb_info.phone, FB_SET_STYLE, DEFAULT_FOREGROUND_COLOR, DEFAULT_BACKGROUND_COLOR);
    nsend_call(fb_info.phone, FB_CLEAR, 0);
   
    /* 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;
        }
    }
   
    if ((interbuffer = mmap(NULL, sizeof(keyfield_t) * fb_info.cols * fb_info.rows , PROTO_READ|PROTO_WRITE, MAP_ANONYMOUS|MAP_PRIVATE, 0 ,0 )) != NULL) {
        if (ipc_call_sync_3(fb_info.phone, IPC_M_AS_AREA_SEND, (ipcarg_t)interbuffer, 0, AS_AREA_READ | AS_AREA_CACHEABLE, NULL, NULL, NULL) != 0) {
            munmap(interbuffer, sizeof(keyfield_t) * fb_info.cols * fb_info.rows);
            interbuffer = NULL;
        }
    }
 
    /* FIXME: save kernel console screen */
   
    async_new_connection(phonehash, 0, NULL, keyboard_events);
   
    sync_send_2(fb_info.phone, FB_CURSOR_GOTO, 0, 0, NULL, NULL);
    nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 1);
 
    /* Register at NS */
    if (ipc_connect_to_me(PHONE_NS, SERVICE_CONSOLE, 0, &phonehash) != 0) {
        return -1;
    };
   
    async_manager();
 
    return 0;  
}
 
 

Rev 1526	Rev 1528
1	/*	1	/*
2	* Copyright (C) 2006 Josef Cejka	2	* Copyright (C) 2006 Josef Cejka
3	* All rights reserved.	3	* All rights reserved.
4	*	4	*
5	* Redistribution and use in source and binary forms, with or without	5	* Redistribution and use in source and binary forms, with or without
6	* modification, are permitted provided that the following conditions	6	* modification, are permitted provided that the following conditions
7	* are met:	7	* are met:
8	*	8	*
9	* - Redistributions of source code must retain the above copyright	9	* - Redistributions of source code must retain the above copyright
10	* notice, this list of conditions and the following disclaimer.	10	* notice, this list of conditions and the following disclaimer.
11	* - Redistributions in binary form must reproduce the above copyright	11	* - Redistributions in binary form must reproduce the above copyright
12	* notice, this list of conditions and the following disclaimer in the	12	* notice, this list of conditions and the following disclaimer in the
13	* documentation and/or other materials provided with the distribution.	13	* documentation and/or other materials provided with the distribution.
14	* - The name of the author may not be used to endorse or promote products	14	* - The name of the author may not be used to endorse or promote products
15	* derived from this software without specific prior written permission.	15	* derived from this software without specific prior written permission.
16	*	16	*
17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27	*/	27	*/
28		28
29		29
30	#include <kbd.h>	30	#include <kbd.h>
31	#include <fb.h>	31	#include <fb.h>
32	#include <ipc/ipc.h>	32	#include <ipc/ipc.h>
33	#include <ipc/fb.h>	33	#include <ipc/fb.h>
34	#include <ipc/services.h>	34	#include <ipc/services.h>
35	#include <errno.h>	35	#include <errno.h>
36	#include <key_buffer.h>	36	#include <key_buffer.h>
37	#include <console.h>	37	#include <console.h>
38	#include <unistd.h>	38	#include <unistd.h>
39	#include <async.h>	39	#include <async.h>
40	#include <libadt/fifo.h>	40	#include <libadt/fifo.h>
41	#include <screenbuffer.h>	41	#include <screenbuffer.h>
42	#include <sys/mman.h>	42	#include <sys/mman.h>
43		43
44	#include "gcons.h"	44	#include "gcons.h"
45		45
46	#define MAX_KEYREQUESTS_BUFFERED 32	46	#define MAX_KEYREQUESTS_BUFFERED 32
47		47
48	#define NAME "CONSOLE"	48	#define NAME "CONSOLE"
49		49
50	/** Index of currently used virtual console.	50	/** Index of currently used virtual console.
51	*/	51	*/
52	int active_console = 0;	52	int active_console = 0;
53		53
54	/** Information about framebuffer	54	/** Information about framebuffer
55	*/	55	*/
56	struct {	56	struct {
57	int phone; /*< Framebuffer phone /	57	int phone; /*< Framebuffer phone /
58	ipcarg_t rows; /*< Framebuffer rows /	58	ipcarg_t rows; /*< Framebuffer rows /
59	ipcarg_t cols; /*< Framebuffer columns /	59	ipcarg_t cols; /*< Framebuffer columns /
60	} fb_info;	60	} fb_info;
61		61
62		62
63	typedef struct {	63	typedef struct {
64	keybuffer_t keybuffer; /*< Buffer for incoming keys. /	64	keybuffer_t keybuffer; /*< Buffer for incoming keys. /
65	FIFO_CREATE_STATIC(keyrequests, ipc_callid_t , MAX_KEYREQUESTS_BUFFERED); /*< Buffer for unsatisfied request for keys. /	65	FIFO_CREATE_STATIC(keyrequests, ipc_callid_t , MAX_KEYREQUESTS_BUFFERED); /*< Buffer for unsatisfied request for keys. /
66	int keyrequest_counter; /*< Number of requests in buffer. /	66	int keyrequest_counter; /*< Number of requests in buffer. /
67	int client_phone; /*< Phone to connected client. /	67	int client_phone; /*< Phone to connected client. /
68	int used; /*< 1 if this virtual console is connected to some client./	68	int used; /*< 1 if this virtual console is connected to some client./
69	screenbuffer_t screenbuffer; /*< Screenbuffer for saving screen contents and related settings. /	69	screenbuffer_t screenbuffer; /*< Screenbuffer for saving screen contents and related settings. /
70	} connection_t;	70	} connection_t;
71		71
72	connection_t connections[CONSOLE_COUNT]; /*< Array of data for virtual consoles /	72	connection_t connections[CONSOLE_COUNT]; /*< Array of data for virtual consoles /
73	keyfield_t interbuffer = NULL; /< Pointer to memory shared with framebufer used for faster virt. console switching /	73	keyfield_t interbuffer = NULL; /< Pointer to memory shared with framebufer used for faster virt. console switching /
74		74
75		75
76	/** Find unused virtual console.	76	/** Find unused virtual console.
77	*	77	*
78	*/	78	*/
79	static int find_free_connection()	79	static int find_free_connection()
80	{	80	{
81	int i = 0;	81	int i = 0;
82		82
83	while (i < CONSOLE_COUNT) {	83	while (i < CONSOLE_COUNT) {
84	if (connections[i].used == 0)	84	if (connections[i].used == 0)
85	return i;	85	return i;
86	++i;	86	++i;
87	}	87	}
88	return CONSOLE_COUNT;	88	return CONSOLE_COUNT;
89	}	89	}
90		90
91	/** Find index of virtual console used by client with given phone.	91	/** Find index of virtual console used by client with given phone.
92	*	92	*
93	*/	93	*/
94	static int find_connection(int client_phone)	94	static int find_connection(int client_phone)
95	{	95	{
96	int i = 0;	96	int i = 0;
97		97
98	while (i < CONSOLE_COUNT) {	98	while (i < CONSOLE_COUNT) {
99	if (connections[i].client_phone == client_phone)	99	if (connections[i].client_phone == client_phone)
100	return i;	100	return i;
101	++i;	101	++i;
102	}	102	}
103	return CONSOLE_COUNT;	103	return CONSOLE_COUNT;
104	}	104	}
105		105
106	/** Check key and process special keys.	106	/** Check key and process special keys.
107	*	107	*
108	* */	108	* */
109	static void write_char(int console, char key)	109	static void write_char(int console, char key)
110	{	110	{
111	screenbuffer_t *scr = &(connections[console].screenbuffer);	111	screenbuffer_t *scr = &(connections[console].screenbuffer);
112		112
113	switch (key) {	113	switch (key) {
114	case '\n':	114	case '\n':
115	scr->position_y += 1;	115	scr->position_y += 1;
116	scr->position_x = 0;	116	scr->position_x = 0;
117	break;	117	break;
118	case '\r':	118	case '\r':
119	break;	119	break;
120	case '\t':	120	case '\t':
121	scr->position_x += 8;	121	scr->position_x += 8;
122	scr->position_x -= scr->position_x % 8;	122	scr->position_x -= scr->position_x % 8;
123	break;	123	break;
124	case '\b':	124	case '\b':
125	if (scr->position_x == 0)	125	if (scr->position_x == 0)
126	break;	126	break;
127		127
128	scr->position_x--;	128	scr->position_x--;
129		129
130	if (console == active_console) {	130	if (console == active_console) {
131	nsend_call_3(fb_info.phone, FB_PUTCHAR, ' ', scr->position_y, scr->position_x);	131	nsend_call_3(fb_info.phone, FB_PUTCHAR, ' ', scr->position_y, scr->position_x);
132	}	132	}
133		133
134	screenbuffer_putchar(scr, ' ');	134	screenbuffer_putchar(scr, ' ');
135		135
136	break;	136	break;
137	default:	137	default:
138	if (console == active_console) {	138	if (console == active_console) {
139	nsend_call_3(fb_info.phone, FB_PUTCHAR, key, scr->position_y, scr->position_x);	139	nsend_call_3(fb_info.phone, FB_PUTCHAR, key, scr->position_y, scr->position_x);
140	}	140	}
141		141
142	screenbuffer_putchar(scr, key);	142	screenbuffer_putchar(scr, key);
143	scr->position_x++;	143	scr->position_x++;
144	}	144	}
145		145
146	scr->position_y += (scr->position_x >= scr->size_x);	146	scr->position_y += (scr->position_x >= scr->size_x);
147		147
148	if (scr->position_y >= scr->size_y) {	148	if (scr->position_y >= scr->size_y) {
149	scr->position_y = scr->size_y - 1;	149	scr->position_y = scr->size_y - 1;
150	screenbuffer_clear_line(scr, scr->top_line++);	150	screenbuffer_clear_line(scr, scr->top_line++);
151	if (console == active_console)	151	if (console == active_console)
152	nsend_call(fb_info.phone, FB_SCROLL, 1);	152	nsend_call(fb_info.phone, FB_SCROLL, 1);
153	}	153	}
154		154
155	scr->position_x = scr->position_x % scr->size_x;	155	scr->position_x = scr->position_x % scr->size_x;
156		156
157	if (console == active_console)	157	if (console == active_console)
158	send_call_2(fb_info.phone, FB_CURSOR_GOTO, scr->position_y, scr->position_x);	158	send_call_2(fb_info.phone, FB_CURSOR_GOTO, scr->position_y, scr->position_x);
159		159
160	}	160	}
161		161
162		162
163	/** Handler for keyboard */	163	/** Handler for keyboard */
164	static void keyboard_events(ipc_callid_t iid, ipc_call_t *icall)	164	static void keyboard_events(ipc_callid_t iid, ipc_call_t *icall)
165	{	165	{
166	ipc_callid_t callid;	166	ipc_callid_t callid;
167	ipc_call_t call;	167	ipc_call_t call;
168	int retval;	168	int retval;
169	int i, j;	169	int i, j;
170	char c,d;	170	char c,d;
171	connection_t *conn;	171	connection_t *conn;
172		172
173	/* Ignore parameters, the connection is alread opened */	173	/* Ignore parameters, the connection is alread opened */
174	while (1) {	174	while (1) {
175	callid = async_get_call(&call);	175	callid = async_get_call(&call);
176	switch (IPC_GET_METHOD(call)) {	176	switch (IPC_GET_METHOD(call)) {
177	case IPC_M_PHONE_HUNGUP:	177	case IPC_M_PHONE_HUNGUP:
178	ipc_answer_fast(callid,0,0,0);	178	ipc_answer_fast(callid,0,0,0);
179	/* TODO: Handle hangup */	179	/* TODO: Handle hangup */
180	return;	180	return;
181	case KBD_PUSHCHAR:	181	case KBD_PUSHCHAR:
182	/* got key from keyboard driver */	182	/* got key from keyboard driver */
183		183
184	retval = 0;	184	retval = 0;
185	c = IPC_GET_ARG1(call);	185	c = IPC_GET_ARG1(call);
186	/* switch to another virtual console */	186	/* switch to another virtual console */
187		187
188	conn = &connections[active_console];	188	conn = &connections[active_console];
189	// if ((c >= KBD_KEY_F1) && (c < KBD_KEY_F1 + CONSOLE_COUNT)) {	189	// if ((c >= KBD_KEY_F1) && (c < KBD_KEY_F1 + CONSOLE_COUNT)) {
190	if ((c >= '0') && (c < '0' + CONSOLE_COUNT)) {	190	if ((c >= '0') && (c < '0' + CONSOLE_COUNT)) {
191	if (c == '0') {	191	if (c == '0') {
192	/* switch to kernel console*/	192	/* switch to kernel console*/
193	nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 0);	193	nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 0);
194	nsend_call_2(fb_info.phone, FB_SET_STYLE, DEFAULT_FOREGROUND_COLOR, DEFAULT_BACKGROUND_COLOR);	194	nsend_call_2(fb_info.phone, FB_SET_STYLE, DEFAULT_FOREGROUND_COLOR, DEFAULT_BACKGROUND_COLOR);
195	nsend_call(fb_info.phone, FB_CLEAR, 0);	195	nsend_call(fb_info.phone, FB_CLEAR, 0);
196	/* FIXME: restore kernel console */	196	/* FIXME: restore kernel console */
197	__SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE);	197	__SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE);
198	break;	198	break;
199		199
200	} else {	200	} else {
201	c = c - '1';	201	c = c - '1';
202	if (c == active_console)	202	if (c == active_console)
203	break;	203	break;
204	active_console = c;	204	active_console = c;
205	gcons_change_console(c);	205	gcons_change_console(c);
206		206
207	}	207	}
208		208
209	conn = &connections[active_console];	209	conn = &connections[active_console];
210		210
211	nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 0);	211	nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 0);
212		212
213	if (interbuffer) {	213	if (interbuffer) {
214	for (i = 0; i < conn->screenbuffer.size_x; i++)	214	for (i = 0; i < conn->screenbuffer.size_x; i++)
215	for (j = 0; j < conn->screenbuffer.size_y; j++)	215	for (j = 0; j < conn->screenbuffer.size_y; j++)
216	interbuffer[i + jconn->screenbuffer.size_x] = get_field_at(&(conn->screenbuffer),i, j);	216	interbuffer[i + jconn->screenbuffer.size_x] = get_field_at(&(conn->screenbuffer),i, j);
217		217
218	sync_send_2(fb_info.phone, FB_DRAW_TEXT_DATA, 0, 0, NULL, NULL);	218	sync_send_2(fb_info.phone, FB_DRAW_TEXT_DATA, 0, 0, NULL, NULL);
219	} else {	219	} else {
220	nsend_call(fb_info.phone, FB_CLEAR, 0);	220	nsend_call(fb_info.phone, FB_CLEAR, 0);
221		221
222		222
223	for (i = 0; i < conn->screenbuffer.size_x; i++)	223	for (i = 0; i < conn->screenbuffer.size_x; i++)
224	for (j = 0; j < conn->screenbuffer.size_y; j++) {	224	for (j = 0; j < conn->screenbuffer.size_y; j++) {
225	d = get_field_at(&(conn->screenbuffer),i, j)->character;	225	d = get_field_at(&(conn->screenbuffer),i, j)->character;
226	if (d && d != ' ')	226	if (d && d != ' ')
227	nsend_call_3(fb_info.phone, FB_PUTCHAR, d, j, i);	227	nsend_call_3(fb_info.phone, FB_PUTCHAR, d, j, i);
228	}	228	}
229		229
230	}	230	}
231	nsend_call_2(fb_info.phone, FB_CURSOR_GOTO, conn->screenbuffer.position_y, conn->screenbuffer.position_x);	231	nsend_call_2(fb_info.phone, FB_CURSOR_GOTO, conn->screenbuffer.position_y, conn->screenbuffer.position_x);
232	nsend_call_2(fb_info.phone, FB_SET_STYLE, conn->screenbuffer.style.fg_color, \	232	nsend_call_2(fb_info.phone, FB_SET_STYLE, conn->screenbuffer.style.fg_color, \
233	conn->screenbuffer.style.bg_color);	233	conn->screenbuffer.style.bg_color);
234	send_call(fb_info.phone, FB_CURSOR_VISIBILITY, 1);	234	send_call(fb_info.phone, FB_CURSOR_VISIBILITY, 1);
235		235
236	break;	236	break;
237	}	237	}
238		238
239	/* if client is awaiting key, send it */	239	/* if client is awaiting key, send it */
240	if (conn->keyrequest_counter > 0) {	240	if (conn->keyrequest_counter > 0) {
241	conn->keyrequest_counter--;	241	conn->keyrequest_counter--;
242	ipc_answer_fast(fifo_pop(conn->keyrequests), 0, c, 0);	242	ipc_answer_fast(fifo_pop(conn->keyrequests), 0, c, 0);
243	break;	243	break;
244	}	244	}
245		245
246	/FIXME: else store key to its buffer /	246	/FIXME: else store key to its buffer /
247	keybuffer_push(&conn->keybuffer, c);	247	keybuffer_push(&conn->keybuffer, c);
248		248
249	break;	249	break;
250	default:	250	default:
251	retval = ENOENT;	251	retval = ENOENT;
252	}	252	}
253	ipc_answer_fast(callid, retval, 0, 0);	253	ipc_answer_fast(callid, retval, 0, 0);
254	}	254	}
255	}	255	}
256		256
257	/** Default thread for new connections */	257	/** Default thread for new connections */
258	static void client_connection(ipc_callid_t iid, ipc_call_t *icall)	258	static void client_connection(ipc_callid_t iid, ipc_call_t *icall)
259	{	259	{
260	ipc_callid_t callid;	260	ipc_callid_t callid;
261	ipc_call_t call;	261	ipc_call_t call;
262	int consnum;	262	int consnum;
263	ipcarg_t arg1, arg2;	263	ipcarg_t arg1, arg2;
264		264
265	if ((consnum = find_free_connection()) == CONSOLE_COUNT) {	265	if ((consnum = find_free_connection()) == CONSOLE_COUNT) {
266	ipc_answer_fast(iid,ELIMIT,0,0);	266	ipc_answer_fast(iid,ELIMIT,0,0);
267	return;	267	return;
268	}	268	}
269		269
270	connections[consnum].used = 1;	270	connections[consnum].used = 1;
271	connections[consnum].client_phone = IPC_GET_ARG3(call);	271	connections[consnum].client_phone = IPC_GET_ARG3(call);
272	screenbuffer_clear(&(connections[consnum].screenbuffer));	272	screenbuffer_clear(&(connections[consnum].screenbuffer));
273		273
274	/* Accept the connection */	274	/* Accept the connection */
275	ipc_answer_fast(iid,0,0,0);	275	ipc_answer_fast(iid,0,0,0);
276		276
277	while (1) {	277	while (1) {
278	callid = async_get_call(&call);	278	callid = async_get_call(&call);
279	arg1 = arg2 = 0;	279	arg1 = arg2 = 0;
280	switch (IPC_GET_METHOD(call)) {	280	switch (IPC_GET_METHOD(call)) {
281	case IPC_M_PHONE_HUNGUP:	281	case IPC_M_PHONE_HUNGUP:
282	/* TODO */	282	/* TODO */
283	ipc_answer_fast(callid, 0,0,0);	283	ipc_answer_fast(callid, 0,0,0);
284	return;	284	return;
285	case CONSOLE_PUTCHAR:	285	case CONSOLE_PUTCHAR:
286	write_char(consnum, IPC_GET_ARG1(call));	286	write_char(consnum, IPC_GET_ARG1(call));
-		287	gcons_notify_char(consnum);
287	break;	288	break;
288	case CONSOLE_CLEAR:	289	case CONSOLE_CLEAR:
289	/* Send message to fb */	290	/* Send message to fb */
290	if (consnum == active_console) {	291	if (consnum == active_console) {
291	send_call(fb_info.phone, FB_CLEAR, 0);	292	send_call(fb_info.phone, FB_CLEAR, 0);
292	}	293	}
293		294
294	screenbuffer_clear(&(connections[consnum].screenbuffer));	295	screenbuffer_clear(&(connections[consnum].screenbuffer));
295		296
296	break;	297	break;
297	case CONSOLE_GOTO:	298	case CONSOLE_GOTO:
298		299
299	screenbuffer_goto(&(connections[consnum].screenbuffer), IPC_GET_ARG1(call), IPC_GET_ARG2(call));	300	screenbuffer_goto(&(connections[consnum].screenbuffer), IPC_GET_ARG2(call), IPC_GET_ARG1(call));
300		301
301	break;	302	break;
302		303
303	case CONSOLE_GETSIZE:	304	case CONSOLE_GETSIZE:
304	arg1 = fb_info.cols;	305	arg1 = fb_info.rows;
305	arg2 = fb_info.rows;	306	arg2 = fb_info.cols;
306	break;	307	break;
307	case CONSOLE_FLUSH:	308	case CONSOLE_FLUSH:
308	sync_send_2(fb_info.phone, FB_FLUSH, 0, 0, NULL, NULL);	309	sync_send_2(fb_info.phone, FB_FLUSH, 0, 0, NULL, NULL);
309	break;	310	break;
310	case CONSOLE_SET_STYLE:	311	case CONSOLE_SET_STYLE:
311		312
312	arg1 = IPC_GET_ARG1(call);	313	arg1 = IPC_GET_ARG1(call);
313	arg2 = IPC_GET_ARG2(call);	314	arg2 = IPC_GET_ARG2(call);
314	screenbuffer_set_style(&(connections[consnum]),arg1, arg2);	315	screenbuffer_set_style(&(connections[consnum]),arg1, arg2);
315	if (consnum == active_console)	316	if (consnum == active_console)
316	nsend_call_2(fb_info.phone, FB_SET_STYLE, arg1, arg2);	317	nsend_call_2(fb_info.phone, FB_SET_STYLE, arg1, arg2);
317		318
318	break;	319	break;
319	case CONSOLE_GETCHAR:	320	case CONSOLE_GETCHAR:
320	if (keybuffer_empty(&(connections[consnum].keybuffer))) {	321	if (keybuffer_empty(&(connections[consnum].keybuffer))) {
321	/* buffer is empty -> store request */	322	/* buffer is empty -> store request */
322	if (connections[consnum].keyrequest_counter < MAX_KEYREQUESTS_BUFFERED) {	323	if (connections[consnum].keyrequest_counter < MAX_KEYREQUESTS_BUFFERED) {
323	fifo_push(connections[consnum].keyrequests, callid);	324	fifo_push(connections[consnum].keyrequests, callid);
324	connections[consnum].keyrequest_counter++;	325	connections[consnum].keyrequest_counter++;
325	} else {	326	} else {
326	/* no key available and too many requests => fail */	327	/* no key available and too many requests => fail */
327	ipc_answer_fast(callid, ELIMIT, 0, 0);	328	ipc_answer_fast(callid, ELIMIT, 0, 0);
328	}	329	}
329	continue;	330	continue;
330	};	331	};
331	keybuffer_pop(&(connections[consnum].keybuffer), (char *)&arg1);	332	keybuffer_pop(&(connections[consnum].keybuffer), (char *)&arg1);
332		333
333	break;	334	break;
334	}	335	}
335	ipc_answer_fast(callid, 0, arg1, arg2);	336	ipc_answer_fast(callid, 0, arg1, arg2);
336	}	337	}
337	}	338	}
338		339
339	int main(int argc, char *argv[])	340	int main(int argc, char *argv[])
340	{	341	{
341	ipcarg_t phonehash;	342	ipcarg_t phonehash;
342	int kbd_phone, fb_phone;	343	int kbd_phone, fb_phone;
343	ipcarg_t retval, arg1 = 0xdead, arg2 = 0xbeef;	344	ipcarg_t retval, arg1 = 0xdead, arg2 = 0xbeef;
344	int i;	345	int i;
345		346
346	async_set_client_connection(client_connection);	347	async_set_client_connection(client_connection);
347		348
348	/* Connect to keyboard driver */	349	/* Connect to keyboard driver */
349		350
350	while ((kbd_phone = ipc_connect_me_to(PHONE_NS, SERVICE_KEYBOARD, 0)) < 0) {	351	while ((kbd_phone = ipc_connect_me_to(PHONE_NS, SERVICE_KEYBOARD, 0)) < 0) {
351	usleep(10000);	352	usleep(10000);
352	};	353	};
353		354
354	if (ipc_connect_to_me(kbd_phone, SERVICE_CONSOLE, 0, &phonehash) != 0) {	355	if (ipc_connect_to_me(kbd_phone, SERVICE_CONSOLE, 0, &phonehash) != 0) {
355	return -1;	356	return -1;
356	};	357	};
357		358
358	/* Connect to framebuffer driver */	359	/* Connect to framebuffer driver */
359		360
360	while ((fb_info.phone = ipc_connect_me_to(PHONE_NS, SERVICE_VIDEO, 0)) < 0) {	361	while ((fb_info.phone = ipc_connect_me_to(PHONE_NS, SERVICE_VIDEO, 0)) < 0) {
361	usleep(10000);	362	usleep(10000);
362	}	363	}
363		364
364	/* Initialize gcons */	365	/* Initialize gcons */
365	gcons_init(fb_info.phone);	366	gcons_init(fb_info.phone);
366	/* Synchronize, the gcons can have something in queue */	367	/* Synchronize, the gcons can have something in queue */
367	sync_send_2(fb_info.phone, FB_GET_CSIZE, 0, 0, NULL, NULL);	368	sync_send_2(fb_info.phone, FB_GET_CSIZE, 0, 0, NULL, NULL);
368		369
369		370
370	ipc_call_sync_2(fb_info.phone, FB_GET_CSIZE, 0, 0, &(fb_info.rows), &(fb_info.cols));	371	ipc_call_sync_2(fb_info.phone, FB_GET_CSIZE, 0, 0, &(fb_info.rows), &(fb_info.cols));
371	nsend_call_2(fb_info.phone, FB_SET_STYLE, DEFAULT_FOREGROUND_COLOR, DEFAULT_BACKGROUND_COLOR);	372	nsend_call_2(fb_info.phone, FB_SET_STYLE, DEFAULT_FOREGROUND_COLOR, DEFAULT_BACKGROUND_COLOR);
372	nsend_call(fb_info.phone, FB_CLEAR, 0);	373	nsend_call(fb_info.phone, FB_CLEAR, 0);
373		374
374	/* Init virtual consoles */	375	/* Init virtual consoles */
375	for (i = 0; i < CONSOLE_COUNT; i++) {	376	for (i = 0; i < CONSOLE_COUNT; i++) {
376	connections[i].used = 0;	377	connections[i].used = 0;
377	keybuffer_init(&(connections[i].keybuffer));	378	keybuffer_init(&(connections[i].keybuffer));
378		379
379	connections[i].keyrequests.head = connections[i].keyrequests.tail = 0;	380	connections[i].keyrequests.head = connections[i].keyrequests.tail = 0;
380	connections[i].keyrequests.items = MAX_KEYREQUESTS_BUFFERED;	381	connections[i].keyrequests.items = MAX_KEYREQUESTS_BUFFERED;
381	connections[i].keyrequest_counter = 0;	382	connections[i].keyrequest_counter = 0;
382		383
383	if (screenbuffer_init(&(connections[i].screenbuffer), fb_info.cols, fb_info.rows ) == NULL) {	384	if (screenbuffer_init(&(connections[i].screenbuffer), fb_info.cols, fb_info.rows ) == NULL) {
384	/FIXME: handle error /	385	/FIXME: handle error /
385	return -1;	386	return -1;
386	}	387	}
387	}	388	}
388		389
389	if ((interbuffer = mmap(NULL, sizeof(keyfield_t) * fb_info.cols * fb_info.rows , PROTO_READ\|PROTO_WRITE, MAP_ANONYMOUS\|MAP_PRIVATE, 0 ,0 )) != NULL) {	390	if ((interbuffer = mmap(NULL, sizeof(keyfield_t) * fb_info.cols * fb_info.rows , PROTO_READ\|PROTO_WRITE, MAP_ANONYMOUS\|MAP_PRIVATE, 0 ,0 )) != NULL) {
390	if (ipc_call_sync_3(fb_info.phone, IPC_M_AS_AREA_SEND, (ipcarg_t)interbuffer, 0, AS_AREA_READ \| AS_AREA_CACHEABLE, NULL, NULL, NULL) != 0) {	391	if (ipc_call_sync_3(fb_info.phone, IPC_M_AS_AREA_SEND, (ipcarg_t)interbuffer, 0, AS_AREA_READ \| AS_AREA_CACHEABLE, NULL, NULL, NULL) != 0) {
391	munmap(interbuffer, sizeof(keyfield_t) * fb_info.cols * fb_info.rows);	392	munmap(interbuffer, sizeof(keyfield_t) * fb_info.cols * fb_info.rows);
392	interbuffer = NULL;	393	interbuffer = NULL;
393	}	394	}
394	}	395	}
395		396
396	/* FIXME: save kernel console screen */	397	/* FIXME: save kernel console screen */
397		398
398	async_new_connection(phonehash, 0, NULL, keyboard_events);	399	async_new_connection(phonehash, 0, NULL, keyboard_events);
399		400
400	sync_send_2(fb_info.phone, FB_CURSOR_GOTO, 0, 0, NULL, NULL);	401	sync_send_2(fb_info.phone, FB_CURSOR_GOTO, 0, 0, NULL, NULL);
401	nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 1);	402	nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 1);
402		403
403	/* Register at NS */	404	/* Register at NS */
404	if (ipc_connect_to_me(PHONE_NS, SERVICE_CONSOLE, 0, &phonehash) != 0) {	405	if (ipc_connect_to_me(PHONE_NS, SERVICE_CONSOLE, 0, &phonehash) != 0) {
405	return -1;	406	return -1;
406	};	407	};
407		408
408	async_manager();	409	async_manager();
409		410
410	return 0;	411	return 0;
411	}	412	}
412		413
413		414

Subversion Repositories HelenOS-historic

(root)/uspace/trunk/console/console.c – Rev 1526 → 1528