use boolean variable to track first waypoint