Forcing ISR to exit into a specific subroutine