WebSVN – HelenOS-historic – Diff – /uspace/trunk/fb/sysio.c


/*
 * Copyright (C) 2006 Ondrej Palkovsky
 * 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 <async.h>
#include <ipc/fb.h>
#include <ipc/ipc.h>
#include <libc.h>
#include <errno.h>
#include <string.h>
#include <libc.h>
#include <stdio.h>
 
#include "sysio.h"
 
#define WIDTH 80
#define HEIGHT 25
 
/* Allow only 1 connection */
static int client_connected = 0;
 
static void sysput(char c)
{
    __SYSCALL3(SYS_IO, 1, (sysarg_t)&c, (sysarg_t) 1);
}
 
static void sysputs(char *s)
{
    while (*s) {
        sysput(*(s++));
    }
//  __SYSCALL3(SYS_IO, 1, (sysarg_t)s, strlen(s));
}
 
/** Send clearscreen sequence to console */
static void clrscr(void)
{
    sysputs("\033[2J");
}
 
/** Send ansi sequence to console to change cursor position */
static void curs_goto(unsigned int row, unsigned int col)
{
    char control[20];
 
    if (row > 200 || col > 200)
        return;
 
    snprintf(control, 20, "\033[%d;%df",row+1, col+1);
    sysputs(control);
}
 
static void set_style(int mode)
{
    char control[20];
   
    snprintf(control, 20, "\033[%dm", mode);
    sysputs(control);
}
 
static void scroll(int i)
{
    if (i > 0) {
        curs_goto(HEIGHT-1, 0);
        while (i--)
            sysputs("\033D");
    } else if (i < 0) {
        curs_goto(0,0);
        while (i++)
            sysputs("\033M");
    }
}
 
/** ANSI terminal emulation main thread */
static void sysio_client_connection(ipc_callid_t iid, ipc_call_t *icall)
{
    int retval;
    ipc_callid_t callid;
    ipc_call_t call;
    char c;
    int lastcol=0;
    int lastrow=0;
    int newcol,newrow;
    int fgcolor,bgcolor;
    int i;
 
    if (client_connected) {
        ipc_answer_fast(iid, ELIMIT, 0,0);
        return;
    }
    client_connected = 1;
    ipc_answer_fast(iid, 0, 0, 0); /* Accept connection */
    while (1) {
        callid = async_get_call(&call);
        switch (IPC_GET_METHOD(call)) {
        case IPC_M_PHONE_HUNGUP:
            client_connected = 0;
            ipc_answer_fast(callid,0,0,0);
            return; /* Exit thread */
        case FB_PUTCHAR:
            c = IPC_GET_ARG1(call);
            newrow = IPC_GET_ARG2(call);
            newcol = IPC_GET_ARG3(call);
            if (lastcol != newcol || lastrow!=newrow)
                curs_goto(newrow, newcol);
            lastcol = newcol + 1;
            lastrow = newrow;
            sysput(c);
            retval = 0;
            break;
        case FB_CURSOR_GOTO:
            newrow = IPC_GET_ARG1(call);
            newcol = IPC_GET_ARG2(call);
            curs_goto(newrow, newcol);
            lastrow = newrow;
            lastcol = newcol;
            break;
        case FB_GET_CSIZE:
            ipc_answer_fast(callid, 0, HEIGHT, WIDTH);
            continue;
        case FB_CLEAR:
            clrscr();
            retval = 0;
            break;
        case FB_SET_STYLE:
            fgcolor = IPC_GET_ARG1(call);
            bgcolor = IPC_GET_ARG2(call);
 
 
            if (fgcolor < bgcolor)
                set_style(0);
            else
                set_style(7);
            retval = 0;
            break;
        case FB_SCROLL:
            i = IPC_GET_ARG1(call);
            if (i > HEIGHT || i < -HEIGHT) {
                retval = EINVAL;
                break;
            }
            scroll(i);
            curs_goto(lastrow, lastcol);
            retval = 0;
            break;
 
        default:
            retval = ENOENT;
        }
        ipc_answer_fast(callid,retval,0,0);
    }
}
 
/** ANSI terminal emulation initialization */
void sysio_init(void)
{
    async_set_client_connection(sysio_client_connection);
    clrscr();
    curs_goto(0,0);
    /* Set scrolling region to 0-25 lines */
    sysputs("\033[0;25r");
}
 

