X-Git-Url: https://codewiz.org/gitweb?a=blobdiff_plain;f=bertos%2Fkern%2Fproc.c;h=f2054c3991557127a79bb4b1b302b16da5d69f84;hb=b8654961cd6761207f6fc880229b39314f6749e2;hp=0bf820393beddf364973d508ce3cb8f77de3651e;hpb=593c2a6e032d4696a67ddcc0dfb8401ef537fae4;p=bertos.git

diff --git a/bertos/kern/proc.c b/bertos/kern/proc.c
index 0bf82039..f2054c39 100644
--- a/bertos/kern/proc.c
+++ b/bertos/kern/proc.c
@@ -193,6 +193,12 @@ static void proc_initStruct(Process *proc)
 
 #if CONFIG_KERN_PRI
 	proc->link.pri = 0;
+
+# if CONFIG_KERN_PRI_INHERIT
+	proc->orig_pri = proc->inh_link.pri = proc->link.pri;
+	proc->inh_blocked_by = NULL;
+	LIST_INIT(&proc->inh_list);
+# endif
 #endif
 }
 
@@ -439,10 +445,33 @@ void proc_rename(struct Process *proc, const char *name)
  */
 void proc_setPri(struct Process *proc, int pri)
 {
+#if CONFIG_KERN_PRI_INHERIT
+	int new_pri;
+
+	/*
+	 * Whatever it will happen below, this is the new
+	 * original priority of the process, i.e., the priority
+	 * it has without taking inheritance under account.
+	 */
+	proc->orig_pri = pri;
+
+	/* If not changing anything we can just leave */
+	if ((new_pri = __prio_proc(proc)) == proc->link.pri)
+		return;
+
+	/*
+	 * Actual process priority is the highest among its
+	 * own priority and the one of the top-priority
+	 * process that it is blocking (returned by
+	 * __prio_proc()).
+	 */
+	proc->link.pri = new_pri;
+#else
 	if (proc->link.pri == pri)
 		return;
 
 	proc->link.pri = pri;
+#endif // CONFIG_KERN_PRI_INHERIT
 
 	if (proc != current_process)
 		ATOMIC(sched_reenqueue(proc));