add draw_waypoints