Improve Teensy3 timing using timer, works on 3.0 & 3.1