← Source browser

src/custom-ur-descriptions/cms_moveit_config/srdf/2fg7.srdf.xacro

 1
 2
 3
 4
 5
 6
 7
 8
 9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
<?xml version="1.0" ?>
<!-- OnRobot 2FG7 parallel gripper -->
<robot xmlns:xacro="http://www.ros.org/wiki/xacro">
    <group name="2fg7_gripper">
        <link name="2fg7_base_link"/>
        <link name="2fg7_body"/>
        <link name="2fg7_left_finger"/>
        <link name="2fg7_right_finger"/>
        <link name="2fg7_tip"/>
        <joint name="twofg7_left_finger_joint"/>
        <joint name="twofg7_right_finger_joint"/>
    </group>

    <group_state name="2fg7_open" group="2fg7_gripper">
        <joint name="twofg7_left_finger_joint" value="0.035"/>
    </group_state>
    <group_state name="2fg7_closed" group="2fg7_gripper">
        <joint name="twofg7_left_finger_joint" value="0"/>
    </group_state>

    <end_effector name="2fg7_gripper" parent_link="flange" group="2fg7_gripper"/>

    <!-- 2FG7 collision rules -->
    <disable_collisions link1="2fg7_base_link" link2="2fg7_body" reason="Adjacent"/>
    <disable_collisions link1="2fg7_base_link" link2="2fg7_left_finger" reason="Never"/>
    <disable_collisions link1="2fg7_base_link" link2="2fg7_right_finger" reason="Never"/>
    <disable_collisions link1="2fg7_base_link" link2="te_toolside" reason="Adjacent"/>
    <disable_collisions link1="2fg7_base_link" link2="te_robotside" reason="Never"/>
    <disable_collisions link1="2fg7_base_link" link2="wrist_extension" reason="Never"/>
    <disable_collisions link1="2fg7_base_link" link2="wrist_1_link" reason="Never"/>
    <disable_collisions link1="2fg7_base_link" link2="wrist_2_link" reason="Never"/>
    <disable_collisions link1="2fg7_base_link" link2="wrist_3_link" reason="Never"/>
    <disable_collisions link1="2fg7_base_link" link2="zivid_arm_mount" reason="Never"/>
    <disable_collisions link1="2fg7_base_link" link2="zivid_base_link" reason="Never"/>
    <disable_collisions link1="2fg7_body" link2="2fg7_left_finger" reason="Adjacent"/>
    <disable_collisions link1="2fg7_body" link2="2fg7_right_finger" reason="Adjacent"/>
    <disable_collisions link1="2fg7_body" link2="te_toolside" reason="Never"/>
    <disable_collisions link1="2fg7_body" link2="wrist_1_link" reason="Never"/>
    <disable_collisions link1="2fg7_body" link2="wrist_2_link" reason="Never"/>
    <disable_collisions link1="2fg7_body" link2="wrist_3_link" reason="Never"/>
    <disable_collisions link1="2fg7_body" link2="zivid_arm_mount" reason="Never"/>
    <disable_collisions link1="2fg7_body" link2="zivid_base_link" reason="Never"/>
    <disable_collisions link1="2fg7_left_finger" link2="2fg7_right_finger" reason="Default"/>
    <disable_collisions link1="2fg7_left_finger" link2="te_toolside" reason="Never"/>
    <disable_collisions link1="2fg7_left_finger" link2="wrist_1_link" reason="Never"/>
    <disable_collisions link1="2fg7_left_finger" link2="wrist_2_link" reason="Never"/>
    <disable_collisions link1="2fg7_left_finger" link2="wrist_3_link" reason="Never"/>
    <disable_collisions link1="2fg7_left_finger" link2="zivid_arm_mount" reason="Never"/>
    <disable_collisions link1="2fg7_left_finger" link2="zivid_base_link" reason="Never"/>
    <disable_collisions link1="2fg7_right_finger" link2="te_toolside" reason="Never"/>
    <disable_collisions link1="2fg7_right_finger" link2="wrist_1_link" reason="Never"/>
    <disable_collisions link1="2fg7_right_finger" link2="wrist_2_link" reason="Never"/>
    <disable_collisions link1="2fg7_right_finger" link2="wrist_3_link" reason="Never"/>
    <disable_collisions link1="2fg7_right_finger" link2="zivid_arm_mount" reason="Never"/>
    <disable_collisions link1="2fg7_right_finger" link2="zivid_base_link" reason="Never"/>

    <!-- Wrist extension + tool exchanger + camera collision rules -->
    <disable_collisions link1="wrist_extension" link2="wrist_1_link" reason="Never"/>
    <disable_collisions link1="wrist_extension" link2="wrist_2_link" reason="Never"/>
    <disable_collisions link1="wrist_extension" link2="wrist_3_link" reason="Never"/>
    <disable_collisions link1="wrist_extension" link2="flange" reason="Adjacent"/>
    <disable_collisions link1="wrist_extension" link2="zivid_arm_mount" reason="Adjacent"/>
    <disable_collisions link1="wrist_extension" link2="zivid_base_link" reason="Never"/>
    <disable_collisions link1="te_robotside" link2="wrist_extension" reason="Adjacent"/>
    <disable_collisions link1="te_robotside" link2="wrist_1_link" reason="Never"/>
    <disable_collisions link1="te_robotside" link2="wrist_2_link" reason="Never"/>
    <disable_collisions link1="te_robotside" link2="wrist_3_link" reason="Never"/>
    <disable_collisions link1="te_robotside" link2="zivid_arm_mount" reason="Never"/>
    <disable_collisions link1="te_robotside" link2="zivid_base_link" reason="Never"/>
    <disable_collisions link1="te_toolside" link2="te_robotside" reason="Adjacent"/>
    <disable_collisions link1="te_toolside" link2="wrist_extension" reason="Never"/>
    <disable_collisions link1="te_toolside" link2="wrist_1_link" reason="Never"/>
    <disable_collisions link1="te_toolside" link2="wrist_2_link" reason="Never"/>
    <disable_collisions link1="te_toolside" link2="wrist_3_link" reason="Never"/>
    <disable_collisions link1="te_toolside" link2="zivid_arm_mount" reason="Never"/>
    <disable_collisions link1="te_toolside" link2="zivid_base_link" reason="Never"/>
    <disable_collisions link1="wrist_2_link" link2="zivid_arm_mount" reason="Never"/>
    <disable_collisions link1="wrist_2_link" link2="zivid_base_link" reason="Never"/>
    <disable_collisions link1="wrist_3_link" link2="zivid_arm_mount" reason="Never"/>
    <disable_collisions link1="wrist_3_link" link2="zivid_base_link" reason="Never"/>
    <disable_collisions link1="zivid_arm_mount" link2="zivid_base_link" reason="Adjacent"/>
    <disable_collisions link1="flange" link2="zivid_arm_mount" reason="Adjacent"/>
</robot>