1 files changed, 22 insertions, 0 deletions

diff --git a/firmware/target/arm/system-arm.h b/firmware/target/arm/system-arm.h
index 7f10a30bdb..b3630a8473 100644
--- a/firmware/target/arm/system-arm.h
+++ b/firmware/target/arm/system-arm.h
@@ -62,6 +62,21 @@ void __div0(void);
 #define enable_fiq() \
     enable_interrupt(FIQ_STATUS)
 
+#define irq_enabled() \
+    interrupt_enabled(IRQ_STATUS)
+#define fiq_enabled() \
+    interrupt_enabled(FIQ_STATUS)
+#define ints_enabled() \
+    interrupt_enabled(IRQ_FIQ_STATUS)
+
+#define irq_enabled_checkval(val) \
+    (((val) & IRQ_STATUS) == 0)
+#define fiq_enabled_checkval(val) \
+    (((val) & FIQ_STATUS) == 0)
+#define ints_enabled_checkval(val) \
+    (((val) & IRQ_FIQ_STATUS) == 0)
+
+
 /* Core-level interrupt masking */
 
 static inline int set_interrupt_status(int status, int mask)
@@ -87,6 +102,13 @@ static inline void restore_interrupt(int cpsr)
     asm volatile ("msr cpsr_c, %0" : : "r"(cpsr));
 }
 
+static inline bool interrupt_enabled(int status)
+{
+    unsigned long cpsr;
+    asm ("mrs %0, cpsr" : "=r"(cpsr));
+    return (cpsr & status) == 0;
+}
+
 /* ARM_ARCH version section for architecture*/
 
 #if ARM_ARCH >= 6