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 2015	Rev 2025
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[(rowscr_width + col)2] = c;	142	scr_addr[(row * scr_width + col) * 2] = c;
143	scr_addr[(rowscr_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, data[i].style.bg_color);	154	scr_addr[i * 2 + 1] = EGA_STYLE(data[i].style.fg_color,
-		155	data[i].style.bg_color);
155	}	156	}
156	}	157	}
157		158
158	static int save_screen(void)	159	static int save_screen(void)
159	{	160	{
160	int i;	161	int i;
161		162
162	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++)
163	;	164	;
164	if (i == MAX_SAVED_SCREENS)	165	if (i == MAX_SAVED_SCREENS)
165	return EINVAL;	166	return EINVAL;
166	if (!(saved_screens[i].data=malloc( 2 * scr_width*scr_height )))	167	if (!(saved_screens[i].data = malloc(2 * scr_width * scr_height)))
167	return ENOMEM;	168	return ENOMEM;
168	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);
169		170
170	return i;	171	return i;
171	}	172	}
172		173
173	static int print_screen(int i)	174	static int print_screen(int i)
174	{	175	{
175	if (saved_screens[i].data)	176	if (saved_screens[i].data)
176	memcpy(scr_addr, saved_screens[i].data, 2 * scr_width * scr_height);	177	memcpy(scr_addr, saved_screens[i].data, 2 * scr_width *
-		178	scr_height);
-		179	else
177	else return EINVAL;	180	return EINVAL;
178	return i;	181	return i;
179	}	182	}
180		183
181		184
182	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)
183	{	186	{
184	int retval;	187	int retval;
185	ipc_callid_t callid;	188	ipc_callid_t callid;
186	ipc_call_t call;	189	ipc_call_t call;
187	char c;	190	char c;
188	unsigned int row, col;	191	unsigned int row, col;
189	int bgcolor,fgcolor;	192	int bgcolor,fgcolor;
190	keyfield_t *interbuf = NULL;	193	keyfield_t *interbuf = NULL;
191	size_t intersize = 0;	194	size_t intersize = 0;
192	int i;	195	int i;
193		196
194	if (client_connected) {	197	if (client_connected) {
195	ipc_answer_fast(iid, ELIMIT, 0,0);	198	ipc_answer_fast(iid, ELIMIT, 0,0);
196	return;	199	return;
197	}	200	}
198	client_connected = 1;	201	client_connected = 1;
199	ipc_answer_fast(iid, 0, 0, 0); /* Accept connection */	202	ipc_answer_fast(iid, 0, 0, 0); /* Accept connection */
200		203
201	while (1) {	204	while (1) {
202	callid = async_get_call(&call);	205	callid = async_get_call(&call);
203	switch (IPC_GET_METHOD(call)) {	206	switch (IPC_GET_METHOD(call)) {
204	case IPC_M_PHONE_HUNGUP:	207	case IPC_M_PHONE_HUNGUP:
205	client_connected = 0;	208	client_connected = 0;
206	ipc_answer_fast(callid,0,0,0);	209	ipc_answer_fast(callid, 0, 0, 0);
207	return; /* Exit thread */	210	return; /* Exit thread */
208	case IPC_M_AS_AREA_SEND:	211	case IPC_M_AS_AREA_SEND:
209	/* We accept one area for data interchange */	212	/* We accept one area for data interchange */
210	intersize = IPC_GET_ARG2(call);	213	intersize = IPC_GET_ARG2(call);
211	if (intersize >= scr_widthscr_heightsizeof(*interbuf)) {	214	if (intersize >= scr_width * scr_height *
-		215	sizeof(*interbuf)) {
212	receive_comm_area(callid,&call,(void *)&interbuf);	216	receive_comm_area(callid, &call, (void *)
-		217	&interbuf);
213	continue;	218	continue;
214	}	219	}
215	retval = EINVAL;	220	retval = EINVAL;
216	break;	221	break;
217	case FB_DRAW_TEXT_DATA:	222	case FB_DRAW_TEXT_DATA:
218	if (!interbuf) {	223	if (!interbuf) {
219	retval = EINVAL;	224	retval = EINVAL;
220	break;	225	break;
221	}	226	}
222	draw_text_data(interbuf);	227	draw_text_data(interbuf);
223	retval = 0;	228	retval = 0;
224	break;	229	break;
225	case FB_GET_CSIZE:	230	case FB_GET_CSIZE:
226	ipc_answer_fast(callid, 0, scr_height, scr_width);	231	ipc_answer_fast(callid, 0, scr_height, scr_width);
227	continue;	232	continue;
228	case FB_CLEAR:	233	case FB_CLEAR:
229	clrscr();	234	clrscr();
230	retval = 0;	235	retval = 0;
231	break;	236	break;
232	case FB_PUTCHAR:	237	case FB_PUTCHAR:
233	c = IPC_GET_ARG1(call);	238	c = IPC_GET_ARG1(call);
234	row = IPC_GET_ARG2(call);	239	row = IPC_GET_ARG2(call);
235	col = IPC_GET_ARG3(call);	240	col = IPC_GET_ARG3(call);
236	if (col >= scr_width \|\| row >= scr_height) {	241	if (col >= scr_width \|\| row >= scr_height) {
237	retval = EINVAL;	242	retval = EINVAL;
238	break;	243	break;
239	}	244	}
240	printchar(c,row,col);	245	printchar(c, row, col);
241	retval = 0;	246	retval = 0;
242	break;	247	break;
243	case FB_CURSOR_GOTO:	248	case FB_CURSOR_GOTO:
244	row = IPC_GET_ARG1(call);	249	row = IPC_GET_ARG1(call);
245	col = IPC_GET_ARG2(call);	250	col = IPC_GET_ARG2(call);
246	if (row >= scr_height \|\| col >= scr_width) {	251	if (row >= scr_height \|\| col >= scr_width) {
247	retval = EINVAL;	252	retval = EINVAL;
248	break;	253	break;
249	}	254	}
250	cursor_goto(row,col);	255	cursor_goto(row, col);
251	retval = 0;	256	retval = 0;
252	break;	257	break;
253	case FB_SCROLL:	258	case FB_SCROLL:
254	i = IPC_GET_ARG1(call);	259	i = IPC_GET_ARG1(call);
255	if (i > scr_height \|\| i < (- (int)scr_height)) {	260	if (i > scr_height \|\| i < -((int) scr_height)) {
256	retval = EINVAL;	261	retval = EINVAL;
257	break;	262	break;
258	}	263	}
259	scroll(i);	264	scroll(i);
260	retval = 0;	265	retval = 0;
261	break;	266	break;
262	case FB_CURSOR_VISIBILITY:	267	case FB_CURSOR_VISIBILITY:
263	if(IPC_GET_ARG1(call))	268	if(IPC_GET_ARG1(call))
264	cursor_enable();	269	cursor_enable();
265	else	270	else
266	cursor_disable();	271	cursor_disable();
267	retval = 0;	272	retval = 0;
268	break;	273	break;
269	case FB_SET_STYLE:	274	case FB_SET_STYLE:
270	fgcolor = IPC_GET_ARG1(call);	275	fgcolor = IPC_GET_ARG1(call);
271	bgcolor = IPC_GET_ARG2(call);	276	bgcolor = IPC_GET_ARG2(call);
272	style = EGA_STYLE(fgcolor, bgcolor);	277	style = EGA_STYLE(fgcolor, bgcolor);
273	retval = 0;	278	retval = 0;
274	break;	279	break;
275	case FB_VP_DRAW_PIXMAP:	280	case FB_VP_DRAW_PIXMAP:
276	i = IPC_GET_ARG2(call);	281	i = IPC_GET_ARG2(call);
277	retval = print_screen(i);	282	retval = print_screen(i);
278	break;	283	break;
279	case FB_VP2PIXMAP:	284	case FB_VP2PIXMAP:
280	retval = save_screen();	285	retval = save_screen();
281	break;	286	break;
282	case FB_DROP_PIXMAP:	287	case FB_DROP_PIXMAP:
283	i = IPC_GET_ARG1(call);	288	i = IPC_GET_ARG1(call);
284	if (i >= MAX_SAVED_SCREENS) {	289	if (i >= MAX_SAVED_SCREENS) {
285	retval = EINVAL;	290	retval = EINVAL;
286	break;	291	break;
287	}	292	}
288	if (saved_screens[i].data) {	293	if (saved_screens[i].data) {
289	free(saved_screens[i].data);	294	free(saved_screens[i].data);
290	saved_screens[i].data = NULL;	295	saved_screens[i].data = NULL;
291	}	296	}
292	retval = 0;	297	retval = 0;
293	break;	298	break;
294		299
295	default:	300	default:
296	retval = ENOENT;	301	retval = ENOENT;
297	}	302	}
298	ipc_answer_fast(callid,retval,0,0);	303	ipc_answer_fast(callid, retval, 0, 0);
299	}	304	}
300	}	305	}
301		306
302	int ega_init(void)	307	int ega_init(void)
303	{	308	{
304	void *ega_ph_addr;	309	void *ega_ph_addr;
305	size_t sz;	310	size_t sz;
306		311
307		-
308	ega_ph_addr=(void *)sysinfo_value("fb.address.physical");	312	ega_ph_addr = (void *) sysinfo_value("fb.address.physical");
309	scr_width=sysinfo_value("fb.width");	313	scr_width = sysinfo_value("fb.width");
310	scr_height=sysinfo_value("fb.height");	314	scr_height = sysinfo_value("fb.height");
311	iospace_enable(task_get_id(), (void *) EGA_IO_ADDRESS, 2);	315	iospace_enable(task_get_id(), (void *) EGA_IO_ADDRESS, 2);
312		316
313	sz = scr_width * scr_height * 2;	317	sz = scr_width * scr_height * 2;
314	scr_addr = as_get_mappable_page(sz, (int)	318	scr_addr = as_get_mappable_page(sz, (int)
315	sysinfo_value("fb.address.color"));	319	sysinfo_value("fb.address.color"));
316		320
317	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) >>
318	PAGE_WIDTH, AS_AREA_READ \| AS_AREA_WRITE);	322	PAGE_WIDTH, AS_AREA_READ \| AS_AREA_WRITE);
319		323
320	async_set_client_connection(ega_client_connection);	324	async_set_client_connection(ega_client_connection);
321		325
322	return 0;	326	return 0;
323	}	327	}
324		328
325		329
326	/**	330	/**
327	* @}	331	* @}
328	*/	332	*/
329		333

Subversion Repositories HelenOS

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