Changeset c16479e in mainline

Timestamp:

2017-08-21T18:42:28Z (7 years ago)

Author:

Martin Decky <martin@…>

Branches:

lfn, master, serial, ticket/834-toolchain-update, topic/msim-upgrade, topic/simplify-dev-export

Children:

ccc362a1

Parents:

5f2926a

Message:

riscv64: interrupt management routines

File:

• kernel/arch/riscv64/include/arch/asm.h (modified) (1 diff)

kernel/arch/riscv64/include/arch/asm.h

@@ -41 +41 @@
 #include <trace.h>
 
+#define SSTATUS_SIE_MASK  0x00000002
+
 NO_TRACE static inline ipl_t interrupts_enable(void)
 {
-        // FIXME
-        return 0;
+        ipl_t ipl;
+        
+        asm volatile (
+                "csrrsi %[ipl], sstatus, " STRING(SSTATUS_SIE_MASK) "\n"
+                : [ipl] "=r" (ipl)
+        );
+        
+        return ipl;
 }
 
 NO_TRACE static inline ipl_t interrupts_disable(void)
 {
-        // FIXME
-        return 0;
+        ipl_t ipl;
+        
+        asm volatile (
+                "csrrci %[ipl], sstatus, " STRING(SSTATUS_SIE_MASK) "\n"
+                : [ipl] "=r" (ipl)
+        );
+        
+        return ipl;
 }
 
 NO_TRACE static inline void interrupts_restore(ipl_t ipl)
 {
-        // FIXME
+        if ((ipl & SSTATUS_SIE_MASK) == SSTATUS_SIE_MASK)
+                interrupts_enable();
+        else
+                interrupts_disable();
 }
 
 NO_TRACE static inline ipl_t interrupts_read(void)
 {
-        // FIXME
-        return 0;
+        ipl_t ipl;
+        
+        asm volatile (
+                "csrr %[ipl], sstatus\n"
+                : [ipl] "=r" (ipl)
+        );
+        
+        return ipl;
 }
 
 NO_TRACE static inline bool interrupts_disabled(void)
 {
-        // FIXME
-        return 0;
+        return ((interrupts_read() & SSTATUS_SIE_MASK) == 0);
 }
 
 NO_TRACE static inline uintptr_t get_stack_base(void)
 {
-        // FIXME
-        return 0;
+        uintptr_t base;
+        
+        asm volatile (
+                "and %[base], sp, %[mask]\n"
+                : [base] "=r" (base)
+                : [mask] "r" (~(STACK_SIZE - 1))
+        );
+        
+        return base;
 }