コード例 #1
0
def navigateThroughWaypoints(wpts):    
    
    # myLoc = wpts[0]
    canvas = Canvas()
    r = robot(wpts, canvas)
    startingLoc = r.getStartingLocation()
    
    n_wpts = len(wpts)
    
    for wp in wpts:
        canvas.drawWaypoint(wp)
    
    for i in range(n_wpts):
        myLoc = r.navigateToWaypoint(wpts[(i + 1 + startingLoc) % n_wpts])
        # myLoc = r.navigateToWaypoint_rt(wpts[(i + 1 + startingLoc) % n_wpts])
        print("At location: {0}".format(myLoc))                 
        time.sleep(1)
        print '\a'