Subversion Repositories or1k

#include "common.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++) {

      if (t & 1)

        PUT_PIXEL(x + j, y + i, fg_color);

      else

        PUT_PIXEL(x + j, y + i, bg_color);

       t >>= 1;

    }

  }

}

static void scroll (void) {

  int x,y;

  for (y = 1; y < CHARSY; y++)

    for (x = 0; x < CHARSX; x++)

      put_char_xy (x, y-1, screen[y][x]);

  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;

  default:

    cx++;

    if(cx >= CHARSX) screen_putc ('\n');

    put_char_xy(cx, cy, c);

    break;

  }

}

void screen_clear () {

  int x, y;

  for (y = 0; y < CHARSY; y++)

    for (x = 0; x < CHARSX; x++)

      put_char_xy (x, y, ' ');

  cx = cy = 0;

}

void screen_puts (char *s) {

  while (*s) {

    screen_putc (*s);

    s++;

  }

}

void screen_init () {

  SET_PALLETE(COLOR_BLACK, 0, 0, 0);

  SET_PALLETE(COLOR_WHITE, 255, 255, 255);

  /* Set screen offset */

  *((unsigned long *)CRT_BUFFER_REG) = FB_BASE_ADD;

  /* Turn screen on */

  *((unsigned long *)CRT_REG) = 0x00000001;

}

#endif /* CRT_ENABLED */