hyq.srdf 4.36 KB
Newer Older
1
2
3
<?xml version="1.0" ?>
<robot name="hyq">

4
5
    <!-- left front leg -->
    <group name="lf_leg">
6
7
8
        <joint name="lf_haa_joint" />
        <joint name="lf_hfe_joint" />
        <joint name="lf_kfe_joint" />
9
        <chain base_link="trunk" tip_link="lf_foot" />
10
    </group>
11
12
    <!-- right front leg -->
    <group name="rf_leg">
13
14
15
        <joint name="rf_haa_joint" />
        <joint name="rf_hfe_joint" />
        <joint name="rf_kfe_joint" />
16
        <chain base_link="trunk" tip_link="rf_foot" />
17
    </group>
18
19
    <!-- left hind leg -->
    <group name="lh_leg">
20
21
22
        <joint name="lh_haa_joint" />
        <joint name="lh_hfe_joint" />
        <joint name="lh_kfe_joint" />
23
        <chain base_link="trunk" tip_link="lh_foot" />
24
    </group>
25
26
    <!-- right hind leg -->
    <group name="rh_leg">
27
28
29
        <joint name="rh_haa_joint" />
        <joint name="rh_hfe_joint" />
        <joint name="rh_kfe_joint" />
30
        <chain base_link="trunk" tip_link="lh_foot" />
31
32
33
34
35
36
37
    </group>
    <group name="all_legs">
        <group name="lf" />
        <group name="rf" />
        <group name="lh" />
        <group name="rh" />
    </group>
38
    <group name="r_legs">
39
40
41
        <group name="rf" />
        <group name="rh" />
    </group>
42
    <group name="l_legs">
43
44
45
        <group name="lf" />
        <group name="lh" />
    </group>
46
    <group name="f_legs">
47
48
49
        <group name="lf" />
        <group name="rf" />
    </group>
50
    <group name="h_legs">
51
52
53
        <group name="lh" />
        <group name="rh" />
    </group>
54
    <group name="ld_legs">
55
56
57
        <group name="lf" />
        <group name="rh" />
    </group>
58
    <group name="rd_legs">
59
60
61
62
        <group name="rf" />
        <group name="lh" />
    </group>

63
64
65
66
    <end_effector name="lf_foot" parent_link="lf_foot" group="lf_leg" />
    <end_effector name="rf_foot" parent_link="rf_foot" group="rf_leg" />
    <end_effector name="lh_foot" parent_link="lh_foot" group="lh_leg" />
    <end_effector name="rh_foot" parent_link="rh_foot" group="rh_leg" />
67

68
    <group_state name="standing" group="all_legs">
69
70
71
72
73
        <joint name="root_joint" value="0. 0. 0.5775 0. 0. 0. 1." />
        <joint name="lf_haa_joint" value="-0.2" />
        <joint name="lf_hfe_joint" value="0.75" />
        <joint name="lf_kfe_joint" value="-1.5" />
        <joint name="lh_haa_joint" value="-0.2" />
74
75
76
77
78
        <joint name="lh_hfe_joint" value="-0.75" />
        <joint name="lh_kfe_joint" value="1.5" />
        <joint name="rf_haa_joint" value="-0.2" />
        <joint name="rf_hfe_joint" value="0.75" />
        <joint name="rf_kfe_joint" value="-1.5" />
79
80
81
82
83
        <joint name="rh_haa_joint" value="-0.2" />
        <joint name="rh_hfe_joint" value="-0.75" />
        <joint name="rh_kfe_joint" value="1.5" />
    </group_state>

84
    <group_state name="straight_standing" group="all_legs">
85
86
87
88
89
        <joint name="root_joint" value="0. 0. 0.5775 0. 0. 0. 1." />
        <joint name="lf_haa_joint" value="0." />
        <joint name="lf_hfe_joint" value="0.75" />
        <joint name="lf_kfe_joint" value="-1.5" />
        <joint name="lh_haa_joint" value="0." />
90
91
92
93
94
        <joint name="lh_hfe_joint" value="-0.75" />
        <joint name="lh_kfe_joint" value="1.5" />
        <joint name="rf_haa_joint" value="0." />
        <joint name="rf_hfe_joint" value="0.75" />
        <joint name="rf_kfe_joint" value="-1.5" />
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
        <joint name="rh_haa_joint" value="0." />
        <joint name="rh_hfe_joint" value="-0.75" />
        <joint name="rh_kfe_joint" value="1.5" />
    </group_state>

    <disable_collisions link1="lf_hipassembly" link2="lf_upperleg" reason="Adjacent" />
    <disable_collisions link1="lf_hipassembly" link2="lf_lowerleg" reason="Never" />
    <disable_collisions link1="lf_hipassembly" link2="rf_hipassembly" reason="Never" />
    <disable_collisions link1="lf_hipassembly" link2="rf_upperleg" reason="Never" />
    <disable_collisions link1="lf_hipassembly" link2="rf_lowerleg" reason="Never" />
    <disable_collisions link1="lf_hipassembly" link2="lh_hipassembly" reason="Never" />
    <disable_collisions link1="lf_hipassembly" link2="lh_upperleg" reason="Never" />
    <disable_collisions link1="lf_hipassembly" link2="lh_lowerleg" reason="Never" />
    <disable_collisions link1="lf_hipassembly" link2="rh_hipassembly" reason="Never" />
    <disable_collisions link1="lf_hipassembly" link2="rh_upperleg" reason="Never" />
    <disable_collisions link1="lf_hipassembly" link2="rh_lowerleg" reason="Never" />

</robot>