adding waypoints to nav