Fix stack alineament on new process.

[bertos.git] / bertos / kern / proc.c

diff --git a/bertos/kern/proc.c b/bertos/kern/proc.c
index 25d410df0b2eaeb977acea069ce5e2b33488b955..6b1aaaff51fe97870b35a826ddaa96d4dd21d496 100644 (file)
--- 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;