diff options
Diffstat (limited to 'src/stm/ao_timer.c')
| -rw-r--r-- | src/stm/ao_timer.c | 17 |
1 files changed, 17 insertions, 0 deletions
diff --git a/src/stm/ao_timer.c b/src/stm/ao_timer.c index 9e9436cf..d00deffa 100644 --- a/src/stm/ao_timer.c +++ b/src/stm/ao_timer.c @@ -36,6 +36,23 @@ ao_time(void) { return ao_tick_count; } + +uint64_t +ao_time_ns(void) +{ + AO_TICK_TYPE before, after; + uint32_t cvr; + + do { + before = ao_tick_count; + cvr = stm_systick.cvr; + after = ao_tick_count; + } while (before != after); + + return (uint64_t) after * (1000000000ULL / AO_HERTZ) + + (uint64_t) cvr * (1000000000ULL / AO_SYSTICK); +} + #endif #if AO_DATA_ALL |