X-Git-Url: http://git.joshuawise.com/netwatch.git/blobdiff_plain/34205a17f715de78b7b88f8c44d0cd00885b91b6..07d1dd26f38ed450a9333741337e8091b37b4fc2:/aseg/counter.c

diff --git a/aseg/counter.c b/aseg/counter.c
index 1138e53..85b73eb 100644
--- a/aseg/counter.c
+++ b/aseg/counter.c
@@ -48,6 +48,18 @@ void pci_dump() {
 	outl(0x840, 0x0100);
 }
 
+void timer_handler(smi_event_t ev)
+{
+	static unsigned int ticks = 0;
+	
+	smi_disable_event(SMI_EVENT_FAST_TIMER);
+	smi_enable_event(SMI_EVENT_FAST_TIMER);
+	
+	outb(0x80, (ticks++) & 0xFF);
+	
+	outlog();
+}
+
 void smi_entry(void)
 {
 	char statstr[512];
@@ -56,8 +68,6 @@ void smi_entry(void)
 	vgasave = inb(0x3D4);
 	
 	counter++;
-	outb(0x80, (counter & 0xFF));
-	
 	sprintf(statstr, "15-412! %08x %08x", smi_status(), counter);
 	strblit(statstr, 0, 0);
 	
@@ -77,7 +87,6 @@ void smi_entry(void)
 	}
 
 	smi_poll();
-	outlog();
 	
 	outl(0xCF8, pcisave);
 	outb(0x3D4, vgasave);