</collision>
</link>
<link name="lef t_gripper">
<link name="righ t_gripper">
<visual>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
</collision>
</link>
<link name="righ t_gripper">
<link name="lef t_gripper">
<visual>
<origin rpy="0 0 0" xyz="0 0 0"/>
<geometry>
</link>
<!--Disable_Collisions -->
<disable_collision joint1="right_gripper" joint 2="gripper_base">
<disable_collision link1="right_gripper" link 2="gripper_base">
<disable_collision joint1="left_gripper" joint 2="gripper_base">
<disable_collision link1="left_gripper" link 2="gripper_base">
</disable_collision>
<!--Joints -->
<child link="servo_head"/>
<origin rpy="0 0 0" xyz="0 0 0"/>
</joint>
<joint name="control_rod_righ t" type="fixed">
<joint name="control_rod_lef t" type="fixed">
<child link="control_rod_righ t"/>
<child link="control_rod_lef t"/>
<joint name="control_rod_lef t" type="fixed">
<joint name="control_rod_righ t" type="fixed">
<child link="control_rod_lef t"/>
<child link="control_rod_righ t"/>
<joint name="gripper_joint_lef t" type="prismatic">
<parent link="control_rod_left"/>
<child link="left_gripper"/>
<origin rpy="0 3.141 0" xyz="0 0 0"/>
<limit effort="1" lower="-2.57436" upper="2. 57436" velocity="1.0"/>
</joint>
<joint name="gripper_joint_right" type="prismatic" >
<joint name="gripper_joint_righ t" type="prismatic">
<origin rpy="0 3.141 0" xyz="0 0 0"/>
<limit effort="1" lower="-0.0257436" upper="0.02 57436" velocity="1.0"/>
<mimic joint = "gripper_joint_left" multiplier = "-1"/>
</joint >
<joint name="gripper_joint_left" type="prismatic">
<parent link="control_rod_left"/>
<child link="left_gripper"/>
<limit effort="1" lower="-2.57436" upper="2.57436" velocity="1.0"/>
<mimic joint = "gripper_joint_left" multiplier = "-1"/>
<limit effort="1" lower="-0.0257436" upper="0.0257436" velocity="1.0"/>
</joint>
</robot>