Example #1
0
 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)