Subversion Repositories openrisc_2011-10-31

#include "common.h"
#include "support.h"
#include "screen.h"
 
#if CRT_ENABLED
unsigned long fg_color = COLOR_WHITE;
unsigned long bg_color = COLOR_BLACK;
int cx = 0;
int cy = 0;
 
extern unsigned char font[256][12];
static char screen[CHARSY][CHARSX];
 
void put_char_xy(int x, int y, char c)
{
	int i, j;
	screen[y][x] = c;
	x *= CHAR_WIDTH;
	y *= CHAR_HEIGHT;
	for (i = 0; i < CHAR_HEIGHT; i++) {
		int t = font[(unsigned char)c][i];
		for (j = 0; j < CHAR_WIDTH; j++) {
			PUT_PIXEL(x + j, y + i, (t & 1) ? fg_color : bg_color);
			t >>= 1;
		}
	}
}
 
static void scroll(void)
{
	int x, y;
#if 1
	for (y = 1; y < CHARSY; y++)
		for (x = 0; x < CHARSX; x++)
			put_char_xy(x, y - 1, screen[y][x]);
#else
	memcpy((unsigned char *)FB_BASE_ADDR,
	       ((unsigned char *)FB_BASE_ADDR) + RESX * CHAR_HEIGHT,
	       (RESY - CHAR_HEIGHT) * RESX);
	memcpy(&screen[0][0], &screen[1][0], (CHARSY - 1) * CHARSX);
#endif
	for (x = 0; x < CHARSX; x++)
		put_char_xy(x, CHARSY - 1, ' ');
	cy--;
}
 
void screen_putc(char c)
{
	int t;
	switch (c) {
	case '\n':
		cy++;
		cx = 0;
		if (cy >= CHARSY)
			scroll();
		break;
	case '\r':
		cx = 0;
		break;
	case '\t':
		for (t = 0; t < 8 - (cx & 7); t++)
			screen_putc(' ');
		break;
	case '\b':
		if (cx > 0)
			cx--;
		put_char_xy(cx, cy, ' ');
		break;
	default:
		put_char_xy(cx, cy, c);
		cx++;
		if (cx >= CHARSX)
			screen_putc('\n');
		break;
	}
}
 
void screen_clear()
{
	memset((unsigned char *)FB_BASE_ADDR, bg_color, RESX * RESY);
	memset(&screen[0][0], ' ', CHARSX * CHARSY);
	cx = cy = 0;
}
 
void screen_puts(char *s)
{
	while (*s) {
		screen_putc(*s);
		s++;
	}
}
 
void screen_init()
{
	screen_clear();
	SET_PALLETE(COLOR_BLACK, 0, 0, 0);
	SET_PALLETE(COLOR_WHITE, 127, 127, 127);
 
	/* Set screen offset */
	*((unsigned long *)CRT_BUFFER_REG) = FB_BASE_ADDR;
 
	/* Turn screen on */
	*((unsigned long *)CRT_REG) = 0x00000001;
}
 
#endif /* CRT_ENABLED */