If we can detect our position accurately, why not use that to drive the chain
lengths so that we don’t have any error?
If we do’t have an accurate position measurement, what is it that you are
logging? Currently we have the position we think we are at, and the position we
want to be at (and alarm if they are too far apart), they diverge any time you
start/stop the motors because you can’t accelerate instantly.