X-Git-Url: https://codewiz.org/gitweb?a=blobdiff_plain;f=bertos%2Fkern%2Fsem.c;h=3c645e957ae0723f2b863fb6a0c395eab64a7f17;hb=35be7aa348f671b0ed50ee43d903444edc4892af;hp=7d07f4d6f61585b928e1361186857c0071cca5fd;hpb=b0ba66e728f0885d53e7836898ea60902c818aa8;p=bertos.git

diff --git a/bertos/kern/sem.c b/bertos/kern/sem.c
index 7d07f4d6..3c645e95 100644
--- a/bertos/kern/sem.c
+++ b/bertos/kern/sem.c
@@ -37,11 +37,13 @@
  */
 
 #include "sem.h"
+#include <cfg/debug.h>
+
 #include <cpu/irq.h> // ASSERT_IRQ_DISABLED()
+
 #include <kern/proc.h>
 #include <kern/proc_p.h>
 #include <kern/signal.h>
-#include <cfg/debug.h>
 
 INLINE void sem_verify(struct Semaphore *s)
 {
@@ -52,7 +54,6 @@ INLINE void sem_verify(struct Semaphore *s)
 	ASSERT(s->nest_count < 128);   // heuristic max
 }
 
-
 /**
  * \brief Initialize a Semaphore structure.
  */
@@ -81,9 +82,9 @@ bool sem_attempt(struct Semaphore *s)
 
 	proc_forbid();
 	sem_verify(s);
-	if ((!s->owner) || (s->owner == CurrentProcess))
+	if ((!s->owner) || (s->owner == current_process))
 	{
-		s->owner = CurrentProcess;
+		s->owner = current_process;
 		s->nest_count++;
 		result = true;
 	}
@@ -116,10 +117,10 @@ void sem_obtain(struct Semaphore *s)
 	sem_verify(s);
 
 	/* Is the semaphore already locked by another process? */
-	if (UNLIKELY(s->owner && (s->owner != CurrentProcess)))
+	if (UNLIKELY(s->owner && (s->owner != current_process)))
 	{
 		/* Append calling process to the wait queue */
-		ADDTAIL(&s->wait_queue, (Node *)CurrentProcess);
+		ADDTAIL(&s->wait_queue, (Node *)current_process);
 
 		/*
 		 * We will wake up only when the current owner calls
@@ -134,7 +135,7 @@ void sem_obtain(struct Semaphore *s)
 		ASSERT(LIST_EMPTY(&s->wait_queue));
 
 		/* The semaphore was free: lock it */
-		s->owner = CurrentProcess;
+		s->owner = current_process;
 		s->nest_count++;
 		proc_permit();
 	}
@@ -156,10 +157,12 @@ void sem_obtain(struct Semaphore *s)
  */
 void sem_release(struct Semaphore *s)
 {
+	Process *proc = NULL;
+
 	proc_forbid();
 	sem_verify(s);
 
-	ASSERT(s->owner == CurrentProcess);
+	ASSERT(s->owner == current_process);
 
 	/*
 	 * Decrement nesting count and check if the semaphore
@@ -167,8 +170,6 @@ void sem_release(struct Semaphore *s)
 	 */
 	if (--s->nest_count == 0)
 	{
-		Process *proc;
-
 		/* Disown semaphore */
 		s->owner = NULL;
 
@@ -177,9 +178,10 @@ void sem_release(struct Semaphore *s)
 		{
 			s->nest_count = 1;
 			s->owner = proc;
-			ATOMIC(SCHED_ENQUEUE(proc));
 		}
 	}
-
 	proc_permit();
+
+	if (proc)
+		ATOMIC(proc_wakeup(proc));
 }