Skip to content

Commit

Permalink
Add behavior tree to navigate to start before starting fields navigation
Browse files Browse the repository at this point in the history
  • Loading branch information
Marc-Morcos committed Jul 4, 2024
1 parent 57640e2 commit 3976fbc
Showing 1 changed file with 29 additions and 0 deletions.
Original file line number Diff line number Diff line change
@@ -0,0 +1,29 @@
<!--
This Behavior Tree computes a complete coverage path over a selected space, then follows it.
Can also take the coverage_path instead of Nav Path for segmented swaths from turns
for changes in operational modes (e.g. raise tool, turn off payload in turns not in field).
Field filepath is set by the Navigator plugin in the action request, but also may be hardcoded
or set using the polygons input port instead for dynamically computed values instead of from file.
It might be wise to still have the planner server on hand to connect to the coverage path in realistic uses.
This BT shows set polygon usage with the coverage server
-->

<root BTCPP_format="4" main_tree_to_execute="MainTree">
<BehaviorTree ID="MainTree">
<RateController hz="0.0000001"> <!-- once, for demo -->
<Sequence name="NavigateWithoutReplanning">
<!-- May use:
'polygons="{field_polygon}" polygons_frame_id="{polygon_frame_id}"' if set polygon via NavigateCompleteCoverage
or file_field="{field_filepath}" if setting polygon file via NavigateCompleteCoverage -->
<ComputeCoveragePath nav_path="{path}" polygons="{field_polygon}" polygons_frame_id="{polygon_frame_id}" error_code_id="{compute_coverage_error_code}"/>
<GetPoseFromPath path="{path}" pose="{startPose}" index="0" />
<ComputePathToPose goal="{startPose}" path="{pathToStart}" planner_id="GridBased" error_code_id="{compute_path_error_code}"/>
<FollowPath path="{pathToStart}" controller_id="FollowPath" error_code_id="{follow_path_error_code}"/>
<FollowPath path="{path}" controller_id="FollowPath" error_code_id="{follow_path_error_code}"/>
</Sequence>
</RateController>
</BehaviorTree>
</root>

0 comments on commit 3976fbc

Please sign in to comment.