Robot: feed correct positions to actuators when reset_axis_position is called