X-Git-Url: http://git.joshuawise.com/netwatch.git/blobdiff_plain/8a677ebb8955dbe1b09e755dbb8343a3b8fdddb1..42125f27f3d2a77966f2015c545a88c4113368ef:/aseg/counter.c diff --git a/aseg/counter.c b/aseg/counter.c index 3c22c05..4876acf 100644 --- a/aseg/counter.c +++ b/aseg/counter.c @@ -3,7 +3,10 @@ #include #include #include +#include +#include "../net/net.h" #include "vga-overlay.h" +#include "packet.h" unsigned int counter = 0; unsigned long pcisave; @@ -65,17 +68,43 @@ void kbc_handler(smi_event_t ev) pci_dump(); } +void gbl_rls_handler(smi_event_t ev) +{ + unsigned long ecx; + + ecx = *(unsigned long*)0xAFFD4; + + packet_t * packet = check_packet(ecx); + if (!packet) + { + dologf("WARN: bad packet at %08x", ecx); + return; + } + + dologf("Got packet: type %08x", packet->type); + + if (packet->type == 42) { + dump_log((char *)packet->data); + *(unsigned long*)0xAFFD4 = 42; + } else { + *(unsigned long*)0xAFFD4 = 0x2BADD00D; + } +} + void smi_entry(void) { char statstr[512]; pcisave = inl(0xCF8); vgasave = inb(0x3D4); + pci_unbother_all(); counter++; sprintf(statstr, "15-412! %08x %08x", smi_status(), counter); strblit(statstr, 0, 0); + eth_poll(); + if (inl(0x840) & 0x1000) { pci_dump(); @@ -85,6 +114,7 @@ void smi_entry(void) smi_poll(); + pci_bother_all(); outl(0xCF8, pcisave); outb(0x3D4, vgasave); }