Initial version. Can now move motor+encoder close to a specific value quickly and smoothly.