More churn moving files around.

[netwatch.git] / hardware / ich2 / ich2-timer.c

diff --git a/hardware/ich2/ich2-timer.c b/hardware/ich2/ich2-timer.c
new file mode 100644 (file)
index 0000000..b8f7e1c
--- /dev/null
+++ b/hardware/ich2/ich2-timer.c
@@ -0,0 +1,51 @@
+/* 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>
+
+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)
+{
+       unsigned long time = _curtmr();
+       
+       if (endtmr == 0 && starttmr == 0)
+               return 0;
+       if ((endtmr < starttmr) && ((time > starttmr) || (time < endtmr)))
+               return 1;
+       else if ((time < endtmr) && (time > starttmr))
+               return 1;
+       endtmr = starttmr = 0;
+       return 0;
+}