Subversion Repositories HelenOS

Rev

Rev 1610 | Rev 1630 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

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