adding coverage visualization, improving waypoint following, included sweepPath