Fix waypoint update on startup