diff options
Diffstat (limited to 'bcmclock.h')
| -rw-r--r-- | bcmclock.h | 35 |
1 files changed, 35 insertions, 0 deletions
diff --git a/bcmclock.h b/bcmclock.h new file mode 100644 index 0000000..dd7136b --- /dev/null +++ b/bcmclock.h @@ -0,0 +1,35 @@ +#ifndef BCMCLOCK_H +#define BCMCLOCK_H + +#include <stdint.h> + +#include "global.h" + +#define ST_BASE (PERIF_BASE + 0x3000) // System Timer + +#define ST_CS (ST_BASE + 0x0) // System Timer Control/Status +#define ST_CLO (ST_BASE + 0x4) // System Timer Counter Lower 32 bits +#define ST_CHI (ST_BASE + 0x8) // System Timer Counter Higher 32 bits +#define ST_C0 (ST_BASE + 0xC) // System Timer Compare 0 +#define ST_C1 (ST_BASE + 0x10) // System Timer Compare 1 +#define ST_C2 (ST_BASE + 0x14) // System Timer Compare 2 +#define ST_C3 (ST_BASE + 0x18) // System Timer Compare 3 + +static inline void bcmclk_enable_timer_irq(void) +{ + *(uint32_t volatile*) ARM_ENABLE_IRQS_1 = 1 << 3; +} + +static inline void bcmclk_disable_timer_irq(void) +{ + *(uint32_t volatile*) ARM_DISABLE_IRQS_1 = 1 << 3; +} + +static inline void bcmclk_irq_settimeout(uint32_t timeout) +{ + uint32_t clock_now = *(uint32_t volatile*) ST_CLO; + *(uint32_t volatile*) ST_C3 = clock_now + timeout; + *(uint32_t volatile*) ST_CS = 1 << 3; +} + +#endif // BCMCLOCK_H |