mc_pos_control: update target position only if needed by control mode