fef/ardix
1
0
Fork 0
Code Issues Pull requests Projects Releases Wiki Activity

sched: set PendSV priority, fix _leave routine

Browse source
This commit is contained in:
anna 2021-08-09 19:26:49 +02:00
parent f5590becd3
commit c79fadaf06
Signed by: fef
GPG key ID: EC22E476DC2D3D84
2 changed files with 20 additions and 14 deletions
arch/at91sam3x8e
leave.Ssched.c

9
arch/at91sam3x8e/leave.S
View file

@ -7,8 +7,15 @@
/* void _leave(void); */
func_begin _leave
pop {r4-r12,lr}
cpsie i
msr psp, r12
/* same as for _do_switch: check which stack pointer the task will use */
tst lr, #(1 << 2)
ite eq
moveq sp, r12
msrne psp, r12
bx lr
func_end _leave

25
arch/at91sam3x8e/sched.c
View file

@ -44,33 +44,32 @@ int arch_sched_init(unsigned int freq)
SysTick_Config(systick_reload);
/* give PendSV the lowest priority so it doesn't interrupt irq handlers */
__set_BASEPRI(0);
NVIC_SetPriority(PendSV_IRQn, 0xf);
return 0;
}
void arch_task_init(struct task *task, void (*entry)(void))
{
/* TODO: Use separate stacks for kernel and program */
struct hw_context *hw_context = task->bottom - sizeof(*hw_context);
struct exc_context *exc_context = (void *)hw_context - sizeof(*exc_context);
memset(hw_context, 0, task->bottom - (void *)hw_context);
hw_context->pc = entry;
hw_context->psr = 0x01000000; /* Thumb = 1, unprivileged */
exc_context->sp = hw_context;
exc_context->lr = (void *)0xfffffff9; /* return to thread mode, use MSP */
exc_context->lr = (void *)0xfffffff9; /* leave exception, use MSP */
hw_context->pc = entry;
hw_context->psr = 0x01000000; /* Thumb state bit set, unprivileged */
hw_context->lr = (void *)0xffffffff;
task->tcb.hw_context = hw_context;
memset(&task->tcb.context, 0, sizeof(task->tcb.context));
task->tcb.context.pc = _leave;
memset(&task->tcb, 0, sizeof(task->tcb));
task->tcb.context.sp = exc_context;
task->tcb.context.pc = _leave;
}
__naked __noreturn static void idle_task_entry(void)
{
while (1);
}
extern void _idle(void);
int arch_idle_task_init(struct task *task)
{
@ -79,7 +78,7 @@ int arch_idle_task_init(struct task *task)
return -ENOMEM;
task->bottom = stack + CONFIG_STACK_SIZE; /* full-descending stack */
arch_task_init(task, idle_task_entry);
arch_task_init(task, _idle);
task->sleep = 0;
task->last_tick = 0;
task->state = TASK_READY;