当前位置: 首页>>代码示例>>Python>>正文


Python Navigation.wander_and_search_target方法代码示例

本文整理汇总了Python中navigation.Navigation.wander_and_search_target方法的典型用法代码示例。如果您正苦于以下问题:Python Navigation.wander_and_search_target方法的具体用法?Python Navigation.wander_and_search_target怎么用?Python Navigation.wander_and_search_target使用的例子?那么恭喜您, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在navigation.Navigation的用法示例。


在下文中一共展示了Navigation.wander_and_search_target方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的Python代码示例。

示例1: Driver

# 需要导入模块: from navigation import Navigation [as 别名]
# 或者: from navigation.Navigation import wander_and_search_target [as 别名]

#.........这里部分代码省略.........
        elif (status == "CONE_IN_RANGE"):
          self.change_state(State.COLLECT_acquire_cone)

      # ---- Collect Acquire Cone ----

      elif (self.state == State.COLLECT_acquire_cone):
        self.arduino.close_claw()

        ping = self.arduino.get_ping()
        if (ping <= constants.PING_CONE_THRESHOLD and ping != 0):
          if (self.ready_to_deliver == True):
            self.change_state(State.DELIVER_spin_and_search_target)
            self.ready_to_deliver = False
          else:
            print("Waiting for inter-bot command to deliver...")
        else:
          self.change_state(State.COLLECT_open_claw)

      # ---- Collect Open Claw ----

      elif (self.state == State.COLLECT_open_claw):
        self.arduino.open_claw()
        self.change_state(State.COLLECT_approach_cone)

      # ---- Deliver Spin and Search Target ----

      elif (self.state == State.DELIVER_spin_and_search_target):
        if (self.start_time == None):
          self.start_time = time.time()

        if (time.time() - self.start_time >= constants.SPIN_TIME):
          self.start_time = None
          self.navigation.stop()
          self.change_state(State.DELIVER_wander_and_search_target)
        # TODO: Use signatures with pixy
        else:
          status = self.navigation.spin_and_search_target()
          if (status == "TARGET_FOUND"):
            self.start_time = None
            self.change_state(State.DELIVER_approach_target)

      # ---- Deliver Wander and Search Target ----

      elif (self.state == State.DELIVER_wander_and_search_target):
        if (self.start_time == None):
          self.start_time = time.time()

        if (time.time() - self.start_time >= constants.WANDER_TIME):
          self.start_time = None
          self.navigation.stop()
          self.change_state(State.DELIVER_spin_and_search_target)
        # TODO: Use signatures with pixy
        else:
          status = self.navigation.wander_and_search_target()
          if (status == "TARGET_FOUND"):
            self.start_time = None
            self.change_state(State.DELIVER_approach_target)

      # ---- Deliver Approach Target ----

      elif (self.state == State.DELIVER_approach_target):
        status = self.navigation.approach_target()
        if (status == "LOST_TARGET"):
          self.change_state(State.DELIVER_wander_and_search_target)
        elif (status == "TARGET_IN_RANGE"):
          self.change_state(State.DELIVER_verify_target)
开发者ID:zacharylawrence,项目名称:ENEE408I-Team-9,代码行数:70,代码来源:driver.py


注:本文中的navigation.Navigation.wander_and_search_target方法示例由纯净天空整理自Github/MSDocs等开源代码及文档管理平台,相关代码片段筛选自各路编程大神贡献的开源项目,源码版权归原作者所有,传播和使用请参考对应项目的License;未经允许,请勿转载。