From 580d6e3f9ef185e8bbf486d84303f6dec270080a Mon Sep 17 00:00:00 2001 From: Tomasz Kramkowski Date: Sun, 26 Mar 2017 21:41:28 +0100 Subject: asm: wfi, set/get_BASEPRI --- asm.h | 17 +++++++++++++++++ 1 file changed, 17 insertions(+) diff --git a/asm.h b/asm.h index f6489e6..f638d58 100644 --- a/asm.h +++ b/asm.h @@ -1,7 +1,24 @@ #ifndef ASM_H #define ASM_H +#include + #define CLI() __asm__ volatile ("cpsid i") #define STI() __asm__ volatile ("cpsie i") +#define WFI() __asm__ volatile ("wfi") + +static inline uint32_t get_BASEPRI(void) +{ + uint32_t ret; + + __asm__ volatile ("mrs %0, basepri" :"=r"(ret)); + + return ret; +} + +static inline void set_BASEPRI(uint32_t p) +{ + __asm__ volatile ("msr basepri, %0" ::"r"(p)); +} #endif /* ASM_H */ -- cgit v1.2.3-54-g00ecf