quite a long road to get waypoints to work right