Changes to eliminate delay in isr on Teensy