netwatch/vga-overlay.c

   1 #include <io.h>
   2 #include <smram.h>
   3 #include <video_defines.h>
   4 #include <minilib.h>
   5 #include <stdarg.h>
   6 #include <output.h>
   7 #include <serial.h>
   8
   9 #define LOGLEN 96
  10 #define LOG_ONSCREEN 4
  11
  12 static char logents[LOGLEN][41] = {{0}};
  13 static int prodptr = 0;
  14 static int flush_imm = 0;
  15
  16 #define VRAM_BASE               0xA0000UL
  17 #define TEXT_CONSOLE_OFFSET     0x18000UL
  18
  19 #define TEXT_CONSOLE_BASE       (VRAM_BASE + TEXT_CONSOLE_OFFSET)
  20
  21 #define COLOR                   0x1F
  22
  23 void vga_flush_imm(int imm)
  24 {
  25         flush_imm = imm;
  26 }
  27
  28 static unsigned char vga_read(unsigned char idx)
  29 {
  30         outb(CRTC_IDX_REG, idx);
  31         return inb(CRTC_DATA_REG);
  32 }
  33
  34 static char * vga_base()
  35 {
  36         return (char *) (
  37                 TEXT_CONSOLE_BASE
  38                 + (((unsigned int) vga_read(CRTC_START_ADDR_MSB_IDX)) << 9)
  39                 + (((unsigned int) vga_read(CRTC_START_ADDR_LSB_IDX)) << 1)
  40         );
  41 }
  42
  43 void strblit(char *src, int row, int col, int fill)
  44 {
  45         char *destp = vga_base() + row * 80 * 2 + col * 2;
  46         outb(0x80, 0x3C);
  47         smram_state_t old_state = smram_save_state();
  48         outb(0x80, 0x3D);
  49
  50         smram_aseg_set_state(SMRAM_ASEG_SMMCODE);
  51         outb(0x80, 0x3E);
  52
  53         while (*src)
  54         {
  55                 *(destp++) = *(src++);
  56                 *(destp++) = COLOR;
  57                 col++;
  58         }
  59         if (fill)
  60                 while (col < 80)
  61                 {
  62                         *(destp++) = ' ';
  63                         *(destp++) = COLOR;
  64                         col++;
  65                 }
  66
  67         outb(0x80, 0x3F);
  68         smram_restore_state(old_state);
  69         outb(0x80, 0x40);
  70 }
  71
  72 void outlog()
  73 {
  74         int y;
  75
  76         for (y = -LOG_ONSCREEN; y < 0; y++)
  77                 strblit(logents[(y + prodptr + LOGLEN) % LOGLEN], y + LOG_ONSCREEN, 40, 1);
  78 }
  79
  80 void dolog(const char *s)
  81 {
  82         strcpy(logents[prodptr], s);
  83         prodptr = (prodptr + 1) % LOGLEN;
  84         while (*s)
  85                 serial_tx(*(s++));
  86         serial_tx('\r');
  87         serial_tx('\n');
  88         if (flush_imm)
  89                 outlog();
  90 }
  91 void (*output)(const char *s) = dolog;
  92
  93 void dologf(const char *fmt, ...)
  94 {
  95         char *s;
  96         va_list va;
  97
  98         va_start(va, fmt);
  99         vsnprintf(logents[prodptr], 40, fmt, va);
 100         s = logents[prodptr];
 101         while (*s)
 102                 serial_tx(*(s++));
 103         serial_tx('\r');
 104         serial_tx('\n');
 105         va_end(va);
 106         prodptr = (prodptr + 1) % LOGLEN;
 107         if (flush_imm)
 108                 outlog();
 109 }
 110 void (*outputf)(const char *s, ...) = dologf;
 111
 112 void dump_log (char * target) {
 113         memcpy(target, logents, sizeof(logents));
 114 }