Added vertices to waypoints