git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@586 35acf78f-673a-0410-8e92-d51de3d6d3f4
This commit is contained in:
parent
a1f4ecfe08
commit
fee14cb4ce
|
@ -17,45 +17,37 @@
|
||||||
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @addtogroup ARMCM3_CORE
|
||||||
|
* @{
|
||||||
|
*/
|
||||||
|
|
||||||
#include <ch.h>
|
#include <ch.h>
|
||||||
#include <nvic.h>
|
#include <nvic.h>
|
||||||
|
|
||||||
/*
|
/**
|
||||||
* System idle thread loop.
|
* The default implementation of this function is void so no messages are
|
||||||
|
* actually printed.
|
||||||
|
* @note The function is declared as a weak symbol, it is possible to redefine
|
||||||
|
* it in your application code.
|
||||||
|
* @param msg pointer to the message string
|
||||||
*/
|
*/
|
||||||
__attribute__((weak))
|
__attribute__((weak))
|
||||||
void _idle(void *p) {
|
void sys_puts(char *msg) {
|
||||||
|
|
||||||
while (TRUE) {
|
|
||||||
#if ENABLE_WFI_IDLE != 0
|
|
||||||
asm volatile ("wfi");
|
|
||||||
#endif
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
void sys_halt(void) {
|
||||||
* System console message (not implemented).
|
|
||||||
*/
|
|
||||||
__attribute__((weak))
|
|
||||||
void chSysPuts(char *msg) {
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* System halt.
|
|
||||||
*/
|
|
||||||
__attribute__((naked, weak))
|
|
||||||
void chSysHalt(void) {
|
|
||||||
|
|
||||||
asm volatile ("cpsid i");
|
asm volatile ("cpsid i");
|
||||||
while (TRUE) {
|
while(TRUE) {
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/**
|
||||||
* Start a thread by invoking its work function.
|
* Start a thread by invoking its work function.
|
||||||
*
|
* If the work function returns @p chThdExit() is automatically invoked. A call
|
||||||
* Start a thread by calling its work function. If the work function returns,
|
* to @p chSysHalt() is added as failure check in the "impossible" case
|
||||||
* call chThdExit and chSysHalt.
|
* @p chThdExit() returns.
|
||||||
*/
|
*/
|
||||||
__attribute__((naked, weak))
|
__attribute__((naked, weak))
|
||||||
void threadstart(void) {
|
void threadstart(void) {
|
||||||
|
@ -65,22 +57,22 @@ void threadstart(void) {
|
||||||
"bl chSysHalt ");
|
"bl chSysHalt ");
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/**
|
||||||
* System Timer vector.
|
* System Timer vector.
|
||||||
|
* This interrupt is used as system tick.
|
||||||
|
* @note The timer is initialized in the board setup code.
|
||||||
*/
|
*/
|
||||||
void SysTickVector(void) {
|
void SysTickVector(void) {
|
||||||
|
|
||||||
chSysIRQEnterI();
|
chSysIRQEnterI();
|
||||||
chSysLock();
|
chSysLockI();
|
||||||
|
|
||||||
chSysTimerHandlerI();
|
chSysTimerHandlerI();
|
||||||
|
chSysUnlockI();
|
||||||
chSysUnlock();
|
|
||||||
chSysIRQExitI();
|
chSysIRQExitI();
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/**
|
||||||
* System invoked context switch.
|
* The SVC vector is used for commanded context switch.
|
||||||
*/
|
*/
|
||||||
__attribute__((naked))
|
__attribute__((naked))
|
||||||
void SVCallVector(Thread *otp, Thread *ntp) {
|
void SVCallVector(Thread *otp, Thread *ntp) {
|
||||||
|
@ -146,7 +138,7 @@ void SVCallVector(Thread *otp, Thread *ntp) {
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
/*
|
/**
|
||||||
* Preemption invoked context switch.
|
* Preemption invoked context switch.
|
||||||
*/
|
*/
|
||||||
__attribute__((naked))
|
__attribute__((naked))
|
||||||
|
@ -154,10 +146,10 @@ void PendSVVector(void) {
|
||||||
Thread *otp;
|
Thread *otp;
|
||||||
register struct intctx *sp_thd asm("r12");
|
register struct intctx *sp_thd asm("r12");
|
||||||
|
|
||||||
chSysLock();
|
chSysLockI();
|
||||||
asm volatile ("push {lr}");
|
asm volatile ("push {lr}");
|
||||||
if (!chSchRescRequiredI()) {
|
if (!chSchRescRequiredI()) {
|
||||||
chSysUnlock();
|
chSysUnlockI();
|
||||||
asm volatile ("pop {pc}");
|
asm volatile ("pop {pc}");
|
||||||
}
|
}
|
||||||
asm volatile ("pop {lr}");
|
asm volatile ("pop {lr}");
|
||||||
|
@ -178,3 +170,5 @@ void PendSVVector(void) {
|
||||||
|
|
||||||
POP_CONTEXT(sp_thd);
|
POP_CONTEXT(sp_thd);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/** @} */
|
||||||
|
|
|
@ -17,6 +17,11 @@
|
||||||
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @addtogroup ARMCM3_CORE
|
||||||
|
* @{
|
||||||
|
*/
|
||||||
|
|
||||||
#ifndef _CHCORE_H_
|
#ifndef _CHCORE_H_
|
||||||
#define _CHCORE_H_
|
#define _CHCORE_H_
|
||||||
|
|
||||||
|
@ -35,29 +40,30 @@
|
||||||
#define ENABLE_WFI_IDLE 0 /* Enables the use of the WFI ins. */
|
#define ENABLE_WFI_IDLE 0 /* Enables the use of the WFI ins. */
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
/*
|
/**
|
||||||
* Macro defining the ARM Cortex-M3 architecture.
|
* Macro defining the ARM Cortex-M3 architecture.
|
||||||
*/
|
*/
|
||||||
#define CH_ARCHITECTURE_ARMCM3
|
#define CH_ARCHITECTURE_ARMCM3
|
||||||
|
|
||||||
/*
|
/**
|
||||||
* 32 bit stack alignment.
|
* 32 bit stack alignment.
|
||||||
*/
|
*/
|
||||||
typedef uint32_t stkalign_t;
|
typedef uint32_t stkalign_t;
|
||||||
|
|
||||||
/*
|
/**
|
||||||
* Generic ARM register.
|
* Generic ARM register.
|
||||||
*/
|
*/
|
||||||
typedef void *regarm_t;
|
typedef void *regarm_t;
|
||||||
|
|
||||||
/*
|
/**
|
||||||
* Interrupt saved context, empty in this architecture.
|
* Interrupt saved context, empty in this architecture.
|
||||||
*/
|
*/
|
||||||
struct extctx {
|
struct extctx {
|
||||||
};
|
};
|
||||||
|
|
||||||
/*
|
/**
|
||||||
* System saved context.
|
* System saved context.
|
||||||
|
* This structure represents the inner stack frame during a context switching.
|
||||||
*/
|
*/
|
||||||
struct intctx {
|
struct intctx {
|
||||||
regarm_t basepri;
|
regarm_t basepri;
|
||||||
|
@ -82,19 +88,17 @@ struct intctx {
|
||||||
regarm_t xpsr;
|
regarm_t xpsr;
|
||||||
};
|
};
|
||||||
|
|
||||||
/*
|
/**
|
||||||
* Port dependent part of the Thread structure, you may add fields in
|
* Cortex-M3 context structure.
|
||||||
* this structure.
|
|
||||||
*/
|
*/
|
||||||
typedef struct {
|
typedef struct {
|
||||||
struct intctx *r13;
|
struct intctx *r13;
|
||||||
} Context;
|
} Context;
|
||||||
|
|
||||||
/*
|
/**
|
||||||
* Platform dependent part of the \p chThdCreate() API.
|
* Platform dependent part of the @p chThdInit() API.
|
||||||
*
|
* This code usually setup the context switching frame represented by a
|
||||||
* The top of the workspace is used for the intctx datastructure.
|
* @p intctx structure.
|
||||||
*
|
|
||||||
*/
|
*/
|
||||||
#define SETUP_CONTEXT(workspace, wsize, pf, arg) { \
|
#define SETUP_CONTEXT(workspace, wsize, pf, arg) { \
|
||||||
tp->p_ctx.r13 = (struct intctx *)((uint8_t *)workspace + \
|
tp->p_ctx.r13 = (struct intctx *)((uint8_t *)workspace + \
|
||||||
|
@ -108,61 +112,107 @@ typedef struct {
|
||||||
tp->p_ctx.r13->xpsr = (regarm_t)0x01000000; \
|
tp->p_ctx.r13->xpsr = (regarm_t)0x01000000; \
|
||||||
}
|
}
|
||||||
|
|
||||||
#define chSysLock() { \
|
/**
|
||||||
|
* The default idle thread implementation requires no extra stack space in
|
||||||
|
* this port.
|
||||||
|
*/
|
||||||
|
#ifndef IDLE_THREAD_STACK_SIZE
|
||||||
|
#define IDLE_THREAD_STACK_SIZE 0
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/**
|
||||||
|
* This port requires no extra stack space for interrupt handling.
|
||||||
|
*/
|
||||||
|
#ifndef INT_REQUIRED_STACK
|
||||||
|
#define INT_REQUIRED_STACK 0
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Enforces a correct alignment for a stack area size value.
|
||||||
|
*/
|
||||||
|
#define STACK_ALIGN(n) ((((n) - 1) | sizeof(stkalign_t)) + 1)
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Computes the thread working area global size.
|
||||||
|
*/
|
||||||
|
#define THD_WA_SIZE(n) StackAlign(sizeof(Thread) + \
|
||||||
|
sizeof(struct intctx) + \
|
||||||
|
sizeof(struct extctx) + \
|
||||||
|
(n) + (INT_REQUIRED_STACK))
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Macro used to allocate a thread working area aligned as both position and
|
||||||
|
* size.
|
||||||
|
*/
|
||||||
|
#define WORKING_AREA(s, n) stkalign_t s[THD_WA_SIZE(n) / sizeof(stkalign_t)];
|
||||||
|
|
||||||
|
/**
|
||||||
|
* IRQ prologue code, inserted at the start of all IRQ handlers enabled to
|
||||||
|
* invoke system APIs.
|
||||||
|
*/
|
||||||
|
#define SYS_IRQ_PROLOGUE()
|
||||||
|
|
||||||
|
/**
|
||||||
|
* IRQ epilogue code, inserted at the end of all IRQ handlers enabled to
|
||||||
|
* invoke system APIs.
|
||||||
|
*/
|
||||||
|
#define SYS_IRQ_EPILOGUE() { \
|
||||||
|
SCB_ICSR = ICSR_PENDSVSET; \
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* This port function is implemented as inlined code for performance reasons.
|
||||||
|
*/
|
||||||
|
#define sys_disable() { \
|
||||||
register uint32_t tmp asm ("r3") = BASEPRI_KERNEL; \
|
register uint32_t tmp asm ("r3") = BASEPRI_KERNEL; \
|
||||||
asm volatile ("msr BASEPRI, %0" : : "r" (tmp)); \
|
asm volatile ("msr BASEPRI, %0" : : "r" (tmp)); \
|
||||||
}
|
}
|
||||||
#define chSysUnlock() { \
|
|
||||||
|
/**
|
||||||
|
* This port function is implemented as inlined code for performance reasons.
|
||||||
|
*/
|
||||||
|
#define sys_enable() { \
|
||||||
register uint32_t tmp asm ("r3") = BASEPRI_USER; \
|
register uint32_t tmp asm ("r3") = BASEPRI_USER; \
|
||||||
asm volatile ("msr BASEPRI, %0" : : "r" (tmp)); \
|
asm volatile ("msr BASEPRI, %0" : : "r" (tmp)); \
|
||||||
}
|
}
|
||||||
#define chSysEnable() { \
|
|
||||||
register uint32_t tmp asm ("r3") = BASEPRI_USER; \
|
/**
|
||||||
asm volatile ("msr BASEPRI, %0" : : "r" (tmp)); \
|
* This port function is implemented as inlined code for performance reasons.
|
||||||
|
*/
|
||||||
|
#define sys_disable_from_isr() sys_disable()
|
||||||
|
|
||||||
|
/**
|
||||||
|
* This port function is implemented as inlined code for performance reasons.
|
||||||
|
*/
|
||||||
|
#define sys_enable_from_isr() sys_enable()
|
||||||
|
|
||||||
|
#define sys_wait_for_interrupt() { \
|
||||||
|
asm volatile ("wfi"); \
|
||||||
}
|
}
|
||||||
#define chSysSwitchI(otp, ntp) { \
|
|
||||||
|
/**
|
||||||
|
* This port function is implemented as inlined code for performance reasons.
|
||||||
|
*/
|
||||||
|
#define sys_switch(otp, ntp) { \
|
||||||
register Thread *_otp asm ("r0") = (otp); \
|
register Thread *_otp asm ("r0") = (otp); \
|
||||||
register Thread *_ntp asm ("r1") = (ntp); \
|
register Thread *_ntp asm ("r1") = (ntp); \
|
||||||
asm volatile ("svc #0" : : "r" (_otp), "r" (_ntp)); \
|
asm volatile ("svc #0" : : "r" (_otp), "r" (_ntp)); \
|
||||||
}
|
}
|
||||||
|
|
||||||
#ifndef INT_REQUIRED_STACK
|
/**
|
||||||
#define INT_REQUIRED_STACK 0 /* NOTE: Always safe for this port. */
|
* IRQ handler function modifier.
|
||||||
#endif
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Enforces a 32 bit alignment for a stack area size value.
|
|
||||||
*/
|
*/
|
||||||
#define STACK_ALIGN(n) ((((n) - 1) | sizeof(stkalign_t)) + 1)
|
#define SYS_IRQ_HANDLER
|
||||||
|
|
||||||
#define THD_WA_SIZE(n) STACK_ALIGN(sizeof(Thread) + \
|
|
||||||
sizeof(struct intctx) + \
|
|
||||||
sizeof(struct extctx) + \
|
|
||||||
(n) + \
|
|
||||||
INT_REQUIRED_STACK)
|
|
||||||
|
|
||||||
#define WORKING_AREA(s, n) stkalign_t s[THD_WA_SIZE(n) / sizeof(stkalign_t)];
|
|
||||||
|
|
||||||
/* called on each interrupt entry, currently nothing is done */
|
|
||||||
#define chSysIRQEnterI()
|
|
||||||
|
|
||||||
/* called on each interrupt exit, pends a supervisor handler for
|
|
||||||
* execution after all higher priority interrupts; PendSVVector() */
|
|
||||||
#define chSysIRQExitI() { \
|
|
||||||
SCB_ICSR = ICSR_PENDSVSET; \
|
|
||||||
}
|
|
||||||
|
|
||||||
#define IDLE_THREAD_STACK_SIZE 0
|
|
||||||
|
|
||||||
#ifdef __cplusplus
|
#ifdef __cplusplus
|
||||||
extern "C" {
|
extern "C" {
|
||||||
#endif
|
#endif
|
||||||
void _idle(void *p) __attribute__((weak, noreturn));
|
void sys_puts(char *msg);
|
||||||
void chSysHalt(void);
|
void sys_halt(void);
|
||||||
void chSysPuts(char *msg);
|
|
||||||
void threadstart(void);
|
|
||||||
#ifdef __cplusplus
|
#ifdef __cplusplus
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#endif /* _CHCORE_H_ */
|
#endif /* _CHCORE_H_ */
|
||||||
|
|
||||||
|
/** @} */
|
||||||
|
|
|
@ -62,12 +62,11 @@ typedef struct {
|
||||||
} Context;
|
} Context;
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Platform dependent part of the \p chThdCreate() API.
|
* Platform dependent part of the @p chThdCreate() API.
|
||||||
* This code usually setup the context switching frame represented by a
|
* This code usually setup the context switching frame represented by a
|
||||||
* @p intctx structure.
|
* @p intctx structure.
|
||||||
*/
|
*/
|
||||||
#define SETUP_CONTEXT(workspace, wsize, pf, arg) \
|
#define SETUP_CONTEXT(workspace, wsize, pf, arg) { \
|
||||||
{ \
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
@ -76,7 +75,9 @@ typedef struct {
|
||||||
* thread should take no more space than those reserved
|
* thread should take no more space than those reserved
|
||||||
* by @p INT_REQUIRED_STACK.
|
* by @p INT_REQUIRED_STACK.
|
||||||
*/
|
*/
|
||||||
|
#ifndef IDLE_THREAD_STACK_SIZE
|
||||||
#define IDLE_THREAD_STACK_SIZE 0
|
#define IDLE_THREAD_STACK_SIZE 0
|
||||||
|
#endif
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Per-thread stack overhead for interrupts servicing, it is used in the
|
* Per-thread stack overhead for interrupts servicing, it is used in the
|
||||||
|
@ -85,7 +86,9 @@ typedef struct {
|
||||||
* interrupt stack and the stack space between @p intctx and @p extctx is
|
* interrupt stack and the stack space between @p intctx and @p extctx is
|
||||||
* known to be zero.
|
* known to be zero.
|
||||||
*/
|
*/
|
||||||
|
#ifndef INT_REQUIRED_STACK
|
||||||
#define INT_REQUIRED_STACK 0
|
#define INT_REQUIRED_STACK 0
|
||||||
|
#endif
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Enforces a correct alignment for a stack area size value.
|
* Enforces a correct alignment for a stack area size value.
|
||||||
|
@ -113,7 +116,7 @@ typedef struct {
|
||||||
#define SYS_IRQ_PROLOGUE()
|
#define SYS_IRQ_PROLOGUE()
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* IRQ epilogue code, inserted at the start of all IRQ handlers enabled to
|
* IRQ epilogue code, inserted at the end of all IRQ handlers enabled to
|
||||||
* invoke system APIs.
|
* invoke system APIs.
|
||||||
*/
|
*/
|
||||||
#define SYS_IRQ_EPILOGUE()
|
#define SYS_IRQ_EPILOGUE()
|
||||||
|
|
Loading…
Reference in New Issue