diff options
Diffstat (limited to 'include/cpu.h')
-rw-r--r-- | include/cpu.h | 14 |
1 files changed, 14 insertions, 0 deletions
diff --git a/include/cpu.h b/include/cpu.h index c93b3b5..eb2cdc0 100644 --- a/include/cpu.h +++ b/include/cpu.h @@ -24,6 +24,20 @@ static inline void setmode(unsigned long mode) asm volatile ("msr cpsr_c, %0" :: "r"(mode)); } +static inline void* getsysstack(void) +{ + void* sp; + asm volatile ( + "mrs r0, cpsr\n" + "bic r1, r0, #0x1F\n" + "orr r1, r1, #0x1F\n" + "msr cpsr_c, r1\n" + "mov %0, sp\n" + "msr cpsr_c, r0" + : "=r"(sp)); + return sp; +} + static inline void* getsvcstack(void) { void* sp; |