37 lines
1.2 KiB
XML
37 lines
1.2 KiB
XML
|
<?xml version='1.0' encoding='utf-8'?>
|
||
|
|
<root BTCPP_format="4">
|
||
|
|
<BehaviorTree ID="GraspObject">
|
||
|
|
<Sequence>
|
||
|
|
|
||
|
|
<Script code="action:='/cartesian_move_to_pose'" />
|
||
|
|
|
||
|
|
<Action ID="GetWorkspace"
|
||
|
|
object_name="{object_name}"
|
||
|
|
service_name="{get_workspace}"
|
||
|
|
grasp_pose="{grasp_pose}"
|
||
|
|
pregrasp_pose="{pregrasp_pose}"
|
||
|
|
postgrasp_pose="{postgrasp_pose}" />
|
||
|
|
|
||
|
|
<Action ID="MoveToPose" pose="{pregrasp_pose}" robot_name="{robot_name}" action_name="{action}" />
|
||
|
|
<Action ID="MoveToPose" pose="{grasp_pose}" robot_name="{robot_name}" action_name="{action}" />
|
||
|
|
<Action ID="MoveToPose" pose="{postgrasp_pose}" robot_name="{robot_name}" action_name="{action}" />
|
||
|
|
</Sequence>
|
||
|
|
</BehaviorTree>
|
||
|
|
|
||
|
|
<TreeNodesModel>
|
||
|
|
<Action ID="GetWorkspace">
|
||
|
|
<input_port name="object_name" />
|
||
|
|
<input_port name="service_name" />
|
||
|
|
<output_port name="grasp_pose" />
|
||
|
|
<output_port name="pregrasp_pose" />
|
||
|
|
<output_port name="postgrasp_pose" />
|
||
|
|
</Action>
|
||
|
|
|
||
|
|
<Action ID="MoveToPose">
|
||
|
|
<input_port name="pose" />
|
||
|
|
<input_port name="robot_name" />
|
||
|
|
<input_port name="action_name" />
|
||
|
|
</Action>
|
||
|
|
</TreeNodesModel>
|
||
|
|
</root>
|