Add timer and debounce functions.
Changed timer module to use time based on SysTick