X-Git-Url: http://git.joshuawise.com/netwatch.git/blobdiff_plain/ee681ad4b4f2ace24beb4d401d425573b450bbd7..20ef12080950c328702f590b53c50e328a03b971:/ich2/ich2-timer.c

diff --git a/ich2/ich2-timer.c b/ich2/ich2-timer.c
new file mode 100644
index 0000000..b98e381
--- /dev/null
+++ b/ich2/ich2-timer.c
@@ -0,0 +1,39 @@
+#include <pci.h>
+#include <io.h>
+#include <reg-82801b.h>
+
+static uint16_t _get_PMBASE()
+{
+	static long pmbase = -1;
+	
+	if (pmbase == -1)	/* Memoize it so that we don't have to hit PCI so often. */
+		pmbase = pci_read32(ICH2_LPC_BUS, ICH2_LPC_DEV, ICH2_LPC_FN, ICH2_LPC_PCI_PMBASE) & ICH2_PMBASE_MASK;
+	
+	return pmbase;
+}
+
+static unsigned long _curtmr()
+{
+	return inl(_get_PMBASE + ICH2_PMBASE_PM1_TMR) & 0xFFFFFF;
+}
+
+/* This is kind of a heuristic, since we can't get interrupts. */
+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;
+}
+
+int oneshot_running(void)
+{
+	if (endtmr == 0 && starttmr == 0)
+		return 0;
+	if ((endtmr < starttmr) && ((_curtmr() > starttmr) || (_curtmr() < endtmr)))
+		return 1;
+	else if ((_curtmr() < endtmr) && (_curtmr() > starttmr))
+		return 1;
+	endtmr = starttmr = 0;
+	return 0;
+}