Use NXP's example for timers, works better than systick counting.