Updated with a better calculation on frequency. And added a way to validate the systick timer
was firing correctly.