feat: serial device interfacing

[lunaix-os.git] / lunaix-os / kernel / ds / mutex.c

diff --git a/lunaix-os/kernel/ds/mutex.c b/lunaix-os/kernel/ds/mutex.c
index 7bfbf10620fe0b8bd6c453d67ddbff00b23b7052..6af1087be1859a7755b70c6c2e32f398e01490cb 100644 (file)
--- a/lunaix-os/kernel/ds/mutex.c
+++ b/lunaix-os/kernel/ds/mutex.c
@@ -4,7 +4,16 @@
 void
 mutex_lock(mutex_t* mutex)
 {
 void
 mutex_lock(mutex_t* mutex)
 {

-    sem_wait(&mutex->sem);
+    if (atomic_load(&mutex->lk) && mutex->owner == __current->pid) {
+        atomic_fetch_add(&mutex->lk, 1);
+        return;
+    }
+
+    while (atomic_load(&mutex->lk)) {
+        sched_yieldk();
+    }
+
+    atomic_fetch_add(&mutex->lk, 1);

     mutex->owner = __current->pid;
 }
 
     mutex->owner = __current->pid;
 }
 


@@ -17,8 +26,8 @@ mutex_unlock(mutex_t* mutex)
 void
 mutex_unlock_for(mutex_t* mutex, pid_t pid)
 {
 void
 mutex_unlock_for(mutex_t* mutex, pid_t pid)
 {

-    if (mutex->owner != pid) {
+    if (mutex->owner != pid || !atomic_load(&mutex->lk)) {

         return;
     }
         return;
     }

-    sem_post(&mutex->sem);
+    atomic_fetch_sub(&mutex->lk, 1);

 }
\ No newline at end of file
 }
\ No newline at end of file