mirror of
https://github.com/RIOT-OS/RIOT.git
synced 2024-12-29 04:50:03 +01:00
129 lines
3.4 KiB
C
129 lines
3.4 KiB
C
/******************************************************************************
|
|
Copyright 2009, 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 FeuerWare.
|
|
|
|
This program is free software: you can redistribute it and/or modify it under
|
|
the terms of the GNU General Public License as published by the Free Software
|
|
Foundation, either version 3 of the License, or (at your option) any later
|
|
version.
|
|
|
|
FeuerWare is distributed in the hope that it will be useful, but WITHOUT
|
|
ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
|
|
FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details.
|
|
|
|
You should have received a copy of the GNU General Public License along with
|
|
this program. If not, see http://www.gnu.org/licenses/ .
|
|
--------------------------------------------------------------------------------
|
|
For further information and questions please use the web site
|
|
http://scatterweb.mi.fu-berlin.de
|
|
and the mailinglist (subscription via web site)
|
|
scatterweb@lists.spline.inf.fu-berlin.de
|
|
*******************************************************************************/
|
|
|
|
#include "cpu.h"
|
|
#include <board.h>
|
|
#include "kernel.h"
|
|
#include "kernel_intern.h"
|
|
#include "scheduler.h"
|
|
|
|
volatile int __inISR = 0;
|
|
|
|
char __isr_stack[MSP430_ISR_STACK_SIZE];
|
|
|
|
void fk_yield() {
|
|
__save_context();
|
|
|
|
dINT();
|
|
/* have fk_thread point to the next thread */
|
|
fk_schedule();
|
|
eINT();
|
|
|
|
__restore_context();
|
|
}
|
|
|
|
// static void __resume_context () {
|
|
// __asm__("mov.w %0,r1" : : "m" (fk_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" (fk_thread->sp));
|
|
// }
|
|
//
|
|
//
|
|
// __return_from_isr
|
|
|
|
void fk_switch_context_exit(){
|
|
fk_thread = fk_threads[0];
|
|
fk_schedule();
|
|
|
|
__restore_context();
|
|
}
|
|
|
|
//----------------------------------------------------------------------------
|
|
// Processor specific routine - here for MSP
|
|
//----------------------------------------------------------------------------
|
|
char *fk_stack_init(void *task_func, void *stack_start)
|
|
{
|
|
unsigned short * stk;
|
|
stk = (unsigned short *) stack_start;
|
|
|
|
*stk = (unsigned short) fk_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; }
|