Basic interrupts are working.

1 files changed, 16 insertions, 0 deletions

diff --git a/include/isr_vector.h b/include/isr_vector.h
index 6059875..3d4070a 100644
--- a/include/isr_vector.h
+++ b/include/isr_vector.h
@@ -51,3 +51,19 @@ void irq_on_wdog_bat(void);
     _real__irq_on_##name();                                                   \
   }                                                                           \
   static void __attribute__((noinline)) _real__irq_on_##name(void)
+
+inline static void enable_interrupts()
+{
+  int mstatus;
+  asm volatile ("csrr %0, mstatus" : "=r"(mstatus));
+  mstatus |= 0x88;
+  asm volatile ("csrw mstatus, %0" : : "r"(mstatus));
+}
+
+inline static void disable_interrupts()
+{
+  int mstatus;
+  asm volatile ("csrr %0, mstatus" : "=r"(mstatus));
+  mstatus &= ~0x88;
+  asm volatile ("csrw mstatus, %0" : : "r"(mstatus));
+}