More anti-oscillation changes

Zero out the position errors in addition to sending the target velocity
when we are within one step of the target