static inline void ao_arch_restore_stack(void) {
uint32_t sp;
+ uint32_t control;
+
+ asm("mrs %0,control" : "=&r" (control));
+ control |= (1 << 1);
+ asm("msr control,%0" : : "r" (control));
+ asm("isb");
+
sp = (uint32_t) ao_cur_task->sp;
/* Switch stacks */
}
#endif
-#define ao_arch_isr_stack()
+static inline void ao_arch_isr_stack(void) {
+ uint32_t control;
+
+ asm("mrs %0,control" : "=&r" (control));
+ control &= ~(1 << 1);
+ asm("msr control,%0" : : "r" (control));
+ asm("isb");
+}
#endif