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;