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)
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)