In mp_check_for_replan, update unit vector and target position