def run_point2(self):
start = (4, 4)
goal = (1, 1)
waypoints = get_waypoint_path(start, goal)
for i in range(len(waypoints) - 1):
self.move_to_point(waypoints[i], waypoints[i + 1])
def run(self):
start = (2,3)
goal = (9,4)
waypoints = get_waypoint_path(start,goal)
for i in range(len(waypoints)-1):
self.move_to_point(waypoints[i], waypoints[i+1])