Got timers to work.

Added stupid hack for stopping the callback function being called immediately after timer start. Seems like the timer sets the update flag and the capture compare flag automatically on timer enable.