Added static waypoints, added some more options to debug navigation