X-Git-Url: http://git.joshuawise.com/netwatch.git/blobdiff_plain/987657404fb5d8c214a96d71f1e6acf4a8b0f00f..5ae81164883c737f0204dc26beb7bb7488693a1d:/aseg/counter.c?ds=inline diff --git a/aseg/counter.c b/aseg/counter.c index e4b5eae..d523168 100644 --- a/aseg/counter.c +++ b/aseg/counter.c @@ -1,68 +1,25 @@ #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 */ cts = inl(0x84C); outl(0x848, 0x0); - + outl(0x840, 0x0); switch(cts&0xF0000) { case 0x20000: @@ -95,11 +52,13 @@ void pci_dump() { default: dolog("Unhandled PCI cycle"); } + + outl(0x848, 0x1000); + outl(0x840, 0x0100); } void __start (void) { - unsigned char smramc; static int first = 1; pcisave = inl(0xCF8); @@ -126,22 +85,20 @@ void __start (void) if (inl(0x844) & 0x1000) /* devact_sts */ { pci_dump(); - outl(0x848, 0x1000); - outl(0x844, 0x1000); + outl(0x844, 0x1000); /* ack it */ } } if (inl(0x834) & 0x4000) dolog("Long periodic timer"); if (inl(0x840) & 0x1000) { - dolog("Caught device monitor trap"); pci_dump(); outl(0x840, 0x1100); outl(0x840, 0x0100); } if (inl(0x834) & ~(0x4160)) { - unsigned char s[40]; + char s[40]; strcpy(s, "Unknown: xxxxxxxx"); tohex(s + 9, inl(0x834) & ~(0x140)); dolog(s);