- try to fix strange loops after reachig a waypoint