Fix interrupts

Implemented __enable_irq / __disable_irq in assembly.