Add ISR safety to teensy 3.x