This is what you need:
IntervalTimer: http://pjrc.com/teensy/td_timing_IntervalTimer.html