summaryrefslogtreecommitdiff
path: root/src/cpu/x86/tsc
diff options
context:
space:
mode:
Diffstat (limited to 'src/cpu/x86/tsc')
-rw-r--r--src/cpu/x86/tsc/delay_tsc.c37
1 files changed, 37 insertions, 0 deletions
diff --git a/src/cpu/x86/tsc/delay_tsc.c b/src/cpu/x86/tsc/delay_tsc.c
index 1907a9cfec..e4993d0dd5 100644
--- a/src/cpu/x86/tsc/delay_tsc.c
+++ b/src/cpu/x86/tsc/delay_tsc.c
@@ -164,3 +164,40 @@ void udelay(unsigned us)
count = rdtscll();
}
}
+
+#if CONFIG_TSC_MONOTONIC_TIMER
+#include <timer.h>
+
+static struct monotonic_counter {
+ int initialized;
+ struct mono_time time;
+ uint64_t last_value;
+} mono_counter;
+
+void timer_monotonic_get(struct mono_time *mt)
+{
+ uint64_t current_tick;
+ uint64_t ticks_elapsed;
+
+ if (!mono_counter.initialized) {
+ init_timer();
+ mono_counter.last_value = rdtscll();
+ mono_counter.initialized = 1;
+ }
+
+ current_tick = rdtscll();
+ ticks_elapsed = current_tick - mono_counter.last_value;
+
+ /* Update current time and tick values only if a full tick occurred. */
+ if (ticks_elapsed >= clocks_per_usec) {
+ uint64_t usecs_elapsed;
+
+ usecs_elapsed = ticks_elapsed / clocks_per_usec;
+ mono_time_add_usecs(&mono_counter.time, (long)usecs_elapsed);
+ mono_counter.last_value = current_tick;
+ }
+
+ /* Save result. */
+ *mt = mono_counter.time;
+}
+#endif