WebSVN – HelenOS – Diff – /trunk/uspace/fb/ega.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.
 */
 
/** @defgroup egafb EGA framebuffer
 * @brief   HelenOS EGA framebuffer.
 * @ingroup fbs
 * @{
 */
/** @file
 */
 
#include <stdlib.h>
#include <unistd.h>
#include <align.h>
#include <async.h>
#include <ipc/ipc.h>
#include <errno.h>
#include <stdio.h>
#include <ddi.h>
#include <sysinfo.h>
#include <as.h>
#include <ipc/fb.h>
#include <ipc/ipc.h>
#include <ipc/ns.h>
#include <ipc/services.h>
#include <libarch/ddi.h>
 
#include "ega.h"
#include "../console/screenbuffer.h"
#include "main.h"
 
#define MAX_SAVED_SCREENS 256
typedef struct saved_screen {
    short *data;
} saved_screen;
 
saved_screen saved_screens[MAX_SAVED_SCREENS];
 
#define EGA_IO_ADDRESS 0x3d4
#define EGA_IO_SIZE 2
 
#define NORMAL_COLOR       0x0f
#define INVERTED_COLOR     0xf0
 
#define EGA_STYLE(fg,bg) ((fg) > (bg) ? NORMAL_COLOR : INVERTED_COLOR)
 
/* Allow only 1 connection */
static int client_connected = 0;
 
static unsigned int scr_width;
static unsigned int scr_height;
static char *scr_addr;
 
static unsigned int style = NORMAL_COLOR;
 
static void clrscr(void)
{
    int i;
   
    for (i = 0; i < scr_width*scr_height; i++) {
        scr_addr[i * 2] = ' ';
        scr_addr[i * 2 + 1] = style;
    }
}
 
static void cursor_goto(unsigned int row, unsigned int col)
{
    int ega_cursor;
 
    ega_cursor = col + scr_width * row;
   
    outb(EGA_IO_ADDRESS, 0xe);
    outb(EGA_IO_ADDRESS + 1, (ega_cursor >> 8) & 0xff);
    outb(EGA_IO_ADDRESS, 0xf);
    outb(EGA_IO_ADDRESS + 1, ega_cursor & 0xff);
}
 
static void cursor_disable(void)
{
    uint8_t stat;
 
    outb(EGA_IO_ADDRESS, 0xa);
    stat=inb(EGA_IO_ADDRESS + 1);
    outb(EGA_IO_ADDRESS, 0xa);
    outb(EGA_IO_ADDRESS + 1, stat | (1 << 5));
}
 
static void cursor_enable(void)
{
    uint8_t stat;
 
    outb(EGA_IO_ADDRESS, 0xa);
    stat=inb(EGA_IO_ADDRESS + 1);
    outb(EGA_IO_ADDRESS, 0xa);
    outb(EGA_IO_ADDRESS + 1, stat & (~(1 << 5)));
}
 
static void scroll(int rows)
{
    int i;
    if (rows > 0) {
        memcpy(scr_addr, ((char *) scr_addr) + rows * scr_width * 2,
            scr_width * scr_height * 2 - rows * scr_width * 2);
        for (i = 0; i < rows * scr_width; i++)
            (((short *) scr_addr) + scr_width * scr_height - rows *
                scr_width)[i] = ((style << 8) + ' ');
    } else if (rows < 0) {
        memcpy(((char *)scr_addr) - rows * scr_width * 2, scr_addr,
            scr_width * scr_height * 2 + rows * scr_width * 2);
        for (i = 0; i < -rows * scr_width; i++)
            ((short *)scr_addr)[i] = ((style << 8 ) + ' ');
    }
}
 
static void printchar(char c, unsigned int row, unsigned int col)
{
    scr_addr[(row * scr_width + col) * 2] = c;
    scr_addr[(row * scr_width + col) * 2 + 1] = style;
   
    cursor_goto(row, col + 1);
}
 
static void draw_text_data(keyfield_t *data)
{
    int i;
 
    for (i = 0; i < scr_width * scr_height; i++) {
        scr_addr[i * 2] = data[i].character;
        scr_addr[i * 2 + 1] = EGA_STYLE(data[i].style.fg_color,
            data[i].style.bg_color);
    }
}
 
