Added waypoint route drawing.