X-Git-Url: http://git.joshuawise.com/netwatch.git/blobdiff_plain/015cd976c6ff9a00fded2edbc617daf85b7b3ca1..5ae81164883c737f0204dc26beb7bb7488693a1d:/aseg/counter.c?ds=inline diff --git a/aseg/counter.c b/aseg/counter.c index edad021..d523168 100644 --- a/aseg/counter.c +++ b/aseg/counter.c @@ -1,11 +1,119 @@ -char counter = 0; +#include +#include +#include +#include -#define outb(port, val) \ -({ asm volatile("outb %0, %%dx" : : "a" ((unsigned char)(val)) , "d" ((unsigned short)(port))); }) +char thestr[512]; + +#include "vga-overlay.h" + +unsigned int counter = 0; +unsigned long pcisave; +unsigned char vgasave; + +void pci_dump() { + 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: + { + unsigned char b; + strcpy(s, "READxxxxxxxxxxxxxxxx"); + tohex(s+4, cts); + b = inb(cts & 0xFFFF); + tohex(s+12, 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; + } + case 0x30000: + { + unsigned char b; + + strcpy(s, "WRITxxxxxxxxxxxxxxxx"); + b = *(unsigned char*)0xAFFD0 /* EAX */; + tohex(s+4, cts); + tohex(s+12, b); + dolog(s); + outb(cts & 0xFFFF, b); + break; + } + default: + dolog("Unhandled PCI cycle"); + } + + outl(0x848, 0x1000); + outl(0x840, 0x0100); +} void __start (void) { + static int first = 1; + + pcisave = inl(0xCF8); + vgasave = inb(0x3D4); + + if (first) + { + first = 0; + dolog("NetWatch running..."); + } + counter++; - outb (0x80, counter); + outb(0x80, (counter & 0xFF)); + + strcpy(thestr, "15-412! xxxxxxxx xxxxxxxx"); + tohex(thestr + 8, inl(0x0834)); + tohex(thestr + 17, counter); + strblit(thestr, 0, 0); + + if (inl(0x834) & 0x20) + dolog("Warning: unhandled APM access"); + if (inl(0x834) & 0x1000) + { + if (inl(0x844) & 0x1000) /* devact_sts */ + { + pci_dump(); + outl(0x844, 0x1000); /* ack it */ + } + } + if (inl(0x834) & 0x4000) + dolog("Long periodic timer"); + if (inl(0x840) & 0x1000) + { + pci_dump(); + outl(0x840, 0x1100); + outl(0x840, 0x0100); + } + if (inl(0x834) & ~(0x4160)) + { + char s[40]; + strcpy(s, "Unknown: xxxxxxxx"); + tohex(s + 9, inl(0x834) & ~(0x140)); + dolog(s); + } + + + outlog(); + + outl(0xCF8, pcisave); + outb(0x3D4, vgasave); + + outl(0x848, 0x1000); + outl(0x834, /*0x40*/0xFFFF); // ack the periodic IRQ + outb(0x830, (inb(0x830) | 0x2) & ~0x40); + outb(0x830, inb(0x830) | 0x40); + }