X-Git-Url: https://codewiz.org/gitweb?a=blobdiff_plain;f=bertos%2Fkern%2Fproc.c;h=6b1aaaff51fe97870b35a826ddaa96d4dd21d496;hb=83fc7933f968173822ed3f636d75860d4a747e76;hp=9a1e410b11ffc60cb74df36ff4f07f95a6515a22;hpb=b0c536ad873bb29ed977417a6a5b1aa586414d3b;p=bertos.git

diff --git a/bertos/kern/proc.c b/bertos/kern/proc.c
index 9a1e410b..6b1aaaff 100644
--- a/bertos/kern/proc.c
+++ b/bertos/kern/proc.c
@@ -202,17 +202,21 @@ struct Process *proc_new_with_name(UNUSED_ARG(const char *, name), void (*entry)
 	{
 		proc = (Process *)stack_base;
 		proc->stack = stack_base + PROC_SIZE_WORDS;
+		// On some architecture stack should be aligned, so we do it.
+		proc->stack = (void *)proc->stack + (sizeof(cpu_aligned_stack_t) - ((long)proc->stack % sizeof(cpu_stack_aligned_t)));
 		if (CPU_SP_ON_EMPTY_SLOT)
 			proc->stack++;
 	}
 	else
 	{
 		proc = (Process *)(stack_base + stack_size / sizeof(cpu_stack_t) - PROC_SIZE_WORDS);
-		proc->stack = (cpu_stack_t *)proc;
+		// On some architecture stack should be aligned, so we do it.
+		proc->stack = (void *)proc - ((long)proc % sizeof(cpu_aligned_stack_t));
 		if (CPU_SP_ON_EMPTY_SLOT)
 			proc->stack--;
 	}
 
+	stack_size = stack_size - PROC_SIZE_WORDS;
 	proc_init_struct(proc);
 	proc->user_data = data;
 
@@ -318,9 +322,9 @@ void proc_setPri(struct Process *proc, int pri)
 
 		if (proc != CurrentProcess)
 		{
-				//proc_forbid();
-				//TODO: re-enqueue process
-				//pric_permit();
+				proc_forbid();
+				ATOMIC(sched_reenqueue(proc));
+				proc_permit();
 		}
 }
 #endif // CONFIG_KERN_PRI