Fixed some enable/disable irq stuff, fixed hard fault