Don't lock mutex if only written by one interrupt

2 files changed, 10 insertions, 1 deletions

diff --git a/src/sys/core.c b/src/sys/core.c
index 636dd64..fbe0536 100644
--- a/src/sys/core.c
+++ b/src/sys/core.c
@@ -49,4 +49,6 @@ void sysinit(void)
 	// Enable IRQ & FIQ
 	enableirq();
 	enablefiq();
+
+	// Start Scheduler
 }
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();
 }