static int save_screen(void)
{
    int i;
 
    for (i=0; (i < MAX_SAVED_SCREENS) && (saved_screens[i].data); i++)
        ;
    if (i == MAX_SAVED_SCREENS)
        return EINVAL;
    if (!(saved_screens[i].data = malloc(2 * scr_width * scr_height)))
        return ENOMEM;
    memcpy(saved_screens[i].data, scr_addr, 2 * scr_width * scr_height);
 
    return i;
}
 
static int print_screen(int i)
{
    if (saved_screens[i].data)
        memcpy(scr_addr, saved_screens[i].data, 2 * scr_width *
            scr_height);
    else
        return EINVAL;
    return i;
}
 
 
static void ega_client_connection(ipc_callid_t iid, ipc_call_t *icall)
{
    int retval;
    ipc_callid_t callid;
    ipc_call_t call;
    char c;
    unsigned int row, col;
    int bgcolor,fgcolor;
    keyfield_t *interbuf = NULL;
    size_t intersize = 0;
    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 IPC_M_AS_AREA_SEND:
            /* We accept one area for data interchange */
            intersize = IPC_GET_ARG2(call);
            if (intersize >= scr_width * scr_height *
                sizeof(*interbuf)) {
                receive_comm_area(callid, &call, (void *)
                    &interbuf);
                continue;
            }
            retval = EINVAL;
            break;
        case FB_DRAW_TEXT_DATA:
            if (!interbuf) {
                retval = EINVAL;
                break;
            }
            draw_text_data(interbuf);
            retval = 0;
            break;
        case FB_GET_CSIZE:
            ipc_answer_fast(callid, 0, scr_height, scr_width);
            continue;
        case FB_CLEAR:
            clrscr();
            retval = 0;
            break;
        case FB_PUTCHAR:
            c = IPC_GET_ARG1(call);
            row = IPC_GET_ARG2(call);
            col = IPC_GET_ARG3(call);
            if (col >= scr_width || row >= scr_height) {
                retval = EINVAL;
                break;
            }
            printchar(c, row, col);
            retval = 0;
            break;
        case FB_CURSOR_GOTO:
            row = IPC_GET_ARG1(call);
            col = IPC_GET_ARG2(call);
            if (row >= scr_height || col >= scr_width) {
                retval = EINVAL;
                break;
            }
            cursor_goto(row, col);
            retval = 0;
            break;
        case FB_SCROLL:
            i = IPC_GET_ARG1(call);
            if (i > scr_height || i < -((int) scr_height)) {
                retval = EINVAL;
                break;
            }
            scroll(i);
            retval = 0;
            break;
        case FB_CURSOR_VISIBILITY:
            if(IPC_GET_ARG1(call))
                cursor_enable();
            else
                cursor_disable();
            retval = 0;
            break;
        case FB_SET_STYLE:
            fgcolor = IPC_GET_ARG1(call);
            bgcolor = IPC_GET_ARG2(call);
            style = EGA_STYLE(fgcolor, bgcolor);
            retval = 0;
            break;
        case FB_VP_DRAW_PIXMAP:
            i = IPC_GET_ARG2(call);
            retval = print_screen(i);
            break;
        case FB_VP2PIXMAP:
            retval = save_screen();
            break;
        case FB_DROP_PIXMAP:
            i = IPC_GET_ARG1(call);
            if (i >= MAX_SAVED_SCREENS) {
                retval = EINVAL;
                break;
            }
            if (saved_screens[i].data) {
                free(saved_screens[i].data);
                saved_screens[i].data = NULL;
            }
            retval = 0;
            break;
 
        default:
            retval = ENOENT;
        }
        ipc_answer_fast(callid, retval, 0, 0);
    }
}
 
