From 49672787286b44c07561355b290946f80f334e58 Mon Sep 17 00:00:00 2001 From: Christian Cunningham Date: Wed, 19 Jan 2022 12:01:18 -0700 Subject: Added clobbers --- include/cpu.h | 14 ++++++++++++++ 1 file changed, 14 insertions(+) (limited to 'include/cpu.h') 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; -- cgit v1.2.1