First implementation of timer-driven motor regulation

reading encoder as few times as possible. Timer executes, reads, resets,
calculates, and calls for the regulator which has been slightly modified.
Regulator might need extra work. We need to debug this to see if it works well