src/console/vga_console.c

   1 /*
   2  *
   3  * modified from original freebios code
   4  * by Steve M. Gehlbach <steve@kesa.com>
   5  *
   6  */
   7
   8 #include <arch/io.h>
   9 #include <string.h>
  10 #include <pc80/vga.h>
  11 #include <console/console.h>
  12
  13 /* The video buffer, should be replaced by symbol in ldscript.ld */
  14 static char *vidmem;
  15
  16 int vga_line, vga_col;
  17
  18 int vga_inited = 0; // it will be changed in pci_rom.c
  19
  20 static int vga_console_inited = 0;
  21
  22 #define VIDBUFFER 0xB8000;
  23
  24 static void memsetw(void *s, int c, unsigned int n)
  25 {
  26         int i;
  27          u16 *ss = (u16 *) s;
  28
  29         for (i = 0; i < n; i++) {
  30                 ss[i] = ( u16 ) c;
  31         }
  32 }
  33
  34 static void vga_init(void)
  35 {
  36         // these are globals
  37         vga_line = 0;
  38         vga_col = 0;
  39         vidmem = (char *) VIDBUFFER;
  40
  41         // mainboard or chip specific init routines
  42         // also loads font
  43         vga_hardware_fixup();
  44
  45         // set attributes, char for entire screen
  46         // font should be previously loaded in
  47         // device specific code (vga_hardware_fixup)
  48          memsetw(vidmem, VGA_ATTR_CLR_WHT, 2*1024); //
  49 }
  50
  51 static void vga_scroll(void)
  52 {
  53         int i;
  54
  55         memcpy(vidmem, vidmem + COLS * 2, (LINES - 1) * COLS * 2);
  56         for (i = (LINES - 1) * COLS * 2; i < LINES * COLS * 2; i += 2)
  57                 vidmem[i] = ' ';
  58 }
  59
  60 static void vga_tx_byte(unsigned char byte)
  61 {
  62         if (!vga_inited) {
  63                 return;
  64         }
  65
  66         if(!vga_console_inited) {
  67                 vga_init();
  68                 vga_console_inited = 1;
  69         }
  70
  71         if (byte == '\n') {
  72                 vga_line++;
  73                 vga_col = 0;
  74
  75         } else if (byte == '\r') {
  76                 vga_col = 0;
  77
  78         } else if (byte == '\b') {
  79                 vga_col--;
  80
  81         } else if (byte == '\t') {
  82                 vga_col += 4;
  83
  84         } else if (byte == '\a') {
  85                 //beep
  86 //              beep(500);
  87                 ;
  88         } else {
  89                 vidmem[((vga_col + (vga_line *COLS)) * 2)] = byte;
  90                 vidmem[((vga_col + (vga_line *COLS)) * 2) +1] = VGA_ATTR_CLR_WHT;
  91                 vga_col++;
  92         }
  93         if (vga_col < 0) {
  94                 vga_col = 0;
  95         }
  96         if (vga_col >= COLS) {
  97                 vga_line++;
  98                 vga_col = 0;
  99         }
 100         if (vga_line >= LINES) {
 101                 vga_scroll();
 102                 vga_line--;
 103         }
 104         // move the cursor
 105         write_crtc((vga_col + (vga_line *COLS)) >> 8, CRTC_CURSOR_HI);
 106         write_crtc((vga_col + (vga_line *COLS)) & 0x0ff, CRTC_CURSOR_LO);
 107 }
 108
 109 static const struct console_driver vga_console __console ={
 110         .init    = 0,
 111         .tx_byte = vga_tx_byte,
 112         .rx_byte = 0,
 113         .tst_byte = 0,
 114 };