Add priority inheritance implementation for Semaphores.

[bertos.git] / bertos / kern / proc_p.h

diff --git a/bertos/kern/proc_p.h b/bertos/kern/proc_p.h
index 5469dfcdf0408c5d63ef6e13bdbfe6dd4286dbad..2b6855497da888086d113da6569ff19a7c61b0af 100644 (file)
--- a/bertos/kern/proc_p.h
+++ b/bertos/kern/proc_p.h
@@ -33,7 +33,6 @@
  *
  * \brief Internal scheduler structures and definitions for processes.
  *
- * \version $Id$
  * \author Bernie Innocenti <bernie@codewiz.org>
  */
 
@@ -79,6 +78,13 @@ extern REGISTER Process      *current_process;
 extern REGISTER List     proc_ready_list;
 
 #if CONFIG_KERN_PRI
+# if CONFIG_KERN_PRI_INHERIT
+       #define __prio_orig(proc) (proc->orig_pri)
+       #define __prio_inh(proc) (LIST_EMPTY(&(proc)->inh_list) ? INT_MIN : \
+                                       ((PriNode *)LIST_HEAD(&proc->inh_list))->pri)
+       #define __prio_proc(proc) (__prio_inh(proc) > __prio_orig(proc) ? \
+                                       __prio_inh(proc) : __prio_orig(proc))
+# endif
        #define prio_next()     (LIST_EMPTY(&proc_ready_list) ? INT_MIN : \
                                        ((PriNode *)LIST_HEAD(&proc_ready_list))->pri)
        #define prio_proc(proc) (proc->link.pri)