65 lines
2.2 KiB
XML
65 lines
2.2 KiB
XML
|
<?xml version='1.0' encoding='utf-8'?>
|
||
|
|
<root BTCPP_format="4">
|
||
|
|
<BehaviorTree ID="PlaceObject">
|
||
|
|
<Sequence>
|
||
|
|
|
||
|
|
|
||
|
|
<!-- <Script code="open_gripper_limit:='-0.014'" /> -->
|
||
|
|
<!-- <Script code="close_gripper_limit:='0.0'" /> -->
|
||
|
|
<!---->
|
||
|
|
<!-- <Script code="robot_name:='rbs_arm'" /> -->
|
||
|
|
<!-- <Script code="place_pose_name:='box_2mm_hole'" /> -->
|
||
|
|
<!---->
|
||
|
|
<!-- <Script code="grasp_service:='/get_place_poses'" /> -->
|
||
|
|
<!-- <Script code="move_action:='/mtp_jtc'" /> -->
|
||
|
|
<!-- <Script code="grpper_action:='/gripper_controller/gripper_cmd'" /> -->
|
||
|
|
|
||
|
|
<Action ID="GetPlacePose"
|
||
|
|
place_pose_name="{place_pose_name}"
|
||
|
|
service_name="{grasp_service}"
|
||
|
|
place_pose="{place_pose}"
|
||
|
|
preplace_pose="{preplace_pose}"
|
||
|
|
postplace_pose="{postplace_pose}" />
|
||
|
|
|
||
|
|
<Action ID="MoveToPose" pose="{preplace_pose}" duration="5.0" robot_name="{robot_name}"
|
||
|
|
action_name="{move_action}" />
|
||
|
|
|
||
|
|
<Action ID="MoveToPose" pose="{place_pose}" duration="2.0" robot_name="{robot_name}"
|
||
|
|
action_name="{move_action}" />
|
||
|
|
|
||
|
|
<Action ID="GripperCommand" open_limit="{open_gripper_limit}" close_limit="{close_gripper_limit}" state="open"
|
||
|
|
action_name="{gripper_action}" />
|
||
|
|
|
||
|
|
<Action ID="MoveToPose" pose="{postplace_pose}" duration="2.0" robot_name="{robot_name}"
|
||
|
|
action_name="{move_action}" />
|
||
|
|
|
||
|
|
<Action ID="GripperCommand" open_limit="{open_gripper_limit}" close_limit="{close_gripper_limit}" state="close"
|
||
|
|
action_name="{gripper_action}" />
|
||
|
|
|
||
|
|
</Sequence>
|
||
|
|
</BehaviorTree>
|
||
|
|
|
||
|
|
<TreeNodesModel>
|
||
|
|
<Action ID="GetGraspPose">
|
||
|
|
<input_port name="object_name" />
|
||
|
|
<input_port name="service_name" />
|
||
|
|
<output_port name="place_pose" />
|
||
|
|
<output_port name="preplace_pose" />
|
||
|
|
<output_port name="postplace_pose" />
|
||
|
|
</Action>
|
||
|
|
|
||
|
|
<Action ID="MoveToPose">
|
||
|
|
<input_port name="pose" />
|
||
|
|
<input_port name="robot_name" />
|
||
|
|
<input_port name="action_name" />
|
||
|
|
</Action>
|
||
|
|
|
||
|
|
<Action ID="GripperCommand">
|
||
|
|
<input_port name="open_limit" />
|
||
|
|
<input_port name="close_limit" />
|
||
|
|
<input_port name="state" />
|
||
|
|
<input_port name="action_name"/>
|
||
|
|
</Action>
|
||
|
|
</TreeNodesModel>
|
||
|
|
</root>
|