ARM7TDMI: get rid of gcc's __attribute__((interrupt)).

[bertos.git] / bertos / cpu / irq.h

diff --git a/bertos/cpu/irq.h b/bertos/cpu/irq.h
index 60acce21d7ed8a35b031f8c82f7475ca5deb3442..6eac70fdea50424752119224ac1165fc794f3a50 100644 (file)
--- a/bertos/cpu/irq.h
+++ b/bertos/cpu/irq.h
@@ -261,8 +261,7 @@
 
                #define IRQ_SAVE_DISABLE(x)                             \
                do {                                                    \
-                       cpu_flags_t sreg;                               \
-                       (void) (&sreg == &x);                           \
+                       register cpu_flags_t sreg;                      \
                        asm volatile (                                  \
                                "mrs %0, cpsr\n\t"                      \
                                "orr %1, %0, #0xc0\n\t"                 \
@@ -287,7 +286,7 @@
                        sreg;                                           \
                })
 
-               #define IRQ_ENABLED() (!(CPU_READ_FLAGS() & 0x80))
+               #define IRQ_ENABLED() ((CPU_READ_FLAGS() & 0xc0) != 0xc0)
 
                #if CONFIG_KERN_PREEMPT
                        EXTERN_C void asm_irq_switch_context(void);
@@ -341,17 +340,17 @@
                         * IRQs will be automatically re-enabled when restoring
                         * the context of the user task.
                         */
-                       #define DECLARE_ISR_CONTEXT_SWITCH(func)        \
-                               void ISR_FUNC func(void);               \
-                               static void __isr_##func(void);         \
-                               void ISR_FUNC func(void)                \
-                               {                                       \
-                                       IRQ_ENTRY();                    \
-                                       IRQ_DISABLE;                    \
-                                       __isr_##func();                 \
-                                       IRQ_EXIT();                     \
-                               }                                       \
-                               static void __isr_##func(void)
+                       #define DECLARE_ISR_CONTEXT_SWITCH(func)                \
+                               void ISR_FUNC func(void);                       \
+                               static NOINLINE void __isr_##func(void);        \
+                               void ISR_FUNC func(void)                        \
+                               {                                               \
+                                       IRQ_ENTRY();                            \
+                                       IRQ_DISABLE;                            \
+                                       __isr_##func();                         \
+                                       IRQ_EXIT();                             \
+                               }                                               \
+                               static NOINLINE void __isr_##func(void)
                        /**
                         * Interrupt service routine prototype: can be used for
                         * forward declarations.
@@ -377,21 +376,41 @@
                        #endif /* !CONFIG_KERN_PRI */
                #endif /* CONFIG_KERN_PREEMPT */
 
+               #ifndef ISR_FUNC
+                       #define ISR_FUNC __attribute__((naked))
+               #endif
                #ifndef DECLARE_ISR
                        #define DECLARE_ISR(func) \
-                               void __attribute__((interrupt)) func(void)
+                               void ISR_FUNC func(void);                               \
+                               /*                                                      \
+                                * FIXME: avoid the inlining of this function.          \
+                                *                                                      \
+                                * This is terribly inefficient, but it's a             \
+                                * reliable workaround to avoid gcc blowing             \
+                                * away the stack (see the bug below):                  \
+                                *                                                      \
+                                * http://gcc.gnu.org/bugzilla/show_bug.cgi?id=41999    \
+                                */                                                     \
+                               static NOINLINE void __isr_##func(void);                \
+                               void ISR_FUNC func(void)                                \
+                               {                                                       \
+                                       asm volatile (                                  \
+                                               "sub    lr, lr, #4\n\t"                 \
+                                               "stmfd  sp!, {r0-r3, ip, lr}\n\t");     \
+                                       __isr_##func();                                 \
+                                       asm volatile (                                  \
+                                               "ldmfd sp!, {r0-r3, ip, pc}^\n\t");     \
+                               }                                                       \
+                               static NOINLINE void __isr_##func(void)
                #endif
                #ifndef DECLARE_ISR_CONTEXT_SWITCH
-                       #define DECLARE_ISR_CONTEXT_SWITCH(func) \
-                               void __attribute__((interrupt)) func(void)
+                       #define DECLARE_ISR_CONTEXT_SWITCH(func) DECLARE_ISR(func)
                #endif
                #ifndef ISR_PROTO
-                       #define ISR_PROTO(func) \
-                               void __attribute__((interrupt)) func(void)
+                       #define ISR_PROTO(func) void ISR_FUNC func(void)
                #endif
                #ifndef ISR_PROTO_CONTEXT_SWITCH
-                       #define ISR_PROTO_CONTEXT_SWITCH(func)  \
-                               void __attribute__((interrupt)) func(void)
+                       #define ISR_PROTO_CONTEXT_SWITCH(func) ISR_PROTO(func)
                #endif
 
        #endif /* !__IAR_SYSTEMS_ICC_ */