X-Git-Url: http://git.joshuawise.com/netwatch.git/blobdiff_plain/85bc8ca6a317e9ce0a3ce1bf27a31df11f44ac47..a9d1719cd11f54eaa60e5206f220212b771caf7c:/aseg/counter.c?ds=sidebyside diff --git a/aseg/counter.c b/aseg/counter.c index f77d256..104d809 100644 --- a/aseg/counter.c +++ b/aseg/counter.c @@ -1,61 +1,18 @@ #include +#include +#include +#include + +char thestr[512]; + +#include "vga-overlay.h" unsigned int counter = 0; unsigned long pcisave; unsigned char vgasave; -unsigned char thestr[512]; -unsigned char logents[4][41] = {0}; - -unsigned char vgaread(unsigned char idx) -{ - outb(0x3D4, idx); - inb(0x3D5); -} - -void strblit(char *src, int r, int c) -{ - char *destp = (char*)(0xB8000UL | (((unsigned int)vgaread(0xC)) << 9) | (((unsigned int)vgaread(0xD)) << 1)) + r*80*2 + c*2; - unsigned char smramc; - - smramc = pci_read8(0, 0, 0, 0x70); - pci_write8(0, 0, 0, 0x70, (smramc & 0xF3) | 0x08); - while (*src) - { - *(destp++) = *(src++); - *(destp++) = 0x1F; - } - pci_write8(0, 0, 0, 0x70, smramc); -} - -void outlog() -{ - int y, x; - unsigned char smramc; - unsigned char *basep = (char*)(0xB8000UL | (((unsigned int)vgaread(0xC)) << 9) | (((unsigned int)vgaread(0xD)) << 1)); - - smramc = pci_read8(0, 0, 0, 0x70); - pci_write8(0, 0, 0, 0x70, (smramc & 0xF3) | 0x08); - 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; - } - pci_write8(0, 0, 0, 0x70, smramc); - - 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); -} void pci_dump() { - unsigned char s[40]; + char s[40]; unsigned long cts; static int curdev = 0; /* 0 if kbd, 1 if mouse */ @@ -68,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; } @@ -102,7 +56,6 @@ void pci_dump() { void __start (void) { - unsigned char smramc; static int first = 1; pcisave = inl(0xCF8); @@ -141,13 +94,7 @@ void __start (void) outl(0x840, 0x0100); } if (inl(0x834) & ~(0x4160)) - { - unsigned char s[40]; - strcpy(s, "Unknown: xxxxxxxx"); - tohex(s + 9, inl(0x834) & ~(0x140)); - dolog(s); - } - + dologf("Unknown: %08x", inl(0x834) & ~(0x140)); outlog();