Refactor `timespec` operations into own class
The class is timer/timer_utils.
Fix timer glitch with slow motor and new token
When the motor is slow and there is a new token at the beginning
the time was not adjusted properly. (This fix is untested)