Refactor waypoint list, add waypoint set preload on start