-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathur5e.xml
138 lines (130 loc) · 6.51 KB
/
ur5e.xml
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
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
<mujoco model="ur5e">
<compiler angle="radian" meshdir="assets" autolimits="true"/>
<default>
<joint axis="0 1 0" range="-6.28319 6.28319"/>
<position ctrlrange="-6.2831 6.2831"/>
<default class="visual">
<geom type="mesh" contype="0" conaffinity="0" group="2"/>
</default>
<default class="collision">
<geom type="capsule" group="3"/>
<default class="eef_collision">
<geom type="cylinder"/>
</default>
</default>
<site size="0.001" rgba="0.5 0.5 0.5 0.3" group="4"/>
<!-- Reference:
https://www.universal-robots.com/articles/ur/robot-care-maintenance/max-joint-torques/ -->
<default class="size3">
<joint armature="0.1" damping="200"/>
<position kp="3500" forcerange="-150 150"/>
<default class="size3_limited">
<joint range="-3.1415 3.1415"/>
<position ctrlrange="-3.1415 3.1415"/>
</default>
</default>
<default class="size1">
<joint armature="0.1" damping="15"/>
<position kp="3000" forcerange="-28 28"/>
</default>
</default>
<asset>
<material name="black" specular="0.5" shininess="0.25" rgba="0.033 0.033 0.033 1"/>
<material name="jointgray" specular="0.5" shininess="0.25" rgba="0.278 0.278 0.278 1"/>
<material name="linkgray" specular="0.5" shininess="0.25" rgba="0.82 0.82 0.82 1"/>
<material name="urblue" specular="0.5" shininess="0.25" rgba="0.49 0.678 0.8 1"/>
<mesh file="base_0.obj"/>
<mesh file="base_1.obj"/>
<mesh file="shoulder_0.obj"/>
<mesh file="shoulder_1.obj"/>
<mesh file="shoulder_2.obj"/>
<mesh file="upperarm_0.obj"/>
<mesh file="upperarm_1.obj"/>
<mesh file="upperarm_2.obj"/>
<mesh file="upperarm_3.obj"/>
<mesh file="forearm_0.obj"/>
<mesh file="forearm_1.obj"/>
<mesh file="forearm_2.obj"/>
<mesh file="forearm_3.obj"/>
<mesh file="wrist1_0.obj"/>
<mesh file="wrist1_1.obj"/>
<mesh file="wrist1_2.obj"/>
<mesh file="wrist2_0.obj"/>
<mesh file="wrist2_1.obj"/>
<mesh file="wrist2_2.obj"/>
<mesh file="wrist3.obj"/>
</asset>
<worldbody>
<light name="spotlight" mode="targetbodycom" target="wrist_2_link" pos="0 -1 2"/>
<body name="base" quat="1 0 0 1">
<inertial mass="4.0" pos="0 0 0" diaginertia="0.00443333156 0.00443333156 0.0072"/>
<geom mesh="base_0" material="black" class="visual"/>
<geom mesh="base_1" material="jointgray" class="visual"/>
<body name="shoulder_link" pos="0 0 0.163">
<inertial mass="3.7" pos="0 0 0" diaginertia="0.0102675 0.0102675 0.00666"/>
<joint name="shoulder_pan_joint" class="size3" axis="0 0 1"/>
<geom mesh="shoulder_0" material="urblue" class="visual"/>
<geom mesh="shoulder_1" material="black" class="visual"/>
<geom mesh="shoulder_2" material="jointgray" class="visual"/>
<geom class="collision" size="0.06 0.06" pos="0 0 -0.04"/>
<body name="upper_arm_link" pos="0 0.138 0" quat="1 0 1 0">
<inertial mass="8.393" pos="0 0 0.2125" diaginertia="0.133886 0.133886 0.0151074"/>
<joint name="shoulder_lift_joint" class="size3"/>
<geom mesh="upperarm_0" material="linkgray" class="visual"/>
<geom mesh="upperarm_1" material="black" class="visual"/>
<geom mesh="upperarm_2" material="jointgray" class="visual"/>
<geom mesh="upperarm_3" material="urblue" class="visual"/>
<geom class="collision" pos="0 -0.04 0" quat="1 1 0 0" size="0.06 0.06"/>
<geom class="collision" size="0.05 0.2" pos="0 0 0.2"/>
<body name="forearm_link" pos="0 -0.131 0.425">
<inertial mass="2.275" pos="0 0 0.196" diaginertia="0.0311796 0.0311796 0.004095"/>
<joint name="elbow_joint" class="size3_limited"/>
<geom mesh="forearm_0" material="urblue" class="visual"/>
<geom mesh="forearm_1" material="linkgray" class="visual"/>
<geom mesh="forearm_2" material="black" class="visual"/>
<geom mesh="forearm_3" material="jointgray" class="visual"/>
<geom class="collision" pos="0 0.08 0" quat="1 1 0 0" size="0.055 0.06"/>
<geom class="collision" size="0.038 0.19" pos="0 0 0.2"/>
<body name="wrist_1_link" pos="0 0 0.392" quat="1 0 1 0">
<inertial mass="1.219" pos="0 0.127 0" diaginertia="0.0025599 0.0025599 0.0021942"/>
<joint name="wrist_1_joint" class="size1"/>
<geom mesh="wrist1_0" material="black" class="visual"/>
<geom mesh="wrist1_1" material="urblue" class="visual"/>
<geom mesh="wrist1_2" material="jointgray" class="visual"/>
<geom class="collision" pos="0 0.05 0" quat="1 1 0 0" size="0.04 0.07"/>
<body name="wrist_2_link" pos="0 0.127 0">
<inertial mass="1.219" pos="0 0 0.1" diaginertia="0.0025599 0.0025599 0.0021942"/>
<joint name="wrist_2_joint" axis="0 0 1" class="size1"/>
<geom mesh="wrist2_0" material="black" class="visual"/>
<geom mesh="wrist2_1" material="urblue" class="visual"/>
<geom mesh="wrist2_2" material="jointgray" class="visual"/>
<geom class="collision" size="0.04 0.06" pos="0 0 0.04"/>
<geom class="collision" pos="0 0.02 0.1" quat="1 1 0 0" size="0.04 0.04"/>
<body name="wrist_3_link" pos="0 0 0.1">
<inertial mass="0.1889" pos="0 0.0771683 0" quat="1 0 0 1"
diaginertia="0.000132134 9.90863e-05 9.90863e-05"/>
<joint name="wrist_3_joint" class="size1"/>
<geom material="linkgray" mesh="wrist3" class="visual"/>
<geom class="eef_collision" pos="0 0.08 0" quat="1 1 0 0" size="0.04 0.02"/>
<site name="attachment_site" pos="0 0.1 0" quat="-1 1 0 0"/>
</body>
</body>
</body>
</body>
</body>
</body>
</body>
</worldbody>
<actuator>
<position class="size3" name="shoulder_pan" joint="shoulder_pan_joint"/>
<position class="size3" name="shoulder_lift" joint="shoulder_lift_joint"/>
<position class="size3_limited" name="elbow" joint="elbow_joint"/>
<position class="size1" name="wrist_1" joint="wrist_1_joint"/>
<position class="size1" name="wrist_2" joint="wrist_2_joint"/>
<position class="size1" name="wrist_3" joint="wrist_3_joint"/>
</actuator>
<keyframe>
<key name="home" qpos="-1.5708 -1.5708 1.5708 -1.5708 -1.5708 0"
ctrl="-1.5708 -1.5708 1.5708 -1.5708 -1.5708 0"/>
</keyframe>
</mujoco>