Rev 1630	Rev 1631
1	/*	1	/*
2	* Copyright (C) 2006 Ondrej Palkovsky	2	* Copyright (C) 2006 Ondrej Palkovsky
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	#include <async.h>	29	#include <async.h>
30	#include <ipc/fb.h>	30	#include <ipc/fb.h>
31	#include <ipc/ipc.h>	31	#include <ipc/ipc.h>
32	#include <libc.h>	32	#include <libc.h>
33	#include <errno.h>	33	#include <errno.h>
34	#include <string.h>	34	#include <string.h>
35	#include <libc.h>	35	#include <libc.h>
36	#include <stdio.h>	36	#include <stdio.h>
37		37
38	#include "sysio.h"	38	#include "sysio.h"
39		39
40	#define WIDTH 80	40	#define WIDTH 80
41	#define HEIGHT 25	41	#define HEIGHT 25
42		42
43	/* Allow only 1 connection */	43	/* Allow only 1 connection */
44	static int client_connected = 0;	44	static int client_connected = 0;
45		45
46	static void sysput(char c)	46	static void sysput(char c)
47	{	47	{
48	__SYSCALL3(SYS_IO, 1, (sysarg_t)&c, (sysarg_t) 1);	48	__SYSCALL3(SYS_IO, 1, (sysarg_t)&c, (sysarg_t) 1);
49	}	49	}
50		50
51	static void sysputs(char *s)	51	static void sysputs(char *s)
52	{	52	{
53	while (*s) {	53	while (*s) {
54	sysput(*(s++));	54	sysput(*(s++));
55	}	55	}
56	// __SYSCALL3(SYS_IO, 1, (sysarg_t)s, strlen(s));	56	// __SYSCALL3(SYS_IO, 1, (sysarg_t)s, strlen(s));
57	}	57	}
58		58
59	/** Send clearscreen sequence to console */	59	/** Send clearscreen sequence to console */
60	static void clrscr(void)	60	static void clrscr(void)
61	{	61	{
62	sysputs("\033[2J");	62	sysputs("\033[2J");
63	}	63	}
64		64
65	/** Send ansi sequence to console to change cursor position */	65	/** Send ansi sequence to console to change cursor position */
66	static void curs_goto(unsigned int row, unsigned int col)	66	static void curs_goto(unsigned int row, unsigned int col)
67	{	67	{
68	char control[20];	68	char control[20];
69		69
70	if (row > 200 \|\| col > 200)	70	if (row > 200 \|\| col > 200)
71	return;	71	return;
72		72
73	snprintf(control, 20, "\033[%d;%df",row+1, col+1);	73	snprintf(control, 20, "\033[%d;%df",row+1, col+1);
74	sysputs(control);	74	sysputs(control);
75	}	75	}
76		76
77	static void set_style(int mode)	77	static void set_style(int mode)
78	{	78	{
79	char control[20];	79	char control[20];
80		80
81	snprintf(control, 20, "\033[%dm", mode);	81	snprintf(control, 20, "\033[%dm", mode);
82	sysputs(control);	82	sysputs(control);
83	}	83	}
84		84
85	static void scroll(int i)	85	static void scroll(int i)
86	{	86	{
87	if (i > 0) {	87	if (i > 0) {
88	curs_goto(HEIGHT-1, 0);	88	curs_goto(HEIGHT-1, 0);
89	while (i--)	89	while (i--)
90	sysputs("\033D");	90	sysputs("\033D");
91	} else if (i < 0) {	91	} else if (i < 0) {
92	curs_goto(0,0);	92	curs_goto(0,0);
93	while (i++)	93	while (i++)
94	sysputs("\033M");	94	sysputs("\033M");
95	}	95	}
96	}	96	}
97		97
98	/** ANSI terminal emulation main thread */	98	/** ANSI terminal emulation main thread */
99	static void sysio_client_connection(ipc_callid_t iid, ipc_call_t *icall)	99	static void sysio_client_connection(ipc_callid_t iid, ipc_call_t *icall)
100	{	100	{
101	int retval;	101	int retval;
102	ipc_callid_t callid;	102	ipc_callid_t callid;
103	ipc_call_t call;	103	ipc_call_t call;
104	char c;	104	char c;
105	int lastcol=0;	105	int lastcol=0;
106	int lastrow=0;	106	int lastrow=0;
107	int newcol,newrow;	107	int newcol,newrow;
108	int fgcolor,bgcolor;	108	int fgcolor,bgcolor;
109	int i;	109	int i;
110		110
111	if (client_connected) {	111	if (client_connected) {
112	ipc_answer_fast(iid, ELIMIT, 0,0);	112	ipc_answer_fast(iid, ELIMIT, 0,0);
113	return;	113	return;
114	}	114	}
115	client_connected = 1;	115	client_connected = 1;
116	ipc_answer_fast(iid, 0, 0, 0); /* Accept connection */	116	ipc_answer_fast(iid, 0, 0, 0); /* Accept connection */
117	while (1) {	117	while (1) {
118	callid = async_get_call(&call);	118	callid = async_get_call(&call);
119	switch (IPC_GET_METHOD(call)) {	119	switch (IPC_GET_METHOD(call)) {
120	case IPC_M_PHONE_HUNGUP:	120	case IPC_M_PHONE_HUNGUP:
121	client_connected = 0;	121	client_connected = 0;
122	ipc_answer_fast(callid,0,0,0);	122	ipc_answer_fast(callid,0,0,0);
123	return; /* Exit thread */	123	return; /* Exit thread */
124	case FB_PUTCHAR:	124	case FB_PUTCHAR:
125	c = IPC_GET_ARG1(call);	125	c = IPC_GET_ARG1(call);
126	newrow = IPC_GET_ARG2(call);	126	newrow = IPC_GET_ARG2(call);
127	newcol = IPC_GET_ARG3(call);	127	newcol = IPC_GET_ARG3(call);
128	if (lastcol != newcol \|\| lastrow!=newrow)	128	if (lastcol != newcol \|\| lastrow!=newrow)
129	curs_goto(newrow, newcol);	129	curs_goto(newrow, newcol);
130	lastcol = newcol + 1;	130	lastcol = newcol + 1;
131	lastrow = newrow;	131	lastrow = newrow;
132	sysput(c);	132	sysput(c);
133	retval = 0;	133	retval = 0;
134	break;	134	break;
135	case FB_CURSOR_GOTO:	135	case FB_CURSOR_GOTO:
136	newrow = IPC_GET_ARG1(call);	136	newrow = IPC_GET_ARG1(call);
137	newcol = IPC_GET_ARG2(call);	137	newcol = IPC_GET_ARG2(call);
138	curs_goto(newrow, newcol);	138	curs_goto(newrow, newcol);
139	lastrow = newrow;	139	lastrow = newrow;
140	lastcol = newcol;	140	lastcol = newcol;
141	break;	141	break;
142	case FB_GET_CSIZE:	142	case FB_GET_CSIZE:
143	ipc_answer_fast(callid, 0, HEIGHT, WIDTH);	143	ipc_answer_fast(callid, 0, HEIGHT, WIDTH);
144	continue;	144	continue;
145	case FB_CLEAR:	145	case FB_CLEAR:
146	clrscr();	146	clrscr();
147	retval = 0;	147	retval = 0;
148	break;	148	break;
149	case FB_SET_STYLE:	149	case FB_SET_STYLE:
150	fgcolor = IPC_GET_ARG1(call);	150	fgcolor = IPC_GET_ARG1(call);
151	bgcolor = IPC_GET_ARG2(call);	151	bgcolor = IPC_GET_ARG2(call);
152	if (bgcolor == 0xf0f0f0)	-
153	set_style(0);	-
154	else if (fgcolor > bgcolor)	152	if (fgcolor < bgcolor)
155	set_style(0);	153	set_style(0);
156	else	154	else
157	set_style(7);	155	set_style(7);
158	retval = 0;	156	retval = 0;
159	break;	157	break;
160	case FB_SCROLL:	158	case FB_SCROLL:
161	i = IPC_GET_ARG1(call);	159	i = IPC_GET_ARG1(call);
162	if (i > HEIGHT \|\| i < -HEIGHT) {	160	if (i > HEIGHT \|\| i < -HEIGHT) {
163	retval = EINVAL;	161	retval = EINVAL;
164	break;	162	break;
165	}	163	}
166	scroll(i);	164	scroll(i);
167	curs_goto(lastrow, lastcol);	165	curs_goto(lastrow, lastcol);
168	retval = 0;	166	retval = 0;
169	break;	167	break;
170		168
171	default:	169	default:
172	retval = ENOENT;	170	retval = ENOENT;
173	}	171	}
174	ipc_answer_fast(callid,retval,0,0);	172	ipc_answer_fast(callid,retval,0,0);
175	}	173	}
176	}	174	}
177		175
178	/** ANSI terminal emulation initialization */	176	/** ANSI terminal emulation initialization */
179	void sysio_init(void)	177	void sysio_init(void)
180	{	178	{
181	async_set_client_connection(sysio_client_connection);	179	async_set_client_connection(sysio_client_connection);
182	clrscr();	180	clrscr();
183	curs_goto(0,0);	181	curs_goto(0,0);
184	/* Set scrolling region to 0-25 lines */	182	/* Set scrolling region to 0-25 lines */
185	sysputs("\033[0;25r");	183	sysputs("\033[0;25r");
186	}	184	}
187		185

Subversion Repositories HelenOS-historic

(root)/uspace/trunk/fb/sysio.c @ 1649 – Rev 1630 → 1631