| | 1 | #include <pci.h> |
| | 2 | #include <io.h> |
| | 3 | #include <reg-82801b.h> |
| | 4 | |
| | 5 | static uint16_t _get_PMBASE() |
| | 6 | { |
| | 7 | static long pmbase = -1; |
| | 8 | |
| | 9 | if (pmbase == -1) /* Memoize it so that we don't have to hit PCI so often. */ |
| | 10 | pmbase = pci_read32(ICH2_LPC_BUS, ICH2_LPC_DEV, ICH2_LPC_FN, ICH2_LPC_PCI_PMBASE) & ICH2_PMBASE_MASK; |
| | 11 | |
| | 12 | return pmbase; |
| | 13 | } |
| | 14 | |
| | 15 | static unsigned long _curtmr() |
| | 16 | { |
| | 17 | return inl(_get_PMBASE() + ICH2_PMBASE_PM1_TMR) & 0xFFFFFF; |
| | 18 | } |
| | 19 | |
| | 20 | /* This is kind of a heuristic, since we can't get interrupts. */ |
| | 21 | static unsigned long starttmr = 0, endtmr = 0; |
| | 22 | |
| | 23 | void oneshot_start_ms(unsigned long milliseconds) |
| | 24 | { |
| | 25 | starttmr = _curtmr(); |
| | 26 | endtmr = (starttmr + milliseconds*(ICH2_PM1_TMR_FREQ/1000)) & 0xFFFFFF; |
| | 27 | } |
| | 28 | |
| | 29 | int oneshot_running(void) |
| | 30 | { |
| | 31 | unsigned long time = _curtmr(); |
| | 32 | |
| | 33 | if (endtmr == 0 && starttmr == 0) |
| | 34 | return 0; |
| | 35 | if ((endtmr < starttmr) && ((time > starttmr) || (time < endtmr))) |
| | 36 | return 1; |
| | 37 | else if ((time < endtmr) && (time > starttmr)) |
| | 38 | return 1; |
| | 39 | endtmr = starttmr = 0; |
| | 40 | return 0; |
| | 41 | } |
git.joshuawise.com / netwatch.git / blame_incremental