mirror of
https://github.com/RIOT-OS/RIOT.git
synced 2024-12-29 04:50:03 +01:00
118 lines
2.8 KiB
C
118 lines
2.8 KiB
C
/******************************************************************************
|
|
Copyright (C) 2013, Freie Universitaet Berlin (FUB). All rights reserved.
|
|
|
|
These sources were developed at the Freie Universitaet Berlin, Computer Systems
|
|
and Telematics group (http://cst.mi.fu-berlin.de).
|
|
-------------------------------------------------------------------------------
|
|
This file is part of RIOT.
|
|
|
|
This file subject to the terms and conditions of the GNU Lesser General Public
|
|
License. See the file LICENSE in the top level directory for more details.
|
|
*******************************************************************************/
|
|
#ifdef CC430
|
|
#include <cc430f6137.h>
|
|
#else
|
|
#include <msp430x16x.h>
|
|
#endif
|
|
#include "cpu.h"
|
|
#include "kernel.h"
|
|
#include "kernel_intern.h"
|
|
#include "sched.h"
|
|
|
|
volatile int __inISR = 0;
|
|
|
|
char __isr_stack[MSP430_ISR_STACK_SIZE];
|
|
|
|
void thread_yield() {
|
|
__save_context();
|
|
|
|
dINT();
|
|
/* have active_thread point to the next thread */
|
|
sched_run();
|
|
eINT();
|
|
|
|
__restore_context();
|
|
}
|
|
|
|
// static void __resume_context () {
|
|
// __asm__("mov.w %0,r1" : : "m" (active_thread->sp));
|
|
//
|
|
// __asm__("pop r15");
|
|
// __asm__("pop r14");
|
|
// __asm__("pop r13");
|
|
// __asm__("pop r12");
|
|
// __asm__("pop r11");
|
|
// __asm__("pop r10");
|
|
// __asm__("pop r9");
|
|
// __asm__("pop r8");
|
|
// __asm__("pop r7");
|
|
// __asm__("pop r6");
|
|
// __asm__("pop r5");
|
|
// __asm__("pop r4");
|
|
// }
|
|
|
|
|
|
// static void __resume_
|
|
//
|
|
// }
|
|
//
|
|
// void __save_context_isr () {
|
|
// __asm__("push r4");
|
|
// __asm__("push r5");
|
|
// __asm__("push r6");
|
|
// __asm__("push r7");
|
|
// __asm__("push r8");
|
|
// __asm__("push r9");
|
|
// __asm__("push r10");
|
|
// __asm__("push r11");
|
|
// __asm__("push r12");
|
|
// __asm__("push r13");
|
|
// __asm__("push r14");
|
|
// __asm__("push r15");
|
|
//
|
|
// __asm__("mov.w r1,%0" : "=r" (active_thread->sp));
|
|
// }
|
|
//
|
|
//
|
|
// __return_from_isr
|
|
|
|
void cpu_switch_context_exit(void){
|
|
active_thread = sched_threads[0];
|
|
sched_run();
|
|
|
|
__restore_context();
|
|
}
|
|
|
|
//----------------------------------------------------------------------------
|
|
// Processor specific routine - here for MSP
|
|
//----------------------------------------------------------------------------
|
|
char *thread_stack_init(void *task_func, void *stack_start, int stack_size)
|
|
{
|
|
unsigned short * stk;
|
|
stk = (unsigned short *) (stack_start + stack_size);
|
|
|
|
*stk = (unsigned short) sched_task_exit;
|
|
--stk;
|
|
|
|
*stk = (unsigned short) task_func;
|
|
--stk;
|
|
|
|
/* initial value for SR */
|
|
// unsigned int sr;
|
|
// __asm__("mov.w r2,%0" : "=r" (sr));
|
|
|
|
*stk = GIE;
|
|
--stk;
|
|
|
|
/* Space for registers. */
|
|
for (unsigned int i = 15; i > 4; i--) {
|
|
*stk = i;
|
|
--stk;
|
|
}
|
|
//stk -= 11;
|
|
|
|
return (char*) stk;
|
|
}
|
|
|
|
int inISR() { return __inISR; }
|