]>
Commit | Line | Data |
---|---|---|
1 | #include <io.h> | |
2 | #include <smram.h> | |
3 | #include <video_defines.h> | |
4 | #include <minilib.h> | |
5 | #include <stdarg.h> | |
6 | ||
7 | static char logents[4][41] = {{0}}; | |
8 | ||
9 | #define VRAM_BASE 0xA0000UL | |
10 | #define TEXT_CONSOLE_OFFSET 0x18000UL | |
11 | ||
12 | #define TEXT_CONSOLE_BASE (VRAM_BASE + TEXT_CONSOLE_OFFSET) | |
13 | ||
14 | #define COLOR 0x1F | |
15 | ||
16 | static unsigned char vga_read(unsigned char idx) | |
17 | { | |
18 | outb(CRTC_IDX_REG, idx); | |
19 | return inb(CRTC_DATA_REG); | |
20 | } | |
21 | ||
22 | static char * vga_base() | |
23 | { | |
24 | return (char *) ( | |
25 | TEXT_CONSOLE_BASE | |
26 | + (((unsigned int) vga_read(CRTC_START_ADDR_MSB_IDX)) << 9) | |
27 | + (((unsigned int) vga_read(CRTC_START_ADDR_LSB_IDX)) << 1) | |
28 | ); | |
29 | } | |
30 | ||
31 | void strblit(char *src, int row, int col) | |
32 | { | |
33 | char *destp = vga_base() + row * 80 * 2 + col * 2; | |
34 | smram_state_t old_state = smram_save_state(); | |
35 | ||
36 | smram_aseg_set_state(SMRAM_ASEG_SMMCODE); | |
37 | ||
38 | while (*src) | |
39 | { | |
40 | *(destp++) = *(src++); | |
41 | *(destp++) = COLOR; | |
42 | } | |
43 | ||
44 | smram_restore_state(old_state); | |
45 | } | |
46 | ||
47 | void outlog() | |
48 | { | |
49 | int y, x; | |
50 | char *basep = vga_base(); | |
51 | ||
52 | smram_state_t old_state = smram_save_state(); | |
53 | ||
54 | smram_aseg_set_state(SMRAM_ASEG_SMMCODE); | |
55 | ||
56 | for (y = 0; y < 4; y++) | |
57 | for (x = 40; x < 80; x++) | |
58 | { | |
59 | basep[y*80*2+x*2] = ' '; | |
60 | basep[y*80*2+x*2+1] = 0x1F; | |
61 | } | |
62 | ||
63 | smram_restore_state(old_state); | |
64 | ||
65 | for (y = 0; y < 4; y++) | |
66 | strblit(logents[y], y, 40); | |
67 | } | |
68 | ||
69 | void dolog(char *s) | |
70 | { | |
71 | memmove(logents[0], logents[1], sizeof(logents[0])*3); | |
72 | strcpy(logents[3], s); | |
73 | } | |
74 | ||
75 | void dologf(char *fmt, ...) | |
76 | { | |
77 | va_list va; | |
78 | ||
79 | memmove(logents[0], logents[1], sizeof(logents[0])*3); | |
80 | va_start(va, fmt); | |
81 | vsnprintf(logents[3], 40, fmt, va); | |
82 | va_end(va); | |
83 | } |