add send-way-points and send-reach-target, and use send-reach-target