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 */