![[BACK]](/cvsweb/icons/back.gif){kind=icon}
Return to console_common.c CVS log ![[TXT]](/cvsweb/icons/text.gif){kind=icon}
![[DIR]](/cvsweb/icons/dir.gif){kind=icon}
Up to [Qemu by Fabrice Bellard] / qemu / roms / openbios / libopenbios|
Return to console_common.c CVS log | Up to [Qemu by Fabrice Bellard] / qemu / roms / openbios / libopenbios |
1.1 root 1: /*
2: * <console.c>
3: *
4: * Simple text console
5: *
6: * Copyright (C) 2002, 2003 Samuel Rydh ([email protected])
7: * Copyright (C) 2005 Stefan Reinauer <[email protected]>
8: *
9: * This program is free software; you can redistribute it and/or
10: * modify it under the terms of the GNU General Public License
11: * as published by the Free Software Foundation
12: *
13: */
14:
15: #include "config.h"
16: #include "libopenbios/bindings.h"
17: #include "libopenbios/fontdata.h"
18: #include "libopenbios/console.h"
19: #include "packages/video.h"
20:
21: #define FONT_ADJ_HEIGHT (FONT_HEIGHT + 2)
22:
23: // Warning: will hang on purpose when encountering unknown codes
24: //#define DEBUG_CONSOLE
25: #ifdef DEBUG_CONSOLE
26: #define DPRINTF(fmt, args...) \
27: do { \
28: printk(fmt , ##args); \
29: for (;;); \
30: } while (0)
31: #else
32: #define DPRINTF(fmt, args...) do {} while(0)
33: #endif
34:
35: typedef enum {
36: ESnormal, ESesc, ESsquare, ESgetpars, ESgotpars, ESfunckey,
37: EShash, ESsetG0, ESsetG1, ESpercent, ESignore, ESnonstd,
38: ESpalette
39: } vc_state_t;
40:
41: #define NPAR 16
42: static struct {
43: int inited;
44: int physw, physh;
45: int w,h;
46:
47: int x,y;
48: char *buf;
49:
50: int cursor_on;
51: vc_state_t vc_state;
52: unsigned int vc_npar,vc_par[NPAR]; /* Parameters of current
53: escape sequence */
54: } cons;
55:
56: static int
57: get_conschar( int x, int y )
58: {
59: if( (unsigned int)x < cons.w && (unsigned int)y < cons.h )
60: return cons.buf[y*cons.w + x];
61: return ' ';
62: }
63:
64: static void
65: draw_char( unsigned int h, unsigned int v )
66: {
67: const unsigned char *c = fontdata;
68: int x, y, xx, rskip, m;
69: int invert = (h==cons.x && v==cons.y && cons.cursor_on);
70: int ch = get_conschar( h, v );
71:
72: while( h >= cons.w || v >= cons.h )
73: return;
74:
75: h *= FONT_WIDTH;
76: v *= FONT_ADJ_HEIGHT;
77:
78: rskip = (FONT_WIDTH > 8)? 2 : 1;
79: c += rskip * (unsigned int)(ch & 0xff) * FONT_HEIGHT;
80:
81: for( x=0; x<FONT_WIDTH; x++ ) {
82: xx = x % 8;
83: if( x && !xx )
84: c++;
85: m = (1<<(7-xx));
86: for( y=0; y<FONT_HEIGHT; y++ ){
87: int col = ((!(c[rskip*y] & m)) != invert) ? 254 : 0;
88: draw_pixel( h+x, v+y+1, col );
89: }
90: draw_pixel( h+x, v, 254 );
91: draw_pixel( h+x, v+FONT_HEIGHT+1, 254 );
92: }
93: }
94:
95: static void
96: show_cursor( int show )
97: {
98: if( cons.cursor_on == show )
99: return;
100: cons.cursor_on = show;
101: draw_char( cons.x, cons.y );
102: }
103:
104:
105: static void
106: draw_line( int n )
107: {
108: int i;
109:
110: if( n >= cons.h || n < 0 )
111: return;
112: for( i=0; i<cons.w; i++ )
113: draw_char( i, n );
114: }
115:
116: #if 0
117: static void
118: refresh( void )
119: {
120: int i;
121: for( i=0; i<cons.h; i++ )
122: draw_line(i);
123: }
124: #endif
125:
126: int
127: console_init( void )
128: {
129: if( video_get_res(&cons.physw,&cons.physh) < 0 )
130: return -1;
131:
132: set_color( 0, 0 );
133:
134: cons.w = cons.physw/FONT_WIDTH;
135: cons.h = cons.physh/FONT_ADJ_HEIGHT;
136: cons.buf = malloc( cons.w * cons.h );
137: cons.inited = 1;
138: cons.x = cons.y = 0;
139: cons.vc_state = ESnormal;
140: return 0;
141: }
142:
143: void
144: console_close( void )
145: {
146: if( !cons.inited )
147: return;
148: free( cons.buf );
149: cons.inited = 0;
150: }
151:
152: static void
153: rec_char( int ch, int x, int y )
154: {
155: if( (unsigned int)x < cons.w && (unsigned int)y < cons.h ) {
156: cons.buf[y*cons.w + x] = ch;
157: draw_char( x, y );
158: }
159: }
160:
161: static void
162: scroll1( void )
163: {
164: int x, y;
165:
166: video_scroll(FONT_ADJ_HEIGHT);
167:
168: for (y = 1; y < cons.h - 1; y++) {
169: for (x = 0; x < cons.w; x++)
170: cons.buf[(y - 1) * cons.w + x] = cons.buf[y * cons.w + x];
171: }
172: for (x = 0; x < cons.w; x++)
173: cons.buf[(cons.h - 1) * cons.w + x] = ' ';
174: draw_line(cons.h - 1);
175: }
176:
177: // Insert char
178: static void csi_at(unsigned int nr)
179: {
180: unsigned int x;
181:
182: if (nr > cons.w - cons.x)
183: nr = cons.w - cons.x;
184: else if (!nr)
185: return;
186:
187: for (x = cons.x + nr; x < cons.w - 1; x++)
188: cons.buf[cons.y * cons.w + x - nr] = cons.buf[cons.y * cons.w + x];
189: for (x = cons.x; x < cons.x + nr; x++)
190: cons.buf[cons.y * cons.w + x] = ' ';
191: draw_line(cons.y);
192: }
193:
194: static void
195: do_con_trol(unsigned char ch)
196: {
197: unsigned int i, j;
198:
199: switch (ch) {
200: case 7:
201: // BEL
202: return;
203: case 8:
204: // BS
205: if (cons.x)
206: cons.x--;
207: return;
208: case 9:
209: // HT
210: cons.x = (cons.x + 8) & ~7;
211: return;
212: case 10:
213: // LF
214: cons.x = 0;
215: cons.y++;
216: return;
217: case 12:
218: // FF
219: for (i = 0; i < cons.h; i++) {
220: for (j = 0; j < cons.w; j++)
221: cons.buf[i * cons.w + j] = ' ';
222: draw_line(i);
223: }
224: cons.x = cons.y = 0;
225: return;
226: case 13:
227: // CR
228: cons.x = 0;
229: return;
230: case 25:
231: // EM
232: return;
233: case 24: // CAN
234: case 26: // SUB
235: cons.vc_state = ESnormal;
236: return;
237: case 27:
238: // ESC
239: cons.vc_state = ESesc;
240: return;
241: }
242: if (ch < 32)
243: DPRINTF("Unhandled control char %d\n", ch);
244:
245: switch (cons.vc_state) {
246: case ESesc:
247: cons.vc_state = ESnormal;
248: switch (ch) {
249: case '[':
250: cons.vc_state = ESsquare;
251: return;
252: case 'M':
253: scroll1();
254: return;
255: default:
256: DPRINTF("Unhandled basic escape code '%c'\n", ch);
257: return;
258: }
259: return;
260: case ESsquare:
261: for(cons.vc_npar = 0; cons.vc_npar < NPAR ; cons.vc_npar++)
262: cons.vc_par[cons.vc_npar] = 0;
263: cons.vc_npar = 0;
264: cons.vc_state = ESgetpars;
265: // Fall through
266: case ESgetpars:
267: if (ch == ';' && cons.vc_npar < NPAR - 1) {
268: cons.vc_npar++;
269: return;
270: } else if (ch >= '0' && ch <= '9') {
271: cons.vc_par[cons.vc_npar] *= 10;
272: cons.vc_par[cons.vc_npar] += ch - '0';
273: return;
274: } else
275: cons.vc_state=ESgotpars;
276: // Fall through
277: case ESgotpars:
278: cons.vc_state = ESnormal;
279: switch(ch) {
280: case 'A':
281: // Cursor up
282: if (cons.vc_par[0] == 0)
283: cons.vc_par[0] = 1;
284: if (cons.y - cons.vc_par[0] > 0)
285: cons.y -= cons.vc_par[0];
286: return;
287: case 'B':
288: // Cursor down
289: if (cons.vc_par[0] == 0)
290: cons.vc_par[0] = 1;
291: if (cons.y + cons.vc_par[0] < cons.h - 1)
292: cons.y += cons.vc_par[0];
293: return;
294: case 'C':
295: // Cursor right
296: if (cons.vc_par[0] == 0)
297: cons.vc_par[0] = 1;
298: if (cons.x + cons.vc_par[0] < cons.w - 1)
299: cons.x += cons.vc_par[0];
300: return;
301: case 'D':
302: // Cursor left
303: if (cons.vc_par[0] == 0)
304: cons.vc_par[0] = 1;
305: if (cons.x - cons.vc_par[0] > 0)
306: cons.x -= cons.vc_par[0];
307: return;
308: case 'H':
309: case 'f':
310: // Set cursor position
311: if (cons.vc_par[0])
312: cons.vc_par[0]--;
313:
314: if (cons.vc_par[1])
315: cons.vc_par[1]--;
316:
317: cons.x = cons.vc_par[1];
318: cons.y = cons.vc_par[0];
319: return;
320: case 'J':
321: if (cons.vc_par[0] == 0 && (unsigned int)cons.y < (unsigned int)cons.h &&
322: (unsigned int)cons.x < (unsigned int)cons.w) {
323: // erase from cursor to end of display
324: for (i = cons.x; i < cons.w; i++)
325: cons.buf[cons.y * cons.w + i] = ' ';
326: draw_line(cons.y);
327: for (j = cons.y + 1; j < cons.h; j++) {
328: for (i = 0; i < cons.w; i++)
329: cons.buf[j * cons.w + i] = ' ';
330: draw_line(j);
331: }
332: } else {
333: DPRINTF("Unhandled CSI J code '%c'\n", cons.vc_par[0]);
334: }
335: return;
336: case 'K':
337: switch (cons.vc_par[0]) {
338: case 0: /* erase from cursor to end of line */
339: for (i = cons.x; i < cons.w; i++)
340: cons.buf[cons.y * cons.w + i] = ' ';
341: draw_line(cons.y);
342: return;
343: case 1: /* erase from start of line to cursor */
344: for (i = 0; i <= cons.x; i++)
345: cons.buf[cons.y * cons.w + i] = ' ';
346: draw_line(cons.y);
347: return;
348: case 2: /* erase whole line */
349: for (i = 0; i < cons.w; i++)
350: cons.buf[cons.y * cons.w + i] = ' ';
351: draw_line(cons.y);
352: return;
353: default:
354: DPRINTF("Unhandled CSI K code '%c'\n", cons.vc_par[0]);
355: return;
356: }
357: return;
358: case 'M':
359: if (cons.vc_par[0] == 1)
360: scroll1();
361: else
362: DPRINTF("Unhandled CSI M %d\n", cons.vc_par[0]);
363: return;
364: case 'm':
365: // Attributes are ignored
366: return;
367: case '@':
368: csi_at(cons.vc_par[0]);
369: return;
370: default:
371: DPRINTF("Unhandled escape code '%c', par[%d, %d, %d, %d, %d]\n",
372: ch, cons.vc_par[0], cons.vc_par[1], cons.vc_par[2],
373: cons.vc_par[3], cons.vc_par[4]);
374: return;
375: }
376: return;
377: default:
378: cons.vc_state = ESnormal;
379: rec_char(ch, cons.x++, cons.y);
380: return;
381: }
382: }
383:
384: int
385: console_draw_fstr(const char *str, int len)
386: {
387: unsigned int y, x;
388: unsigned char ch;
389:
390: if (!str || len <= 0) {
391: return 0;
392: }
393:
394: if( !cons.inited && console_init() )
395: return -1;
396:
397: show_cursor(0);
398: while((ch = *str++) && len--) {
399: do_con_trol(ch);
400:
401: if( cons.x >= cons.w ) {
402: cons.x=0, cons.y++;
403: }
404: if( cons.y >= cons.h ) {
405: for( y=0; y<cons.h-1; y++ )
406: for( x=0; x<cons.w; x++ )
407: cons.buf[y*cons.w + x] = cons.buf[(y+1)*cons.w + x];
408: cons.y = cons.h-1;
409: cons.x = 0;
410: scroll1();
411: }
412: }
413: show_cursor(1);
414: return 0;
415: }
This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.