mirror of
https://github.com/RIOT-OS/RIOT.git
synced 2024-12-29 04:50:03 +01:00
89 lines
2.0 KiB
C
89 lines
2.0 KiB
C
/**
|
|
* ARM architecture common support functions
|
|
*
|
|
* Copyright (C) 2008, 2009 Heiko Will <hwill@inf.fu-berlin.de>
|
|
* Copyright (C) 2009 Kaspar Schleiser <kaspar@schleiser.de>
|
|
*
|
|
* This file subject to the terms and conditions of the GNU General Public
|
|
* License. See the file LICENSE in the top level directory for more details.
|
|
*
|
|
* @ingroup arch
|
|
* @{
|
|
* @file
|
|
* @author Kaspar Schleiser <kaspar.schleiser@fu-berlin.de>
|
|
* @author Heiko Will <heiko.will@fu-berlin.de>
|
|
* @}
|
|
*/
|
|
/**
|
|
*
|
|
*
|
|
*
|
|
*/
|
|
|
|
#include <stdio.h>
|
|
#include "arm_cpu.h"
|
|
#include "sched.h"
|
|
#include "kernel_intern.h"
|
|
|
|
void thread_yield() {
|
|
asm("svc 0\n");
|
|
}
|
|
|
|
//----------------------------------------------------------------------------
|
|
// Processor specific routine - here for ARM7
|
|
// sizeof(void*) = sizeof(int)
|
|
//----------------------------------------------------------------------------
|
|
char * thread_stack_init(void * task_func, void * stack_start)
|
|
{
|
|
unsigned int * stk;
|
|
stk = (unsigned int *) stack_start;
|
|
stk--;
|
|
|
|
*stk = 0x77777777;
|
|
stk--;
|
|
|
|
*stk = (unsigned int)sched_task_exit; // LR
|
|
|
|
stk--;
|
|
*stk = (unsigned int) stack_start - 4; // SP
|
|
|
|
for (int i = 12; i>= 0 ; i--) { // build base stack
|
|
stk--;
|
|
*stk = i;
|
|
}
|
|
|
|
stk--;
|
|
*stk = ((unsigned int) task_func); // Entry Point
|
|
stk--;
|
|
*stk = (unsigned int) NEW_TASK_CPSR; // spsr
|
|
|
|
return (char*)stk;
|
|
}
|
|
|
|
void thread_print_stack () {
|
|
register void * stack = 0;
|
|
asm( "mov %0, sp" : "=r" (stack));
|
|
|
|
register unsigned int * s = (unsigned int*) stack;
|
|
printf("task: %X SP: %X\n", (unsigned int)active_thread, (unsigned int)stack);
|
|
register int i = 0;
|
|
s += 5;
|
|
while (*s != 0x77777777) {
|
|
printf("STACK (%u) addr=%X = %X \n",i,(unsigned int) s, (unsigned int)*s);
|
|
s++;
|
|
i++;
|
|
}
|
|
printf("STACK (%u)= %X \n",i,*s);
|
|
}
|
|
|
|
__attribute__((naked,noreturn)) void
|
|
arm_reset(void)
|
|
{
|
|
dINT();
|
|
WDTC = 0x00FFF;
|
|
WDMOD = 0x03;
|
|
WDFEED= 0xAA;
|
|
WDFEED= 0x55;
|
|
while(1);
|
|
}
|