Don't lock mutex if only written by one interrupt

1 files changed, 8 insertions, 1 deletions

diff --git a/src/sys/timer.c b/src/sys/timer.c
index 9419f80..d9c2f6b 100644
--- a/src/sys/timer.c
+++ b/src/sys/timer.c
@@ -24,11 +24,18 @@ void increase_counter(void)
 	}
 }
 
+inline void hard_increase_counter(void)
+{
+	unsigned long* counter = (unsigned long*)exe_cnt_m.addr;
+	*counter += 1;
+}
+
 void c_timer(void)
 {
 	// Reset the counter
 	write_cntv_tval(cntfrq/CPS);
 
-	increase_counter();
+	hard_increase_counter();
+	//increase_counter();
 	status();
 }