Interrupt does not switch between ISR's properly