mirror of
https://gitlab.com/qemu-project/openbios.git
synced 2024-02-13 08:34:06 +08:00
320db5725b
git-svn-id: svn://coreboot.org/openbios/openbios-devel@135 f158a5a8-5612-0410-a976-696ce0be7e32
331 lines
7.0 KiB
C
331 lines
7.0 KiB
C
/*
|
|
* <console.c>
|
|
*
|
|
* Simple text console
|
|
*
|
|
* Copyright (C) 2002, 2003 Samuel Rydh (samuel@ibrium.se)
|
|
* Copyright (C) 2005 Stefan Reinauer <stepan@openbios.org>
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License
|
|
* as published by the Free Software Foundation
|
|
*
|
|
*/
|
|
|
|
#include "openbios/config.h"
|
|
#include "openbios/bindings.h"
|
|
|
|
#include "font_8x8.c"
|
|
|
|
#define FONT_ADJ_HEIGHT (FONT_HEIGHT + 2)
|
|
#define NCOLS 80
|
|
#define NROWS 48
|
|
|
|
typedef enum {
|
|
ESnormal, ESesc, ESsquare, ESgetpars, ESgotpars, ESfunckey,
|
|
EShash, ESsetG0, ESsetG1, ESpercent, ESignore, ESnonstd,
|
|
ESpalette
|
|
} vc_state_t;
|
|
|
|
#define NPAR 16
|
|
static struct {
|
|
int inited;
|
|
int physw, physh;
|
|
int w,h;
|
|
|
|
int x,y;
|
|
char *buf;
|
|
|
|
int cursor_on;
|
|
vc_state_t vc_state;
|
|
unsigned int vc_npar,vc_par[NPAR]; /* Parameters of current
|
|
escape sequence */
|
|
} cons;
|
|
|
|
static int
|
|
get_conschar( int x, int y )
|
|
{
|
|
if( (uint)x < cons.w && (uint)y < cons.h )
|
|
return cons.buf[y*cons.w + x];
|
|
return ' ';
|
|
}
|
|
|
|
static void
|
|
draw_char( uint h, uint v )
|
|
{
|
|
char *c = fontdata;
|
|
int x, y, xx, rskip, m;
|
|
int invert = (h==cons.x && v==cons.y && cons.cursor_on);
|
|
int ch = get_conschar( h, v );
|
|
|
|
while( h >= cons.w || v >= cons.h )
|
|
return;
|
|
|
|
h *= FONT_WIDTH;
|
|
v *= FONT_ADJ_HEIGHT;
|
|
|
|
rskip = (FONT_WIDTH > 8)? 2 : 1;
|
|
c += rskip * (unsigned int)(ch & 0xff) * FONT_HEIGHT;
|
|
|
|
for( x=0; x<FONT_WIDTH; x++ ) {
|
|
xx = x % 8;
|
|
if( x && !xx )
|
|
c++;
|
|
m = (1<<(7-xx));
|
|
for( y=0; y<FONT_HEIGHT; y++ ){
|
|
int col = ((!(c[rskip*y] & m)) != invert) ? 254 : 0;
|
|
draw_pixel( h+x, v+y+1, col );
|
|
}
|
|
draw_pixel( h+x, v, 254 );
|
|
draw_pixel( h+x, v+FONT_HEIGHT+1, 254 );
|
|
}
|
|
}
|
|
|
|
static void
|
|
show_cursor( int show )
|
|
{
|
|
if( cons.cursor_on == show )
|
|
return;
|
|
cons.cursor_on = show;
|
|
draw_char( cons.x, cons.y );
|
|
}
|
|
|
|
|
|
static void
|
|
draw_line( int n )
|
|
{
|
|
int i;
|
|
|
|
if( n >= cons.h || n < 0 )
|
|
return;
|
|
for( i=0; i<cons.w; i++ )
|
|
draw_char( i, n );
|
|
}
|
|
|
|
#if 0
|
|
static void
|
|
refresh( void )
|
|
{
|
|
int i;
|
|
for( i=0; i<cons.h; i++ )
|
|
draw_line(i);
|
|
}
|
|
#endif
|
|
|
|
static int
|
|
console_init( void )
|
|
{
|
|
if( video_get_res(&cons.physw,&cons.physh) < 0 )
|
|
return -1;
|
|
|
|
set_color( 0, 0 );
|
|
|
|
cons.w = cons.physw/FONT_WIDTH;
|
|
cons.h = cons.physh/FONT_ADJ_HEIGHT;
|
|
cons.buf = malloc( cons.w * cons.h );
|
|
cons.inited = 1;
|
|
cons.x = cons.y = 0;
|
|
cons.vc_state = ESnormal;
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
console_close( void )
|
|
{
|
|
if( !cons.inited )
|
|
return;
|
|
free( cons.buf );
|
|
cons.inited = 0;
|
|
}
|
|
|
|
static void
|
|
rec_char( int ch, int x, int y )
|
|
{
|
|
if( (uint)x < cons.w && (uint)y < cons.h ) {
|
|
cons.buf[y*cons.w + x] = ch;
|
|
draw_char( x, y );
|
|
}
|
|
}
|
|
|
|
static void
|
|
scroll1( void )
|
|
{
|
|
osi_fb_info_t fb;
|
|
int i, x, offs, size, *dest, *src;
|
|
|
|
openbios_GetFBInfo( &fb );
|
|
|
|
offs = fb.rb * FONT_ADJ_HEIGHT;
|
|
size = (fb.h * fb.rb - offs)/16;
|
|
dest = (int*)fb.mphys;
|
|
src = (int*)(fb.mphys + offs);
|
|
|
|
for( i=0; i<size; i++ ) {
|
|
dest[0] = src[0];
|
|
dest[1] = src[1];
|
|
dest[2] = src[2];
|
|
dest[3] = src[3];
|
|
dest += 4;
|
|
src += 4;
|
|
}
|
|
for( x=0; x<cons.w; x++ )
|
|
cons.buf[(cons.h-1)*cons.w + x] = 0;
|
|
draw_line(cons.h-1);
|
|
}
|
|
|
|
static void
|
|
do_con_trol(int ch)
|
|
{
|
|
unsigned int i, j;
|
|
|
|
switch (ch) {
|
|
case 8:
|
|
if (cons.x)
|
|
cons.x--;
|
|
return;
|
|
case 10 ... 12:
|
|
cons.x = 0;
|
|
cons.y++;
|
|
return;
|
|
case 13:
|
|
cons.x = 0;
|
|
return;
|
|
case 24:
|
|
case 26:
|
|
cons.vc_state = ESnormal;
|
|
return;
|
|
case 27:
|
|
cons.vc_state = ESesc;
|
|
return;
|
|
}
|
|
|
|
switch (cons.vc_state) {
|
|
case ESesc:
|
|
cons.vc_state = ESnormal;
|
|
switch (ch) {
|
|
case '[':
|
|
cons.vc_state = ESsquare;
|
|
return;
|
|
case 'M':
|
|
scroll1();
|
|
return;
|
|
default:
|
|
printk("Unhandled escape code '%c'\n", ch);
|
|
return;
|
|
}
|
|
return;
|
|
case ESsquare:
|
|
for(cons.vc_npar = 0; cons.vc_npar < NPAR ; cons.vc_npar++)
|
|
cons.vc_par[cons.vc_npar] = 0;
|
|
cons.vc_npar = 0;
|
|
cons.vc_state = ESgetpars;
|
|
// Fall through
|
|
case ESgetpars:
|
|
if (ch == ';' && cons.vc_npar < NPAR - 1) {
|
|
cons.vc_npar++;
|
|
return;
|
|
} else if (ch >= '0' && ch <= '9') {
|
|
cons.vc_par[cons.vc_npar] *= 10;
|
|
cons.vc_par[cons.vc_npar] += ch - '0';
|
|
return;
|
|
} else
|
|
cons.vc_state=ESgotpars;
|
|
// Fall through
|
|
case ESgotpars:
|
|
cons.vc_state = ESnormal;
|
|
switch(ch) {
|
|
case 'H':
|
|
case 'f':
|
|
if (cons.vc_par[0])
|
|
cons.vc_par[0]--;
|
|
|
|
if (cons.vc_par[1])
|
|
cons.vc_par[1]--;
|
|
|
|
cons.x = cons.vc_par[1];
|
|
cons.y = cons.vc_par[0];
|
|
return;
|
|
case 'J':
|
|
if (cons.vc_par[0] == 0 && (uint)cons.y < (uint)cons.h &&
|
|
(uint)cons.x < (uint)cons.w) {
|
|
// erase from cursor to end of display
|
|
for (i = cons.x; i < cons.w; i++)
|
|
cons.buf[cons.y * cons.w + i] = ' ';
|
|
draw_line(cons.y);
|
|
for (j = cons.y + 1; j < cons.h; j++) {
|
|
for (i = 0; i < cons.w; i++)
|
|
cons.buf[j * cons.w + i] = ' ';
|
|
draw_line(j);
|
|
}
|
|
}
|
|
return;
|
|
case 'K':
|
|
switch (cons.vc_par[0]) {
|
|
case 0: /* erase from cursor to end of line */
|
|
for (i = cons.x; i < cons.w; i++)
|
|
cons.buf[cons.y * cons.w + i] = ' ';
|
|
draw_line(cons.y);
|
|
return;
|
|
case 1: /* erase from start of line to cursor */
|
|
for (i = 0; i <= cons.x; i++)
|
|
cons.buf[cons.y * cons.w + i] = ' ';
|
|
draw_line(cons.y);
|
|
return;
|
|
case 2: /* erase whole line */
|
|
for (i = 0; i <= cons.w; i++)
|
|
cons.buf[cons.y * cons.w + i] = ' ';
|
|
draw_line(cons.y);
|
|
return;
|
|
default:
|
|
return;
|
|
}
|
|
return;
|
|
case 'M':
|
|
scroll1();
|
|
return;
|
|
case 'm':
|
|
return;
|
|
case '@':
|
|
return;
|
|
default:
|
|
printk("Unhandled escape code '%c', par[%d, %d, %d, %d, %d]\n",
|
|
ch, cons.vc_par[0], cons.vc_par[1], cons.vc_par[2],
|
|
cons.vc_par[3], cons.vc_par[4]);
|
|
return;
|
|
}
|
|
return;
|
|
default:
|
|
cons.vc_state = ESnormal;
|
|
rec_char(ch, cons.x++, cons.y);
|
|
return;
|
|
}
|
|
}
|
|
|
|
int
|
|
console_draw_str( const char *str )
|
|
{
|
|
int ch, y, x;
|
|
|
|
if( !cons.inited && console_init() )
|
|
return -1;
|
|
|
|
show_cursor(0);
|
|
while( (ch=*str++) ) {
|
|
do_con_trol(ch);
|
|
|
|
if( cons.x >= cons.w ) {
|
|
cons.x=0, cons.y++;
|
|
}
|
|
if( cons.y >= cons.h ) {
|
|
for( y=0; y<cons.h-1; y++ )
|
|
for( x=0; x<cons.w; x++ )
|
|
cons.buf[y*cons.w + x] = cons.buf[(y+1)*cons.w + x];
|
|
cons.y = cons.h-1;
|
|
cons.x = 0;
|
|
scroll1();
|
|
}
|
|
}
|
|
show_cursor(1);
|
|
return 0;
|
|
}
|