Interrupt does not switch between ISR's properly

Is there a reason you are avoiding a Stepper library?