예제 #1
0
 def moveUpRamp(self, loc1, loc2):
   self.logger.info("Moving up the ramp from "+ str(loc1)+ " to "+str(loc2))
   x1, y1 = self.waypoints[loc1][1]
   x2, y2 = self.waypoints[loc2][1]
   distance = math.sqrt((x1-x2)*(x1-x2) + (y1-y2)*(y1-y2))
   speed = comm.default_speed * 1.2
   micro_m = nav.micro_move_XY(distance, speed, datetime.now())
   self.qMove_nav.put(micro_m)
예제 #2
0
 def microMove(self, distance, direction):
   #print "Moving from ", startLoc, " to ", endLoc
   micro_m = nav.micro_move_XY(distance, comm.default_speed * direction, datetime.now())
   self.qMove_nav.put(micro_m)