X-Git-Url: http://git.joshuawise.com/netwatch.git/blobdiff_plain/20ef12080950c328702f590b53c50e328a03b971..5a626f09575fe20698435018921b4f13d4a615c1:/ich2/ich2-timer.c diff --git a/ich2/ich2-timer.c b/ich2/ich2-timer.c index b98e381..9934589 100644 --- a/ich2/ich2-timer.c +++ b/ich2/ich2-timer.c @@ -14,7 +14,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 +23,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;