]> Joshua Wise's Git repositories - netwatch.git/blob - aseg/vga-overlay.c
7aa8b412c517f73f68f5afeead935b98c5c588cb
[netwatch.git] / aseg / 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
8 static char logents[4][41] = {{0}};
9
10 #define VRAM_BASE               0xA0000UL
11 #define TEXT_CONSOLE_OFFSET     0x18000UL 
12
13 #define TEXT_CONSOLE_BASE       (VRAM_BASE + TEXT_CONSOLE_OFFSET)
14
15 #define COLOR                   0x1F
16
17 static unsigned char vga_read(unsigned char idx)
18 {
19         outb(CRTC_IDX_REG, idx);
20         return inb(CRTC_DATA_REG);
21 }
22
23 static char * vga_base()
24 {
25         return (char *) (
26                 TEXT_CONSOLE_BASE
27                 + (((unsigned int) vga_read(CRTC_START_ADDR_MSB_IDX)) << 9)
28                 + (((unsigned int) vga_read(CRTC_START_ADDR_LSB_IDX)) << 1)
29         );
30 }
31
32 void strblit(char *src, int row, int col)
33 {
34         char *destp = vga_base() + row * 80 * 2 + col * 2;
35         smram_state_t old_state = smram_save_state();
36
37         smram_aseg_set_state(SMRAM_ASEG_SMMCODE);
38
39         while (*src)
40         {
41                 *(destp++) = *(src++);
42                 *(destp++) = COLOR;
43         }
44
45         smram_restore_state(old_state);
46 }
47
48 void outlog()
49 {
50         int y, x;
51         char *basep = vga_base();
52
53         smram_state_t old_state = smram_save_state();
54
55         smram_aseg_set_state(SMRAM_ASEG_SMMCODE);
56
57         for (y = 0; y < 4; y++)
58                 for (x = 40; x < 80; x++)
59                 {
60                         basep[y*80*2+x*2] = ' ';
61                         basep[y*80*2+x*2+1] = 0x1F;
62                 }
63
64         smram_restore_state(old_state);
65         
66         for (y = 0; y < 4; y++)
67                 strblit(logents[y], y, 40);
68 }
69
70 void dolog(const char *s)
71 {
72         memmove(logents[0], logents[1], sizeof(logents[0])*3);
73         strcpy(logents[3], s);
74 }
75 void (*output)(const char *s) = dolog;
76
77 void dologf(const char *fmt, ...)
78 {
79         va_list va;
80         
81         memmove(logents[0], logents[1], sizeof(logents[0])*3);
82         va_start(va, fmt);
83         vsnprintf(logents[3], 40, fmt, va);
84         va_end(va);
85 }
86 void (*outputf)(const char *s, ...) = dologf;
87
88 void dump_log (char * target) {
89         memcpy(target, logents, sizeof(logents));
90 }
This page took 0.024281 seconds and 2 git commands to generate.