WebSVN – HelenOS – Diff – /trunk/uspace/fb/ega.c



 
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)

    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:

            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;
 
        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"));

Rev 2015	Rev 2025
Line 80...	Line 80...
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)
Line 201...	Line 204...
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:
Line 235...	Line 240...
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;
Line 293...	Line 298...
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"));

Subversion Repositories HelenOS

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