fixed a waypoint contact issue