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)
