Inlined functions

1 files changed, 13 insertions, 2 deletions

diff --git a/src/util/time.h b/src/util/time.h
index aa74896..13875e2 100644
--- a/src/util/time.h
+++ b/src/util/time.h
@@ -3,12 +3,23 @@
 
 void routing_core0cntv_to_core0irq(void);
 unsigned long read_core0timer_pending(void);
-void enable_cntv(void);
-void disable_cntv(void);
 unsigned long long read_cntvct(void);
 unsigned long long read_cntvoff(void);
 unsigned long read_cntv_tval(void);
 void write_cntv_tval(unsigned long val);
 unsigned long read_cntfrq(void);
 
+static inline void enablecntv(void) {
+	unsigned long cntv_ctl;
+	cntv_ctl = 1;
+	asm volatile ("mcr p15, 0, %0, c14, c3, 1" :: "r"(cntv_ctl) ); // write CNTV_CTL
+}
+
+static inline void disablecntv(void)
+{
+	unsigned long cntv_ctl;
+	cntv_ctl = 0;
+	asm volatile ("mcr p15, 0, %0, c14, c3, 1" :: "r"(cntv_ctl) ); // write CNTV_CTL
+}
+
 #endif