Velocity accuracy when position steps 2 positions #3
Description
Add additional timers to know which time step was skipped instead of averaging the time steps. Increases accuracy over taking half of the time step because half of a time step doesn't take into account the phase shift of the encoders. Phase shift could leave inaccuracies in the velocity calculation during the next two position increments that use these averaged rate calculations.