Mode-aware locking

2 files changed, 29 insertions, 7 deletions

diff --git a/src/tests/test.c b/src/tests/test.c
index 40e2679..071323e 100644
--- a/src/tests/test.c
+++ b/src/tests/test.c
@@ -33,28 +33,28 @@ void test_entry(void)
 	add_thread(btest, 0, 4);
 }
 
-static struct Mutex testm = {.addr = 0, .pid = 0};
-//static struct Lock testm = {.pid = 0};
+//static struct Mutex testm = {.addr = 0, .pid = 0};
+static struct Lock testm = {.pid = 0};
 
 void ctest1(void)
 {
 	uart_string("1 Started\n");
-	sys1(SYS_LOCK, &testm);
+	lock(&testm);
 	uart_string("1 Finished\n");
 }
 
 void ctest2(void)
 {
 	uart_string("2 Started\n");
-	sys1(SYS_LOCK, &testm);
+	lock(&testm);
 	uart_string("2 Finished\n");
-	sys1(SYS_UNLOCK, &testm);
+	unlock(&testm);
 }
 
 void ctest3(void)
 {
 	uart_string("3 Started\n");
-	sys1(SYS_UNLOCK, &testm);
+	unlock(&testm);
 	uart_string("3 Finished\n");
 }
 
diff --git a/src/util/lock.c b/src/util/lock.c
index 2a7d35e..6b048f4 100644
--- a/src/util/lock.c
+++ b/src/util/lock.c
@@ -1,5 +1,27 @@
-#include <util/lock.h>
+#include <cpu.h>
+#include <cpu/atomic/swap.h>
 #include <lib/kmem.h>
+#include <util/lock.h>
+
+void lock(struct Lock* l)
+{
+	unsigned long mode = getmode() & 0x1F;
+	if (mode == 0x10) {
+		sys1(SYS_LOCK, l);
+	} else {
+		atm_lock(CORE0_PID, (unsigned long*)l);
+	}
+}
+
+void unlock(struct Lock* l)
+{
+	unsigned long mode = getmode() & 0x1F;
+	if (mode == 0x10) {
+		sys1(SYS_UNLOCK, l);
+	} else {
+		atm_release((unsigned long*)l);
+	}
+}
 
 struct Lock* create_lock(void)
 {