int ega_init(void)
{
    void *ega_ph_addr;
    size_t sz;
 
    ega_ph_addr = (void *) sysinfo_value("fb.address.physical");
    scr_width = sysinfo_value("fb.width");
    scr_height = sysinfo_value("fb.height");
    iospace_enable(task_get_id(), (void *) EGA_IO_ADDRESS, 2);
 
    sz = scr_width * scr_height * 2;
    scr_addr = as_get_mappable_page(sz, (int)
        sysinfo_value("fb.address.color"));
 
    physmem_map(ega_ph_addr, scr_addr, ALIGN_UP(sz, PAGE_SIZE) >>
        PAGE_WIDTH, AS_AREA_READ | AS_AREA_WRITE);
 
    async_set_client_connection(ega_client_connection);
 
    return 0;
}
 
 
/**
 * @}
 */
 

Rev 2025	Rev 2071
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	/** @defgroup egafb EGA framebuffer	29	/** @defgroup egafb EGA framebuffer
30	* @brief HelenOS EGA framebuffer.	30	* @brief HelenOS EGA framebuffer.
31	* @ingroup fbs	31	* @ingroup fbs
32	* @{	32	* @{
33	*/	33	*/
34	/** @file	34	/** @file
35	*/	35	*/
36		36
37	#include <stdlib.h>	37	#include <stdlib.h>
38	#include <unistd.h>	38	#include <unistd.h>
39	#include <align.h>	39	#include <align.h>
40	#include <async.h>	40	#include <async.h>
41	#include <ipc/ipc.h>	41	#include <ipc/ipc.h>
42	#include <errno.h>	42	#include <errno.h>
43	#include <stdio.h>	43	#include <stdio.h>
44	#include <ddi.h>	44	#include <ddi.h>
45	#include <sysinfo.h>	45	#include <sysinfo.h>
46	#include <as.h>	46	#include <as.h>
47	#include <ipc/fb.h>	47	#include <ipc/fb.h>
48	#include <ipc/ipc.h>	48	#include <ipc/ipc.h>
49	#include <ipc/ns.h>	49	#include <ipc/ns.h>
50	#include <ipc/services.h>	50	#include <ipc/services.h>
51	#include <libarch/ddi.h>	51	#include <libarch/ddi.h>
52		52
53	#include "ega.h"	53	#include "ega.h"
54	#include "../console/screenbuffer.h"	54	#include "../console/screenbuffer.h"
55	#include "main.h"	55	#include "main.h"
56		56
57	#define MAX_SAVED_SCREENS 256	57	#define MAX_SAVED_SCREENS 256
58	typedef struct saved_screen {	58	typedef struct saved_screen {
59	short *data;	59	short *data;
60	} saved_screen;	60	} saved_screen;
61		61
62	saved_screen saved_screens[MAX_SAVED_SCREENS];	62	saved_screen saved_screens[MAX_SAVED_SCREENS];
63		63
64	#define EGA_IO_ADDRESS 0x3d4	64	#define EGA_IO_ADDRESS 0x3d4
65	#define EGA_IO_SIZE 2	65	#define EGA_IO_SIZE 2
66		66
67	#define NORMAL_COLOR 0x0f	67	#define NORMAL_COLOR 0x0f
68	#define INVERTED_COLOR 0xf0	68	#define INVERTED_COLOR 0xf0
69		69
70	#define EGA_STYLE(fg,bg) ((fg) > (bg) ? NORMAL_COLOR : INVERTED_COLOR)	70	#define EGA_STYLE(fg,bg) ((fg) > (bg) ? NORMAL_COLOR : INVERTED_COLOR)
71		71
72	/* Allow only 1 connection */	72	/* Allow only 1 connection */
73	static int client_connected = 0;	73	static int client_connected = 0;
74		74
75	static unsigned int scr_width;	75	static unsigned int scr_width;
76	static unsigned int scr_height;	76	static unsigned int scr_height;
77	static char *scr_addr;	77	static char *scr_addr;
78		78
79	static unsigned int style = NORMAL_COLOR;	79	static unsigned int style = NORMAL_COLOR;
80		80
81	static void clrscr(void)	81	static void clrscr(void)
82	{	82	{
83	int i;	83	int i;
84		84
85	for (i = 0; i < scr_width*scr_height; i++) {	85	for (i = 0; i < scr_width*scr_height; i++) {
86	scr_addr[i * 2] = ' ';	86	scr_addr[i * 2] = ' ';
87	scr_addr[i * 2 + 1] = style;	87	scr_addr[i * 2 + 1] = style;
88	}	88	}
89	}	89	}
90		90
91	static void cursor_goto(unsigned int row, unsigned int col)	91	static void cursor_goto(unsigned int row, unsigned int col)
92	{	92	{
93	int ega_cursor;	93	int ega_cursor;
94		94
95	ega_cursor = col + scr_width * row;	95	ega_cursor = col + scr_width * row;
96		96
97	outb(EGA_IO_ADDRESS, 0xe);	97	outb(EGA_IO_ADDRESS, 0xe);
98	outb(EGA_IO_ADDRESS + 1, (ega_cursor >> 8) & 0xff);	98	outb(EGA_IO_ADDRESS + 1, (ega_cursor >> 8) & 0xff);
99	outb(EGA_IO_ADDRESS, 0xf);	99	outb(EGA_IO_ADDRESS, 0xf);
100	outb(EGA_IO_ADDRESS + 1, ega_cursor & 0xff);	100	outb(EGA_IO_ADDRESS + 1, ega_cursor & 0xff);
101	}	101	}
102		102
103	static void cursor_disable(void)	103	static void cursor_disable(void)
104	{	104	{
105	uint8_t stat;	105	uint8_t stat;
106		106
107	outb(EGA_IO_ADDRESS, 0xa);	107	outb(EGA_IO_ADDRESS, 0xa);
108	stat=inb(EGA_IO_ADDRESS + 1);	108	stat=inb(EGA_IO_ADDRESS + 1);
109	outb(EGA_IO_ADDRESS, 0xa);	109	outb(EGA_IO_ADDRESS, 0xa);
110	outb(EGA_IO_ADDRESS + 1, stat \| (1 << 5));	110	outb(EGA_IO_ADDRESS + 1, stat \| (1 << 5));
111	}	111	}
112		112
113	static void cursor_enable(void)	113	static void cursor_enable(void)
114	{	114	{
115	uint8_t stat;	115	uint8_t stat;
116		116
117	outb(EGA_IO_ADDRESS, 0xa);	117	outb(EGA_IO_ADDRESS, 0xa);
118	stat=inb(EGA_IO_ADDRESS + 1);	118	stat=inb(EGA_IO_ADDRESS + 1);
119	outb(EGA_IO_ADDRESS, 0xa);	119	outb(EGA_IO_ADDRESS, 0xa);
120	outb(EGA_IO_ADDRESS + 1, stat & (~(1 << 5)));	120	outb(EGA_IO_ADDRESS + 1, stat & (~(1 << 5)));
121	}	121	}
122		122
123	static void scroll(int rows)	123	static void scroll(int rows)
124	{	124	{
125	int i;	125	int i;
126	if (rows > 0) {	126	if (rows > 0) {
127	memcpy(scr_addr, ((char ) scr_addr) + rows scr_width * 2,	127	memcpy(scr_addr, ((char ) scr_addr) + rows scr_width * 2,
128	scr_width * scr_height * 2 - rows * scr_width * 2);	128	scr_width * scr_height * 2 - rows * scr_width * 2);
129	for (i = 0; i < rows * scr_width; i++)	129	for (i = 0; i < rows * scr_width; i++)
130	(((short ) scr_addr) + scr_width scr_height - rows *	130	(((short ) scr_addr) + scr_width scr_height - rows *
131	scr_width)[i] = ((style << 8) + ' ');	131	scr_width)[i] = ((style << 8) + ' ');
132	} else if (rows < 0) {	132	} else if (rows < 0) {
133	memcpy(((char )scr_addr) - rows scr_width * 2, scr_addr,	133	memcpy(((char )scr_addr) - rows scr_width * 2, scr_addr,
134	scr_width * scr_height * 2 + rows * scr_width * 2);	134	scr_width * scr_height * 2 + rows * scr_width * 2);
135	for (i = 0; i < -rows * scr_width; i++)	135	for (i = 0; i < -rows * scr_width; i++)
136	((short *)scr_addr)[i] = ((style << 8 ) + ' ');	136	((short *)scr_addr)[i] = ((style << 8 ) + ' ');
137	}	137	}
138	}	138	}
139		139
140	static void printchar(char c, unsigned int row, unsigned int col)	140	static void printchar(char c, unsigned int row, unsigned int col)
141	{	141	{
142	scr_addr[(row * scr_width + col) * 2] = c;	142	scr_addr[(row * scr_width + col) * 2] = c;
143	scr_addr[(row * scr_width + col) * 2 + 1] = style;	143	scr_addr[(row * scr_width + col) * 2 + 1] = style;
144		144
145	cursor_goto(row, col + 1);	145	cursor_goto(row, col + 1);
146	}	146	}
147		147
148	static void draw_text_data(keyfield_t *data)	148	static void draw_text_data(keyfield_t *data)
149	{	149	{
150	int i;	150	int i;
151		151
152	for (i = 0; i < scr_width * scr_height; i++) {	152	for (i = 0; i < scr_width * scr_height; i++) {
153	scr_addr[i * 2] = data[i].character;	153	scr_addr[i * 2] = data[i].character;
154	scr_addr[i * 2 + 1] = EGA_STYLE(data[i].style.fg_color,	154	scr_addr[i * 2 + 1] = EGA_STYLE(data[i].style.fg_color,
155	data[i].style.bg_color);	155	data[i].style.bg_color);
156	}	156	}
157	}	157	}
158		158
159	static int save_screen(void)	159	static int save_screen(void)
160	{	160	{
161	int i;	161	int i;
162		162
163	for (i=0; (i < MAX_SAVED_SCREENS) && (saved_screens[i].data); i++)	163	for (i=0; (i < MAX_SAVED_SCREENS) && (saved_screens[i].data); i++)
164	;	164	;
165	if (i == MAX_SAVED_SCREENS)	165	if (i == MAX_SAVED_SCREENS)
166	return EINVAL;	166	return EINVAL;
167	if (!(saved_screens[i].data = malloc(2 * scr_width * scr_height)))	167	if (!(saved_screens[i].data = malloc(2 * scr_width * scr_height)))
168	return ENOMEM;	168	return ENOMEM;
169	memcpy(saved_screens[i].data, scr_addr, 2 * scr_width * scr_height);	169	memcpy(saved_screens[i].data, scr_addr, 2 * scr_width * scr_height);
170		170
171	return i;	171	return i;
172	}	172	}
173		173
174	static int print_screen(int i)	174	static int print_screen(int i)
175	{	175	{
176	if (saved_screens[i].data)	176	if (saved_screens[i].data)
177	memcpy(scr_addr, saved_screens[i].data, 2 * scr_width *	177	memcpy(scr_addr, saved_screens[i].data, 2 * scr_width *
178	scr_height);	178	scr_height);
179	else	179	else
180	return EINVAL;	180	return EINVAL;
181	return i;	181	return i;
182	}	182	}
183		183
184		184
185	static void ega_client_connection(ipc_callid_t iid, ipc_call_t *icall)	185	static void ega_client_connection(ipc_callid_t iid, ipc_call_t *icall)
186	{	186	{
187	int retval;	187	int retval;
188	ipc_callid_t callid;	188	ipc_callid_t callid;
189	ipc_call_t call;	189	ipc_call_t call;
190	char c;	190	char c;
191	unsigned int row, col;	191	unsigned int row, col;
192	int bgcolor,fgcolor;	192	int bgcolor,fgcolor;
193	keyfield_t *interbuf = NULL;	193	keyfield_t *interbuf = NULL;
194	size_t intersize = 0;	194	size_t intersize = 0;
195	int i;	195	int i;
196		196
197	if (client_connected) {	197	if (client_connected) {
198	ipc_answer_fast(iid, ELIMIT, 0,0);	198	ipc_answer_fast(iid, ELIMIT, 0,0);
199	return;	199	return;
200	}	200	}
201	client_connected = 1;	201	client_connected = 1;
202	ipc_answer_fast(iid, 0, 0, 0); /* Accept connection */	202	ipc_answer_fast(iid, 0, 0, 0); /* Accept connection */
203		203
204	while (1) {	204	while (1) {
205	callid = async_get_call(&call);	205	callid = async_get_call(&call);
206	switch (IPC_GET_METHOD(call)) {	206	switch (IPC_GET_METHOD(call)) {
207	case IPC_M_PHONE_HUNGUP:	207	case IPC_M_PHONE_HUNGUP:
208	client_connected = 0;	208	client_connected = 0;
209	ipc_answer_fast(callid, 0, 0, 0);	209	ipc_answer_fast(callid, 0, 0, 0);
210	return; /* Exit thread */	210	return; /* Exit thread */
211	case IPC_M_AS_AREA_SEND:	211	case IPC_M_AS_AREA_SEND:
212	/* We accept one area for data interchange */	212	/* We accept one area for data interchange */
213	intersize = IPC_GET_ARG2(call);	213	intersize = IPC_GET_ARG2(call);
214	if (intersize >= scr_width * scr_height *	214	if (intersize >= scr_width * scr_height *
215	sizeof(*interbuf)) {	215	sizeof(*interbuf)) {
216	receive_comm_area(callid, &call, (void *)	216	receive_comm_area(callid, &call, (void *)
217	&interbuf);	217	&interbuf);
218	continue;	218	continue;
219	}	219	}
220	retval = EINVAL;	220	retval = EINVAL;
221	break;	221	break;
222	case FB_DRAW_TEXT_DATA:	222	case FB_DRAW_TEXT_DATA:
223	if (!interbuf) {	223	if (!interbuf) {
224	retval = EINVAL;	224	retval = EINVAL;
225	break;	225	break;
226	}	226	}
227	draw_text_data(interbuf);	227	draw_text_data(interbuf);
228	retval = 0;	228	retval = 0;
229	break;	229	break;
230	case FB_GET_CSIZE:	230	case FB_GET_CSIZE:
231	ipc_answer_fast(callid, 0, scr_height, scr_width);	231	ipc_answer_fast(callid, 0, scr_height, scr_width);
232	continue;	232	continue;
233	case FB_CLEAR:	233	case FB_CLEAR:
234	clrscr();	234	clrscr();
235	retval = 0;	235	retval = 0;
236	break;	236	break;
237	case FB_PUTCHAR:	237	case FB_PUTCHAR:
238	c = IPC_GET_ARG1(call);	238	c = IPC_GET_ARG1(call);
239	row = IPC_GET_ARG2(call);	239	row = IPC_GET_ARG2(call);
240	col = IPC_GET_ARG3(call);	240	col = IPC_GET_ARG3(call);
241	if (col >= scr_width \|\| row >= scr_height) {	241	if (col >= scr_width \|\| row >= scr_height) {
242	retval = EINVAL;	242	retval = EINVAL;
243	break;	243	break;
244	}	244	}
245	printchar(c, row, col);	245	printchar(c, row, col);
246	retval = 0;	246	retval = 0;
247	break;	247	break;
248	case FB_CURSOR_GOTO:	248	case FB_CURSOR_GOTO:
249	row = IPC_GET_ARG1(call);	249	row = IPC_GET_ARG1(call);
250	col = IPC_GET_ARG2(call);	250	col = IPC_GET_ARG2(call);
251	if (row >= scr_height \|\| col >= scr_width) {	251	if (row >= scr_height \|\| col >= scr_width) {
252	retval = EINVAL;	252	retval = EINVAL;
253	break;	253	break;
254	}	254	}
255	cursor_goto(row, col);	255	cursor_goto(row, col);
256	retval = 0;	256	retval = 0;
257	break;	257	break;
258	case FB_SCROLL:	258	case FB_SCROLL:
259	i = IPC_GET_ARG1(call);	259	i = IPC_GET_ARG1(call);
260	if (i > scr_height \|\| i < -((int) scr_height)) {	260	if (i > scr_height \|\| i < -((int) scr_height)) {
261	retval = EINVAL;	261	retval = EINVAL;
262	break;	262	break;
263	}	263	}
264	scroll(i);	264	scroll(i);
265	retval = 0;	265	retval = 0;
266	break;	266	break;
267	case FB_CURSOR_VISIBILITY:	267	case FB_CURSOR_VISIBILITY:
268	if(IPC_GET_ARG1(call))	268	if(IPC_GET_ARG1(call))
269	cursor_enable();	269	cursor_enable();
270	else	270	else
271	cursor_disable();	271	cursor_disable();
272	retval = 0;	272	retval = 0;
273	break;	273	break;
274	case FB_SET_STYLE:	274	case FB_SET_STYLE:
275	fgcolor = IPC_GET_ARG1(call);	275	fgcolor = IPC_GET_ARG1(call);
276	bgcolor = IPC_GET_ARG2(call);	276	bgcolor = IPC_GET_ARG2(call);
277	style = EGA_STYLE(fgcolor, bgcolor);	277	style = EGA_STYLE(fgcolor, bgcolor);
278	retval = 0;	278	retval = 0;
279	break;	279	break;
280	case FB_VP_DRAW_PIXMAP:	280	case FB_VP_DRAW_PIXMAP:
281	i = IPC_GET_ARG2(call);	281	i = IPC_GET_ARG2(call);
282	retval = print_screen(i);	282	retval = print_screen(i);
283	break;	283	break;
284	case FB_VP2PIXMAP:	284	case FB_VP2PIXMAP:
285	retval = save_screen();	285	retval = save_screen();
286	break;	286	break;
287	case FB_DROP_PIXMAP:	287	case FB_DROP_PIXMAP:
288	i = IPC_GET_ARG1(call);	288	i = IPC_GET_ARG1(call);
289	if (i >= MAX_SAVED_SCREENS) {	289	if (i >= MAX_SAVED_SCREENS) {
290	retval = EINVAL;	290	retval = EINVAL;
291	break;	291	break;
292	}	292	}
293	if (saved_screens[i].data) {	293	if (saved_screens[i].data) {
294	free(saved_screens[i].data);	294	free(saved_screens[i].data);
295	saved_screens[i].data = NULL;	295	saved_screens[i].data = NULL;
296	}	296	}
297	retval = 0;	297	retval = 0;
298	break;	298	break;
299		299
300	default:	300	default:
301	retval = ENOENT;	301	retval = ENOENT;
302	}	302	}
303	ipc_answer_fast(callid, retval, 0, 0);	303	ipc_answer_fast(callid, retval, 0, 0);
304	}	304	}
305	}	305	}
306		306
307	int ega_init(void)	307	int ega_init(void)
308	{	308	{
309	void *ega_ph_addr;	309	void *ega_ph_addr;
310	size_t sz;	310	size_t sz;
311		311
312	ega_ph_addr = (void *) sysinfo_value("fb.address.physical");	312	ega_ph_addr = (void *) sysinfo_value("fb.address.physical");
313	scr_width = sysinfo_value("fb.width");	313	scr_width = sysinfo_value("fb.width");
314	scr_height = sysinfo_value("fb.height");	314	scr_height = sysinfo_value("fb.height");
315	iospace_enable(task_get_id(), (void *) EGA_IO_ADDRESS, 2);	315	iospace_enable(task_get_id(), (void *) EGA_IO_ADDRESS, 2);
316		316
317	sz = scr_width * scr_height * 2;	317	sz = scr_width * scr_height * 2;
318	scr_addr = as_get_mappable_page(sz, (int)	318	scr_addr = as_get_mappable_page(sz, (int)
319	sysinfo_value("fb.address.color"));	319	sysinfo_value("fb.address.color"));
320		320
321	physmem_map(ega_ph_addr, scr_addr, ALIGN_UP(sz, PAGE_SIZE) >>	321	physmem_map(ega_ph_addr, scr_addr, ALIGN_UP(sz, PAGE_SIZE) >>
322	PAGE_WIDTH, AS_AREA_READ \| AS_AREA_WRITE);	322	PAGE_WIDTH, AS_AREA_READ \| AS_AREA_WRITE);
323		323
324	async_set_client_connection(ega_client_connection);	324	async_set_client_connection(ega_client_connection);
325		325
326	return 0;	326	return 0;
327	}	327	}
328		328
329		329
330	/**	330	/**
331	* @}	331	* @}
332	*/	332	*/
333		333

Subversion Repositories HelenOS

(root)/trunk/uspace/fb/ega.c – Rev 2025 → 2071