|
| 1 | +import time |
| 2 | + |
| 3 | +import behaviortree_py as bt |
| 4 | +import behaviortree_py.example as bt_example # Needed to laod the ExampleTask pybind11 |
| 5 | + |
| 6 | +xml_text = """ |
| 7 | +<root BTCPP_format="4"> |
| 8 | + <BehaviorTree ID="MainTree"> |
| 9 | + <Sequence> |
| 10 | + <SetTaskName task="{task}" /> |
| 11 | + <ModifyTaskName task="{task}" /> |
| 12 | + <PrintTaskName task="{task}" /> |
| 13 | + <PySetTaskName task="{task}" /> |
| 14 | + <PrintTaskName task="{task}" /> |
| 15 | + </Sequence> |
| 16 | + </BehaviorTree> |
| 17 | +</root> |
| 18 | +""" |
| 19 | + |
| 20 | + |
| 21 | +def modify_task_name(tree_node: bt.TreeNode) -> bt.NodeStatus: |
| 22 | + task = tree_node.get_input("task") |
| 23 | + print(f"Modifying task name: {task.name}") |
| 24 | + task.name = "My Task Python" |
| 25 | + tree_node.set_output("task", task) |
| 26 | + return bt.NodeStatus.SUCCESS |
| 27 | + |
| 28 | + |
| 29 | +def py_set_task_name(tree_node: bt.TreeNode) -> bt.NodeStatus: |
| 30 | + task = bt_example.ExampleTask() |
| 31 | + task.name = "New Task Name Python" |
| 32 | + tree_node.set_output("task", task) |
| 33 | + return bt.NodeStatus.SUCCESS |
| 34 | + |
| 35 | + |
| 36 | +factory = bt.BehaviorTreeFactory() |
| 37 | +factory.register_from_plugin(bt_example.__file__) |
| 38 | +bt.load_type_converters(bt_example.__file__) |
| 39 | +factory.register_simple_action( |
| 40 | + "ModifyTaskName", modify_task_name, dict([bt.bidirectional_port("task")]) |
| 41 | +) |
| 42 | +factory.register_simple_action( |
| 43 | + "PySetTaskName", py_set_task_name, dict([bt.output_port("task")]) |
| 44 | +) |
| 45 | +factory.register_behavior_tree_from_text(xml_text) |
| 46 | + |
| 47 | +tree = factory.create_tree("MainTree") |
| 48 | + |
| 49 | +logger = bt.StdCoutLogger(tree) |
| 50 | + |
| 51 | +print(bt.get_tree_recursively(tree.root_node())) |
| 52 | + |
| 53 | +tree.tick_while_running() |
0 commit comments