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>
 
#define MAX_KEYREQUESTS_BUFFERED 32
 
#define NAME "CONSOLE"
 
int active_console = 0;
 
struct {
    int phone;      /**< Framebuffer phone */
    ipcarg_t rows;      /**< Framebuffer rows */
    ipcarg_t cols;      /**< Framebuffer columns */
} fb_info;
 
typedef struct {
    keybuffer_t keybuffer;
    FIFO_CREATE_STATIC(keyrequests, ipc_callid_t , MAX_KEYREQUESTS_BUFFERED);
    int keyrequest_counter;
    int client_phone;
    int used;
    screenbuffer_t screenbuffer;
} connection_t;
 
 
 
connection_t connections[CONSOLE_COUNT];
keyfield_t *interbuffer = NULL;
   
static int find_free_connection()
{
    int i = 0;
   
    while (i < CONSOLE_COUNT) {
        if (connections[i].used == 0)
            return i;
        ++i;
    }
    return CONSOLE_COUNT;
}
 
 
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*/
                    sync_send_2(fb_info.phone, FB_CURSOR_VISIBILITY, 0, 0, NULL, NULL);
                    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;
                }
               
                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));
            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_ARG1(call), IPC_GET_ARG2(call));
           
            break;
        case CONSOLE_GETSIZE:
            arg1 = fb_info.cols;
            arg2 = fb_info.rows;
            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);
    }
   
    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);
   
    nsend_call_2(fb_info.phone, FB_CURSOR_GOTO, 0, 0);
    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 1520	Rev 1521
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	#define MAX_KEYREQUESTS_BUFFERED 32	44	#define MAX_KEYREQUESTS_BUFFERED 32
45		45
46	#define NAME "CONSOLE"	46	#define NAME "CONSOLE"
47		47
48	int active_console = 0;	48	int active_console = 0;
49		49
50	struct {	50	struct {
51	int phone; /*< Framebuffer phone /	51	int phone; /*< Framebuffer phone /
52	ipcarg_t rows; /*< Framebuffer rows /	52	ipcarg_t rows; /*< Framebuffer rows /
53	ipcarg_t cols; /*< Framebuffer columns /	53	ipcarg_t cols; /*< Framebuffer columns /
54	} fb_info;	54	} fb_info;
55		55
56	typedef struct {	56	typedef struct {
57	keybuffer_t keybuffer;	57	keybuffer_t keybuffer;
58	FIFO_CREATE_STATIC(keyrequests, ipc_callid_t , MAX_KEYREQUESTS_BUFFERED);	58	FIFO_CREATE_STATIC(keyrequests, ipc_callid_t , MAX_KEYREQUESTS_BUFFERED);
59	int keyrequest_counter;	59	int keyrequest_counter;
60	int client_phone;	60	int client_phone;
61	int used;	61	int used;
62	screenbuffer_t screenbuffer;	62	screenbuffer_t screenbuffer;
63	} connection_t;	63	} connection_t;
64		64
65		65
66		66
67	connection_t connections[CONSOLE_COUNT];	67	connection_t connections[CONSOLE_COUNT];
68	keyfield_t *interbuffer = NULL;	68	keyfield_t *interbuffer = NULL;
69		69
70	static int find_free_connection()	70	static int find_free_connection()
71	{	71	{
72	int i = 0;	72	int i = 0;
73		73
74	while (i < CONSOLE_COUNT) {	74	while (i < CONSOLE_COUNT) {
75	if (connections[i].used == 0)	75	if (connections[i].used == 0)
76	return i;	76	return i;
77	++i;	77	++i;
78	}	78	}
79	return CONSOLE_COUNT;	79	return CONSOLE_COUNT;
80	}	80	}
81		81
82		82
83	static int find_connection(int client_phone)	83	static int find_connection(int client_phone)
84	{	84	{
85	int i = 0;	85	int i = 0;
86		86
87	while (i < CONSOLE_COUNT) {	87	while (i < CONSOLE_COUNT) {
88	if (connections[i].client_phone == client_phone)	88	if (connections[i].client_phone == client_phone)
89	return i;	89	return i;
90	++i;	90	++i;
91	}	91	}
92	return CONSOLE_COUNT;	92	return CONSOLE_COUNT;
93	}	93	}
94		94
95	/** Check key and process special keys.	95	/** Check key and process special keys.
96	*	96	*
97	* */	97	* */
98	static void write_char(int console, char key)	98	static void write_char(int console, char key)
99	{	99	{
100	screenbuffer_t *scr = &(connections[console].screenbuffer);	100	screenbuffer_t *scr = &(connections[console].screenbuffer);
101		101
102	switch (key) {	102	switch (key) {
103	case '\n':	103	case '\n':
104	scr->position_y += 1;	104	scr->position_y += 1;
105	scr->position_x = 0;	105	scr->position_x = 0;
106	break;	106	break;
107	case '\r':	107	case '\r':
108	break;	108	break;
109	case '\t':	109	case '\t':
110	scr->position_x += 8;	110	scr->position_x += 8;
111	scr->position_x -= scr->position_x % 8;	111	scr->position_x -= scr->position_x % 8;
112	break;	112	break;
113	case '\b':	113	case '\b':
114	if (scr->position_x == 0)	114	if (scr->position_x == 0)
115	break;	115	break;
116		116
117	scr->position_x--;	117	scr->position_x--;
118		118
119	if (console == active_console) {	119	if (console == active_console) {
120	nsend_call_3(fb_info.phone, FB_PUTCHAR, ' ', scr->position_y, scr->position_x);	120	nsend_call_3(fb_info.phone, FB_PUTCHAR, ' ', scr->position_y, scr->position_x);
121	}	121	}
122		122
123	screenbuffer_putchar(scr, ' ');	123	screenbuffer_putchar(scr, ' ');
124		124
125	break;	125	break;
126	default:	126	default:
127	if (console == active_console) {	127	if (console == active_console) {
128	nsend_call_3(fb_info.phone, FB_PUTCHAR, key, scr->position_y, scr->position_x);	128	nsend_call_3(fb_info.phone, FB_PUTCHAR, key, scr->position_y, scr->position_x);
129	}	129	}
130		130
131	screenbuffer_putchar(scr, key);	131	screenbuffer_putchar(scr, key);
132	scr->position_x++;	132	scr->position_x++;
133	}	133	}
134		134
135	scr->position_y += (scr->position_x >= scr->size_x);	135	scr->position_y += (scr->position_x >= scr->size_x);
136		136
137	if (scr->position_y >= scr->size_y) {	137	if (scr->position_y >= scr->size_y) {
138	scr->position_y = scr->size_y - 1;	138	scr->position_y = scr->size_y - 1;
139	screenbuffer_clear_line(scr, scr->top_line++);	139	screenbuffer_clear_line(scr, scr->top_line++);
140	if (console == active_console)	140	if (console == active_console)
141	nsend_call(fb_info.phone, FB_SCROLL, 1);	141	nsend_call(fb_info.phone, FB_SCROLL, 1);
142	}	142	}
143		143
144	scr->position_x = scr->position_x % scr->size_x;	144	scr->position_x = scr->position_x % scr->size_x;
145		145
146	if (console == active_console)	146	if (console == active_console)
147	send_call_2(fb_info.phone, FB_CURSOR_GOTO, scr->position_y, scr->position_x);	147	send_call_2(fb_info.phone, FB_CURSOR_GOTO, scr->position_y, scr->position_x);
148		148
149	}	149	}
150		150
151		151
152	/* Handler for keyboard */	152	/* Handler for keyboard */
153	static void keyboard_events(ipc_callid_t iid, ipc_call_t *icall)	153	static void keyboard_events(ipc_callid_t iid, ipc_call_t *icall)
154	{	154	{
155	ipc_callid_t callid;	155	ipc_callid_t callid;
156	ipc_call_t call;	156	ipc_call_t call;
157	int retval;	157	int retval;
158	int i, j;	158	int i, j;
159	char c,d;	159	char c,d;
160	connection_t *conn;	160	connection_t *conn;
161		161
162	/* Ignore parameters, the connection is alread opened */	162	/* Ignore parameters, the connection is alread opened */
163	while (1) {	163	while (1) {
164	callid = async_get_call(&call);	164	callid = async_get_call(&call);
165	switch (IPC_GET_METHOD(call)) {	165	switch (IPC_GET_METHOD(call)) {
166	case IPC_M_PHONE_HUNGUP:	166	case IPC_M_PHONE_HUNGUP:
167	ipc_answer_fast(callid,0,0,0);	167	ipc_answer_fast(callid,0,0,0);
168	/* TODO: Handle hangup */	168	/* TODO: Handle hangup */
169	return;	169	return;
170	case KBD_PUSHCHAR:	170	case KBD_PUSHCHAR:
171	/* got key from keyboard driver */	171	/* got key from keyboard driver */
172		172
173	retval = 0;	173	retval = 0;
174	c = IPC_GET_ARG1(call);	174	c = IPC_GET_ARG1(call);
175	/* switch to another virtual console */	175	/* switch to another virtual console */
176		176
177	conn = &connections[active_console];	177	conn = &connections[active_console];
178	// if ((c >= KBD_KEY_F1) && (c < KBD_KEY_F1 + CONSOLE_COUNT)) {	178	// if ((c >= KBD_KEY_F1) && (c < KBD_KEY_F1 + CONSOLE_COUNT)) {
179	if ((c >= '0') && (c < '0' + CONSOLE_COUNT)) {	179	if ((c >= '0') && (c < '0' + CONSOLE_COUNT)) {
180		180
181	if (c == '0') {	181	if (c == '0') {
182	/* switch to kernel console*/	182	/* switch to kernel console*/
183	sync_send_2(fb_info.phone, FB_CURSOR_VISIBILITY, 0, 0, NULL, NULL);	183	sync_send_2(fb_info.phone, FB_CURSOR_VISIBILITY, 0, 0, NULL, NULL);
184	nsend_call_2(fb_info.phone, FB_SET_STYLE, DEFAULT_FOREGROUND_COLOR, DEFAULT_BACKGROUND_COLOR);	184	nsend_call_2(fb_info.phone, FB_SET_STYLE, DEFAULT_FOREGROUND_COLOR, DEFAULT_BACKGROUND_COLOR);
185	nsend_call(fb_info.phone, FB_CLEAR, 0);	185	nsend_call(fb_info.phone, FB_CLEAR, 0);
186	/* FIXME: restore kernel console */	186	/* FIXME: restore kernel console */
187	__SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE);	187	__SYSCALL0(SYS_DEBUG_ENABLE_CONSOLE);
188	break;	188	break;
189		189
190	} else {	190	} else {
191	c = c - '1';	191	c = c - '1';
192	if (c == active_console)	192	if (c == active_console)
193	break;	193	break;
194	active_console = c;	194	active_console = c;
195	}	195	}
196		196
197	conn = &connections[active_console];	197	conn = &connections[active_console];
198		198
199	nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 0);	199	nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 0);
200		200
201	if (interbuffer) {	201	if (interbuffer) {
202	for (i = 0; i < conn->screenbuffer.size_x; i++)	202	for (i = 0; i < conn->screenbuffer.size_x; i++)
203	for (j = 0; j < conn->screenbuffer.size_y; j++)	203	for (j = 0; j < conn->screenbuffer.size_y; j++)
204	interbuffer[i + jconn->screenbuffer.size_x] = get_field_at(&(conn->screenbuffer),i, j);	204	interbuffer[i + jconn->screenbuffer.size_x] = get_field_at(&(conn->screenbuffer),i, j);
205		205
206	sync_send_2(fb_info.phone, FB_DRAW_TEXT_DATA, 0, 0, NULL, NULL);	206	sync_send_2(fb_info.phone, FB_DRAW_TEXT_DATA, 0, 0, NULL, NULL);
207	} else {	207	} else {
208	nsend_call(fb_info.phone, FB_CLEAR, 0);	208	nsend_call(fb_info.phone, FB_CLEAR, 0);
209		209
210		210
211	for (i = 0; i < conn->screenbuffer.size_x; i++)	211	for (i = 0; i < conn->screenbuffer.size_x; i++)
212	for (j = 0; j < conn->screenbuffer.size_y; j++) {	212	for (j = 0; j < conn->screenbuffer.size_y; j++) {
213	d = get_field_at(&(conn->screenbuffer),i, j)->character;	213	d = get_field_at(&(conn->screenbuffer),i, j)->character;
214	if (d && d != ' ')	214	if (d && d != ' ')
215	nsend_call_3(fb_info.phone, FB_PUTCHAR, d, j, i);	215	nsend_call_3(fb_info.phone, FB_PUTCHAR, d, j, i);
216	}	216	}
217		217
218	}	218	}
219	nsend_call_2(fb_info.phone, FB_CURSOR_GOTO, conn->screenbuffer.position_y, conn->screenbuffer.position_x);	219	nsend_call_2(fb_info.phone, FB_CURSOR_GOTO, conn->screenbuffer.position_y, conn->screenbuffer.position_x);
220	nsend_call_2(fb_info.phone, FB_SET_STYLE, conn->screenbuffer.style.fg_color, \	220	nsend_call_2(fb_info.phone, FB_SET_STYLE, conn->screenbuffer.style.fg_color, \
221	conn->screenbuffer.style.bg_color);	221	conn->screenbuffer.style.bg_color);
222	send_call(fb_info.phone, FB_CURSOR_VISIBILITY, 1);	222	send_call(fb_info.phone, FB_CURSOR_VISIBILITY, 1);
223		223
224	break;	224	break;
225	}	225	}
226		226
227	/* if client is awaiting key, send it */	227	/* if client is awaiting key, send it */
228	if (conn->keyrequest_counter > 0) {	228	if (conn->keyrequest_counter > 0) {
229	conn->keyrequest_counter--;	229	conn->keyrequest_counter--;
230	ipc_answer_fast(fifo_pop(conn->keyrequests), 0, c, 0);	230	ipc_answer_fast(fifo_pop(conn->keyrequests), 0, c, 0);
231	break;	231	break;
232	}	232	}
233		233
234	/FIXME: else store key to its buffer /	234	/FIXME: else store key to its buffer /
235	keybuffer_push(&conn->keybuffer, c);	235	keybuffer_push(&conn->keybuffer, c);
236		236
237	break;	237	break;
238	default:	238	default:
239	retval = ENOENT;	239	retval = ENOENT;
240	}	240	}
241	ipc_answer_fast(callid, retval, 0, 0);	241	ipc_answer_fast(callid, retval, 0, 0);
242	}	242	}
243	}	243	}
244		244
245	/** Default thread for new connections */	245	/** Default thread for new connections */
246	static void client_connection(ipc_callid_t iid, ipc_call_t *icall)	246	static void client_connection(ipc_callid_t iid, ipc_call_t *icall)
247	{	247	{
248	ipc_callid_t callid;	248	ipc_callid_t callid;
249	ipc_call_t call;	249	ipc_call_t call;
250	int consnum;	250	int consnum;
251	ipcarg_t arg1;	251	ipcarg_t arg1, arg2;
252		252
253	if ((consnum = find_free_connection()) == CONSOLE_COUNT) {	253	if ((consnum = find_free_connection()) == CONSOLE_COUNT) {
254	ipc_answer_fast(iid,ELIMIT,0,0);	254	ipc_answer_fast(iid,ELIMIT,0,0);
255	return;	255	return;
256	}	256	}
257		257
258	connections[consnum].used = 1;	258	connections[consnum].used = 1;
259	connections[consnum].client_phone = IPC_GET_ARG3(call);	259	connections[consnum].client_phone = IPC_GET_ARG3(call);
260	screenbuffer_clear(&(connections[consnum].screenbuffer));	260	screenbuffer_clear(&(connections[consnum].screenbuffer));
261		261
262	/* Accept the connection */	262	/* Accept the connection */
263	ipc_answer_fast(iid,0,0,0);	263	ipc_answer_fast(iid,0,0,0);
264		264
265	while (1) {	265	while (1) {
266	callid = async_get_call(&call);	266	callid = async_get_call(&call);
-		267	arg1 = arg2 = 0;
267	switch (IPC_GET_METHOD(call)) {	268	switch (IPC_GET_METHOD(call)) {
268	case IPC_M_PHONE_HUNGUP:	269	case IPC_M_PHONE_HUNGUP:
269	/* TODO */	270	/* TODO */
270	ipc_answer_fast(callid, 0,0,0);	271	ipc_answer_fast(callid, 0,0,0);
271	return;	272	return;
272	case CONSOLE_PUTCHAR:	273	case CONSOLE_PUTCHAR:
273	write_char(consnum, IPC_GET_ARG1(call));	274	write_char(consnum, IPC_GET_ARG1(call));
274	break;	275	break;
275	case CONSOLE_CLEAR:	276	case CONSOLE_CLEAR:
276	/* Send message to fb */	277	/* Send message to fb */
277	if (consnum == active_console) {	278	if (consnum == active_console) {
278	send_call(fb_info.phone, FB_CLEAR, 0);	279	send_call(fb_info.phone, FB_CLEAR, 0);
279	}	280	}
280		281
281	screenbuffer_clear(&(connections[consnum].screenbuffer));	282	screenbuffer_clear(&(connections[consnum].screenbuffer));
282		283
283	break;	284	break;
284	case CONSOLE_GOTO:	285	case CONSOLE_GOTO:
285		286
286	screenbuffer_goto(&(connections[consnum].screenbuffer), IPC_GET_ARG1(call), IPC_GET_ARG2(call));	287	screenbuffer_goto(&(connections[consnum].screenbuffer), IPC_GET_ARG1(call), IPC_GET_ARG2(call));
287		288
288	break;	289	break;
-		290	case CONSOLE_GETSIZE:
-		291	arg1 = fb_info.cols;
-		292	arg2 = fb_info.rows;
-		293	break;
289		294
290	case CONSOLE_GETCHAR:	295	case CONSOLE_GETCHAR:
291	if (keybuffer_empty(&(connections[consnum].keybuffer))) {	296	if (keybuffer_empty(&(connections[consnum].keybuffer))) {
292	/* buffer is empty -> store request */	297	/* buffer is empty -> store request */
293	if (connections[consnum].keyrequest_counter < MAX_KEYREQUESTS_BUFFERED) {	298	if (connections[consnum].keyrequest_counter < MAX_KEYREQUESTS_BUFFERED) {
294	fifo_push(connections[consnum].keyrequests, callid);	299	fifo_push(connections[consnum].keyrequests, callid);
295	connections[consnum].keyrequest_counter++;	300	connections[consnum].keyrequest_counter++;
296	} else {	301	} else {
297	/* no key available and too many requests => fail */	302	/* no key available and too many requests => fail */
298	ipc_answer_fast(callid, ELIMIT, 0, 0);	303	ipc_answer_fast(callid, ELIMIT, 0, 0);
299	}	304	}
300	continue;	305	continue;
301	};	306	};
302	keybuffer_pop(&(connections[consnum].keybuffer), (char *)&arg1);	307	keybuffer_pop(&(connections[consnum].keybuffer), (char *)&arg1);
303		308
304	break;	309	break;
305	}	310	}
306	ipc_answer_fast(callid, 0, arg1, 0);	311	ipc_answer_fast(callid, 0, arg1, arg2);
307	}	312	}
308	}	313	}
309		314
310	int main(int argc, char *argv[])	315	int main(int argc, char *argv[])
311	{	316	{
312	ipcarg_t phonehash;	317	ipcarg_t phonehash;
313	int kbd_phone, fb_phone;	318	int kbd_phone, fb_phone;
314	ipcarg_t retval, arg1 = 0xdead, arg2 = 0xbeef;	319	ipcarg_t retval, arg1 = 0xdead, arg2 = 0xbeef;
315	int i;	320	int i;
316		321
317	async_set_client_connection(client_connection);	322	async_set_client_connection(client_connection);
318		323
319	/* Connect to keyboard driver */	324	/* Connect to keyboard driver */
320		325
321	while ((kbd_phone = ipc_connect_me_to(PHONE_NS, SERVICE_KEYBOARD, 0)) < 0) {	326	while ((kbd_phone = ipc_connect_me_to(PHONE_NS, SERVICE_KEYBOARD, 0)) < 0) {
322	usleep(10000);	327	usleep(10000);
323	};	328	};
324		329
325	if (ipc_connect_to_me(kbd_phone, SERVICE_CONSOLE, 0, &phonehash) != 0) {	330	if (ipc_connect_to_me(kbd_phone, SERVICE_CONSOLE, 0, &phonehash) != 0) {
326	return -1;	331	return -1;
327	};	332	};
328		333
329	/* Connect to framebuffer driver */	334	/* Connect to framebuffer driver */
330		335
331	while ((fb_info.phone = ipc_connect_me_to(PHONE_NS, SERVICE_VIDEO, 0)) < 0) {	336	while ((fb_info.phone = ipc_connect_me_to(PHONE_NS, SERVICE_VIDEO, 0)) < 0) {
332	usleep(10000);	337	usleep(10000);
333	}	338	}
334		339
335	ipc_call_sync_2(fb_info.phone, FB_GET_CSIZE, 0, 0, &(fb_info.rows), &(fb_info.cols));	340	ipc_call_sync_2(fb_info.phone, FB_GET_CSIZE, 0, 0, &(fb_info.rows), &(fb_info.cols));
336	nsend_call_2(fb_info.phone, FB_SET_STYLE, DEFAULT_FOREGROUND_COLOR, DEFAULT_BACKGROUND_COLOR);	341	nsend_call_2(fb_info.phone, FB_SET_STYLE, DEFAULT_FOREGROUND_COLOR, DEFAULT_BACKGROUND_COLOR);
337	nsend_call(fb_info.phone, FB_CLEAR, 0);	342	nsend_call(fb_info.phone, FB_CLEAR, 0);
338		343
339	/* Init virtual consoles */	344	/* Init virtual consoles */
340	for (i = 0; i < CONSOLE_COUNT; i++) {	345	for (i = 0; i < CONSOLE_COUNT; i++) {
341	connections[i].used = 0;	346	connections[i].used = 0;
342	keybuffer_init(&(connections[i].keybuffer));	347	keybuffer_init(&(connections[i].keybuffer));
343		348
344	connections[i].keyrequests.head = connections[i].keyrequests.tail = 0;	349	connections[i].keyrequests.head = connections[i].keyrequests.tail = 0;
345	connections[i].keyrequests.items = MAX_KEYREQUESTS_BUFFERED;	350	connections[i].keyrequests.items = MAX_KEYREQUESTS_BUFFERED;
346	connections[i].keyrequest_counter = 0;	351	connections[i].keyrequest_counter = 0;
347		352
348	if (screenbuffer_init(&(connections[i].screenbuffer), fb_info.cols, fb_info.rows ) == NULL) {	353	if (screenbuffer_init(&(connections[i].screenbuffer), fb_info.cols, fb_info.rows ) == NULL) {
349	/FIXME: handle error /	354	/FIXME: handle error /
350	return -1;	355	return -1;
351	}	356	}
352	}	357	}
353		358
354	if ((interbuffer = mmap(NULL, sizeof(keyfield_t) * fb_info.cols * fb_info.rows , PROTO_READ\|PROTO_WRITE, MAP_ANONYMOUS\|MAP_PRIVATE, 0 ,0 )) != NULL) {	359	if ((interbuffer = mmap(NULL, sizeof(keyfield_t) * fb_info.cols * fb_info.rows , PROTO_READ\|PROTO_WRITE, MAP_ANONYMOUS\|MAP_PRIVATE, 0 ,0 )) != NULL) {
355	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) {	360	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) {
356	munmap(interbuffer, sizeof(keyfield_t) * fb_info.cols * fb_info.rows);	361	munmap(interbuffer, sizeof(keyfield_t) * fb_info.cols * fb_info.rows);
357	interbuffer = NULL;	362	interbuffer = NULL;
358	}	363	}
359	}	364	}
360		365
361	/* FIXME: save kernel console screen */	366	/* FIXME: save kernel console screen */
362		367
363	async_new_connection(phonehash, 0, NULL, keyboard_events);	368	async_new_connection(phonehash, 0, NULL, keyboard_events);
364		369
365	nsend_call_2(fb_info.phone, FB_CURSOR_GOTO, 0, 0);	370	nsend_call_2(fb_info.phone, FB_CURSOR_GOTO, 0, 0);
366	nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 1);	371	nsend_call(fb_info.phone, FB_CURSOR_VISIBILITY, 1);
367		372
368	/* Register at NS */	373	/* Register at NS */
369	if (ipc_connect_to_me(PHONE_NS, SERVICE_CONSOLE, 0, &phonehash) != 0) {	374	if (ipc_connect_to_me(PHONE_NS, SERVICE_CONSOLE, 0, &phonehash) != 0) {
370	return -1;	375	return -1;
371	};	376	};
372		377
373	async_manager();	378	async_manager();
374		379
375	return 0;	380	return 0;
376	}	381	}
377		382
378		383

Subversion Repositories HelenOS-historic

(root)/uspace/trunk/console/console.c @ 1740 – Rev 1520 → 1521