def moveToWayPoint(self, startLoc, endLoc):
#print "Moving from ", startLoc, " to ", endLoc, "--", self.waypoints[endLoc]
self.logger.info("Moving from "+ str(startLoc)+ " to "+str(endLoc)+ "--"+str(self.waypoints[endLoc]))
x, y = self.waypoints[endLoc][1]
theta = self.waypoints[endLoc][2]
speed = self.waypoints[endLoc][3]
self.bot_state["naving"] = True
macro_m = nav.macro_move(x, y, theta, datetime.now())
self.qMove_nav.put(macro_m)
#self.wait(self.bot_state["naving"])
while self.bot_state["naving"] != False:
continue
def moveToWayPoint(self, startLoc, endLoc): print "Moving from ", startLoc, " to ", endLoc, "--", self.waypoints[endLoc] x, y, theta = self.waypoints[endLoc] macro_m = nav.macro_move(x, y, theta, datetime.now()) self.qMove_nav.put(macro_m)