add new functions to smram-ich2

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

diff --git a/ich2/ich2-timer.c b/ich2/ich2-timer.c
index b98e3817dd686f02bd2b3d8cb3ae998bbd6c688c..9934589ed62d14d002592260bd46e9a8e3ca7141 100644 (file)
--- 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;