Cortex-M0 improvements for IAR port.

git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@2803 35acf78f-673a-0410-8e92-d51de3d6d3f4
This commit is contained in:
gdisirio 2011-03-06 10:39:17 +00:00
parent 3964ec0195
commit f26704f6ee
3 changed files with 29 additions and 48 deletions

View File

@ -27,11 +27,6 @@
#include "ch.h" #include "ch.h"
/**
* @brief PC register temporary storage.
*/
regarm_t _port_saved_pc;
/** /**
* @brief System Timer vector. * @brief System Timer vector.
* @details This interrupt is used as system tick. * @details This interrupt is used as system tick.

View File

@ -32,10 +32,8 @@
/* Port implementation part. */ /* Port implementation part. */
/*===========================================================================*/ /*===========================================================================*/
/** #if !defined(__DOXYGEN__)
* @brief Cortex-Mx exception context. struct extctx {
*/
struct cmxctx {
regarm_t r0; regarm_t r0;
regarm_t r1; regarm_t r1;
regarm_t r2; regarm_t r2;
@ -46,18 +44,6 @@ struct cmxctx {
regarm_t xpsr; regarm_t xpsr;
}; };
#if !defined(__DOXYGEN__)
struct extctx {
regarm_t xpsr;
regarm_t r12;
regarm_t lr;
regarm_t r0;
regarm_t r1;
regarm_t r2;
regarm_t r3;
regarm_t pc;
};
struct intctx { struct intctx {
regarm_t r8; regarm_t r8;
regarm_t r9; regarm_t r9;
@ -231,10 +217,6 @@ struct intctx {
} }
#endif #endif
#if !defined(__DOXYGEN__)
extern regarm_t _port_saved_pc;
#endif
#ifdef __cplusplus #ifdef __cplusplus
extern "C" { extern "C" {
#endif #endif

View File

@ -30,16 +30,15 @@
#define CORTEX_PRIORITY_MASK(n) ((n) << (8 - CORTEX_PRIORITY_BITS)) #define CORTEX_PRIORITY_MASK(n) ((n) << (8 - CORTEX_PRIORITY_BITS))
EXTCTX_SIZE SET 32 EXTCTX_SIZE SET 32
CONTEXT_OFFSET SET 12 CONTEXT_OFFSET SET 12
SCB_ICSR SET 0xE000ED04
SECTION .text:CODE:NOROOT(2) SECTION .text:CODE:NOROOT(2)
EXTERN chThdExit EXTERN chThdExit
EXTERN chSchIsRescRequiredExI EXTERN chSchIsRescRequiredExI
EXTERN chSchDoRescheduleI EXTERN chSchDoRescheduleI
EXTERN _port_saved_pc
EXTERN _port_irq_nesting
THUMB THUMB
@ -76,29 +75,32 @@ _port_thread_start:
blx r4 blx r4
bl chThdExit bl chThdExit
/*
* NMI vector.
* The NMI vector is used for exception mode re-entering after a context
* switch.
*/
PUBLIC NMIVector
NMIVector:
mrs r3, PSP
adds r3, r3, #32
msr PSP, r3
cpsie i
bx lr
/* /*
* Post-IRQ switch code. * Post-IRQ switch code.
* Exception handlers return here for context switching. * Exception handlers return here for context switching.
*/ */
PUBLIC _port_switch_from_isr PUBLIC _port_switch_from_isr
_port_switch_from_isr: _port_switch_from_isr:
/* Note, saves r4 to make space for the PC.*/
push {r0, r1, r2, r3, r4}
mrs r0, APSR
mov r1, r12
push {r0, r1, lr}
ldr r0, =_port_saved_pc
ldr r0, [r0]
adds r0, r0, #1
str r0, [sp, #28]
bl chSchDoRescheduleI bl chSchDoRescheduleI
pop {r0, r1, r2} movs r3, #128
mov r12, r1 lsls r3, r3, #24
msr APSR, r0 ldr r2, =SCB_ICSR
mov lr, r2 str r3, [r2, #0]
pop {r0, r1, r2, r3} _waitnmi:
cpsie i b _waitnmi
pop {pc}
/* /*
* Reschedule verification and setup after an IRQ. * Reschedule verification and setup after an IRQ.
@ -117,11 +119,13 @@ stillnested
pop {r3, pc} pop {r3, pc}
doresch doresch
mrs r3, PSP mrs r3, PSP
ldr r2, =_port_saved_pc subs r3, r3, #32
ldr r1, [r3, #24] msr PSP, r3
str r1, [r2]
ldr r2, =_port_switch_from_isr ldr r2, =_port_switch_from_isr
str r2, [r3, #24] str r2, [r3, #24]
movs r2, #128
lsls r2, r2, #17
str r2, [r3, #28]
pop {r3, pc} pop {r3, pc}
END END