X-Git-Url: http://git.joshuawise.com/netwatch.git/blobdiff_plain/1830630f2cc0aa3e1e44f7390614216395fdfe7a..3c4e084de9ed00171748c20de1251d347fc33c1c:/ich2/ich2-timer.c

diff --git a/ich2/ich2-timer.c b/ich2/ich2-timer.c
index b98e381..b8f7e1c 100644
--- a/ich2/ich2-timer.c
+++ b/ich2/ich2-timer.c
@@ -1,3 +1,13 @@
+/* ich2-timer.c
+ * High precision timer routines for ICH2 southbridge
+ * NetWatch system management mode administration console
+ *
+ * Copyright (c) 2008 Jacob Potter and Joshua Wise.  All rights reserved.
+ * This program is free software; you can redistribute and/or modify it under
+ * the terms found in the file LICENSE in the root of this source tree. 
+ *
+ */
+
 #include <pci.h>
 #include <io.h>
 #include <reg-82801b.h>
@@ -14,7 +24,7 @@ static uint16_t _get_PMBASE()
 
 static unsigned long _curtmr()
 {
-	return inl(_get_PMBASE + ICH2_PMBASE_PM1_TMR) & 0xFFFFFF;
+	return inl(_get_PMBASE() + ICH2_PMBASE_PM1_TMR) & 0xFFFFFF;
 }
 
 /* This is kind of a heuristic, since we can't get interrupts. */
@@ -23,16 +33,18 @@ static unsigned long starttmr = 0, endtmr = 0;
 void oneshot_start_ms(unsigned long milliseconds)
 {
 	starttmr = _curtmr();
-	endtmr = (starttmr + milliseconds*(ICH2_PM1_TMR_FREQ/1000)) % 0xFFFFFF;
+	endtmr = (starttmr + milliseconds*(ICH2_PM1_TMR_FREQ/1000)) & 0xFFFFFF;
 }
 
 int oneshot_running(void)
 {
+	unsigned long time = _curtmr();
+	
 	if (endtmr == 0 && starttmr == 0)
 		return 0;
-	if ((endtmr < starttmr) && ((_curtmr() > starttmr) || (_curtmr() < endtmr)))
+	if ((endtmr < starttmr) && ((time > starttmr) || (time < endtmr)))
 		return 1;
-	else if ((_curtmr() < endtmr) && (_curtmr() > starttmr))
+	else if ((time < endtmr) && (time > starttmr))
 		return 1;
 	endtmr = starttmr = 0;
 	return 0;