X-Git-Url: http://git.joshuawise.com/netwatch.git/blobdiff_plain/c54a4356fd904634dae9b942fb3a587cdcb860b9..8e106bffd631c8bae10efe153f893d80ad0be2df:/aseg/counter.c diff --git a/aseg/counter.c b/aseg/counter.c index 3484b95..104d809 100644 --- a/aseg/counter.c +++ b/aseg/counter.c @@ -3,77 +3,13 @@ #include #include -unsigned int counter = 0; -unsigned long pcisave; -unsigned char vgasave; char thestr[512]; -char logents[4][41] = {{0}}; - -#define VRAM_BASE 0xA0000UL -#define TEXT_CONSOLE_OFFSET 0x18000UL - -#define TEXT_CONSOLE_BASE (VRAM_BASE + TEXT_CONSOLE_OFFSET) - -#define COLOR 0x1F -unsigned char vga_read(unsigned char idx) -{ - outb(CRTC_IDX_REG, idx); - return inb(CRTC_DATA_REG); -} - -char * vga_base() -{ - return (char *) ( - TEXT_CONSOLE_BASE - | (((unsigned int) vga_read(CRTC_START_ADDR_LSB_IDX)) << 9) - | (((unsigned int) vga_read(CRTC_START_ADDR_MSB_IDX)) << 1) - ); -} - -void strblit(char *src, int row, int col) -{ - char *destp = vga_base() + row * 80 * 2 + col * 2; - smram_state_t old_state = smram_save_state(); - - smram_aseg_set_state(SMRAM_ASEG_SMMCODE); - - while (*src) - { - *(destp++) = *(src++); - *(destp++) = COLOR; - } - - smram_restore_state(old_state); -} - -void outlog() -{ - int y, x; - char *basep = vga_base(); +#include "vga-overlay.h" - smram_state_t old_state = smram_save_state(); - - smram_aseg_set_state(SMRAM_ASEG_SMMCODE); - - for (y = 0; y < 4; y++) - for (x = 40; x < 80; x++) - { - basep[y*80*2+x*2] = ' '; - basep[y*80*2+x*2+1] = 0x1F; - } - - smram_restore_state(old_state); - - for (y = 0; y < 4; y++) - strblit(logents[y], y, 40); -} - -void dolog(char *s) -{ - memmove(logents[0], logents[1], sizeof(logents[0])*3); - strcpy(logents[3], s); -} +unsigned int counter = 0; +unsigned long pcisave; +unsigned char vgasave; void pci_dump() { char s[40]; @@ -89,15 +25,12 @@ void pci_dump() { case 0x20000: { unsigned char b; - strcpy(s, "READxxxxxxxxxxxxxxxx"); - tohex(s+4, cts); b = inb(cts & 0xFFFF); - tohex(s+12, b); + dologf("READ: %08x (%02x)", cts, b); if ((cts & 0xFFFF) == 0x64) curdev = (b & 0x20) ? 1 : 0; if ((curdev == 0) && ((cts & 0xFFFF) == 0x60) && (b == 0x01)) outb(0xCF9, 0x4); - dolog(s); *(unsigned char*)0xAFFD0 /* EAX */ = b; break; } @@ -161,13 +94,7 @@ void __start (void) outl(0x840, 0x0100); } if (inl(0x834) & ~(0x4160)) - { - char s[40]; - strcpy(s, "Unknown: xxxxxxxx"); - tohex(s + 9, inl(0x834) & ~(0x140)); - dolog(s); - } - + dologf("Unknown: %08x", inl(0x834) & ~(0x140)); outlog();