Add SysTick Timer interrupts configured for 5ms