Exemplo n.º 1
0
 def setTarget(self, target, request):
     self._target = target
     ## setting cam
     pitch = float(request.get("body","cam", "pitch"))
     roll = float(request.get("body","cam", "roll"))
     self.setCamAngle(pitch, roll, request)
     
     ## setting waypoint FIXME: setting some values not statically
     LOG.log_app_info("Setting target.")
     maxSpeed= 10 ## in m/s
     timeToStay=1 ## in s
     acc=2 ## in m
     lng=float(target["lon"])
     lat=float(target["lat"])
     heading=float(target["heading"])
     height=float(target["alt"])
     flags = str(request.get("body", "cam", "trigger")).lower() == "true"
     command = Command.getCmd_uploadTarget(maxSpeed, timeToStay, acc, lng, lat, heading, height, flags)
     self.writeData(command)
     key = "WPT"
     if not self.__pending_acks.has_key(key):
         self.__pending_acks[key] = request
     self.__onMission = True