Fix interrupt re-enabling bug in context switch ISR