Improve lab sim example objectives with story telling #49
There are no files selected for viewing
This file contains hidden or bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains hidden or bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains hidden or bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains hidden or bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1,33 @@ | ||
| <?xml version="1.0" encoding="UTF-8" ?> | ||
| <root BTCPP_format="4" main_tree_to_execute="_Scan Scene"> | ||
| <!--//////////--> | ||
| <BehaviorTree | ||
| ID="_Scan Scene" | ||
| _description="Move robot our of scene to enable full snapshot of scene." | ||
| _favorite="true" | ||
| > | ||
| <Control ID="Sequence" name="TopLevelSequence"> | ||
| <Action ID="ClearSnapshot" /> | ||
| <SubTree | ||
| ID="Move to Waypoint" | ||
| _collapsed="true" | ||
| joint_group_name="manipulator" | ||
| planner_interface="moveit_default" | ||
| controller_names="/joint_trajectory_controller" | ||
| waypoint_name="Park Far Right" | ||
| /> | ||
| <SubTree ID="Take scene camera snapshot" _collapsed="true" /> | ||
| <SubTree | ||
| ID="Move to Waypoint" | ||
| _collapsed="true" | ||
| joint_group_name="manipulator" | ||
| planner_interface="moveit_default" | ||
| controller_names="/joint_trajectory_controller" | ||
| waypoint_name="Look at Table" | ||
| /> | ||
| </Control> | ||
| </BehaviorTree> | ||
| <TreeNodesModel> | ||
| <SubTree ID="_Scan Scene" /> | ||
| </TreeNodesModel> | ||
| </root> |
This file contains hidden or bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1,106 @@ | ||
| <?xml version="1.0" encoding="utf-8" ?> | ||
| <root | ||
| BTCPP_format="4" | ||
| main_tree_to_execute="Constrained Pick and Place Subtree" | ||
| > | ||
| <!--//////////--> | ||
| <BehaviorTree | ||
| ID="Constrained Pick and Place Subtree" | ||
| _subtreeOnly="true" | ||
| _description="" | ||
| > | ||
| <Control ID="Sequence"> | ||
| <!--Create a special type of motion planning configuration that includes an upwards orientation requirement--> | ||
| <Action | ||
| ID="InitializeMotionConstraints" | ||
| constraints_name="gripper pointing down" | ||
| constraints="{constraints}" | ||
| /> | ||
| <Action | ||
| ID="AppendOrientationConstraint" | ||
| config_file_name="my_constraints.yaml" | ||
| constraints="{constraints}" | ||
| /> | ||
| <!--Move to pick location--> | ||
| <!--Note: Sampling based planners can be non-deterministic. The retry decorator improves the likelihood of success--> | ||
| <Decorator ID="RetryUntilSuccessful" num_attempts="3"> | ||
| <SubTree | ||
| ID="Move to Waypoint" | ||
| waypoint_name="{pre_pick}" | ||
| joint_group_name="manipulator" | ||
| controller_names="/joint_trajectory_controller /robotiq_gripper_controller" | ||
| planner_interface="moveit_default" | ||
| constraints="{constraints}" | ||
| /> | ||
| </Decorator> | ||
| <Decorator ID="RetryUntilSuccessful" num_attempts="3"> | ||
| <SubTree | ||
| ID="Move to Waypoint" | ||
| waypoint_name="{pick}" | ||
| joint_group_name="manipulator" | ||
| controller_names="/joint_trajectory_controller /robotiq_gripper_controller" | ||
| planner_interface="moveit_default" | ||
| constraints="{constraints}" | ||
| /> | ||
| </Decorator> | ||
| <!--We force success as the gripper closes, since we are commanding a position it will never reach (fingers fully closed)--> | ||
| <Decorator ID="ForceSuccess"> | ||
| <SubTree ID="Close Gripper" /> | ||
| </Decorator> | ||
| <!--Move to place (drop) location--> | ||
| <Decorator ID="RetryUntilSuccessful" num_attempts="3"> | ||
| <SubTree | ||
| ID="Move to Waypoint" | ||
| controller_names="/joint_trajectory_controller /robotiq_gripper_controller" | ||
| joint_group_name="manipulator" | ||
| planner_interface="moveit_default" | ||
| constraints="{constraints}" | ||
| _collapsed="true" | ||
| waypoint_name="{pre_pick}" | ||
| /> | ||
| </Decorator> | ||
| <Decorator ID="RetryUntilSuccessful" num_attempts="3"> | ||
| <SubTree | ||
| ID="Move to Waypoint" | ||
| controller_names="/joint_trajectory_controller /robotiq_gripper_controller" | ||
| joint_group_name="manipulator" | ||
| planner_interface="moveit_default" | ||
| constraints="{constraints}" | ||
| _collapsed="true" | ||
| waypoint_name="{pre_place}" | ||
| /> | ||
| </Decorator> | ||
| <Decorator ID="RetryUntilSuccessful" num_attempts="3"> | ||
| <SubTree | ||
| ID="Move to Waypoint" | ||
| controller_names="/joint_trajectory_controller /robotiq_gripper_controller" | ||
| joint_group_name="manipulator" | ||
| planner_interface="moveit_default" | ||
| constraints="{constraints}" | ||
| _collapsed="true" | ||
| waypoint_name="{place}" | ||
| /> | ||
| </Decorator> | ||
| <SubTree ID="Open Gripper" /> | ||
| <Decorator ID="RetryUntilSuccessful" num_attempts="3"> | ||
| <SubTree | ||
| ID="Move to Waypoint" | ||
| controller_names="/joint_trajectory_controller /robotiq_gripper_controller" | ||
| joint_group_name="manipulator" | ||
| planner_interface="moveit_default" | ||
| constraints="{constraints}" | ||
| _collapsed="true" | ||
| waypoint_name="{pre_place}" | ||
| /> | ||
| </Decorator> | ||
| </Control> | ||
| </BehaviorTree> | ||
| <TreeNodesModel> | ||
| <SubTree ID="Constrained Pick and Place Subtree"> | ||
| <inout_port name="pre_pick" default="" /> | ||
| <inout_port name="pick" default="" /> | ||
| <inout_port name="pre_place" default="" /> | ||
| <inout_port name="place" default="" /> | ||
| </SubTree> | ||
| </TreeNodesModel> | ||
| </root> |
This file contains hidden or bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains hidden or bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains hidden or bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains hidden or bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Oops, something went wrong.
Oops, something went wrong.
Add this suggestion to a batch that can be applied as a single commit.
This suggestion is invalid because no changes were made to the code.
Suggestions cannot be applied while the pull request is closed.
Suggestions cannot be applied while viewing a subset of changes.
Only one suggestion per line can be applied in a batch.
Add this suggestion to a batch that can be applied as a single commit.
Applying suggestions on deleted lines is not supported.
You must change the existing code in this line in order to create a valid suggestion.
Outdated suggestions cannot be applied.
This suggestion has been applied or marked resolved.
Suggestions cannot be applied from pending reviews.
Suggestions cannot be applied on multi-line comments.
Suggestions cannot be applied while the pull request is queued to merge.
Suggestion cannot be applied right now. Please check back later.
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
I don't know why these links end up in collision after planning a waypoint, but this is my workaround