def main(): rospy.init_node("youbot_navigation_ai_re") nav_ai = YoubotNavigationAI() nav_ai.setup_introspection() #Example Task Spec spec = task_specification_navigation() spec.add_target(navigation_target("D1", "S", 2.0)) spec.add_target(navigation_target("T4", "W", 2.0)) spec.add_target(navigation_target("S1", "N", 2.0)) spec.add_target(navigation_target("S5", "N", 2.0)) nav_ai.get_statemachine().userdata.task_specification_nav_in = spec nav_ai.run()
def execute(self, userdata): try: task_spec = task_specification_navigation() target = navigation_target(userdata.marker_in, userdata.orientation_in, 0.0) task_spec.add_target(target) userdata.task_spec_out = task_spec except: return "failed" return "generated"
def parse_place(self, place_str): place = place_str.strip()[1:] #remove heading '(' print place marker, orientation, sleeptime = place.split(",") sleeptime = int(sleeptime) return navigation_target(marker, orientation, sleeptime)