mani-skill-nightly 2025.4.5.444__py3-none-any.whl → 2025.4.5.2022__py3-none-any.whl
This diff represents the content of publicly available package versions that have been released to one of the supported registries. The information contained in this diff is provided for informational purposes only and reflects changes between package versions as they appear in their respective public registries.
- mani_skill/agents/base_real_agent.py +202 -0
- mani_skill/agents/controllers/base_controller.py +13 -2
- mani_skill/agents/controllers/passive_controller.py +2 -0
- mani_skill/agents/controllers/pd_joint_pos.py +2 -0
- mani_skill/agents/controllers/pd_joint_pos_vel.py +2 -0
- mani_skill/agents/controllers/pd_joint_vel.py +2 -0
- mani_skill/agents/robots/__init__.py +2 -0
- mani_skill/agents/robots/koch/__init__.py +1 -0
- mani_skill/agents/robots/koch/koch.py +163 -0
- mani_skill/agents/robots/koch/koch_real.py +5 -0
- mani_skill/agents/robots/so100/__init__.py +1 -0
- mani_skill/agents/robots/so100/so_100.py +118 -0
- mani_skill/agents/robots/so100/so_100_real.py +5 -0
- mani_skill/assets/robots/koch/LICENSE +507 -0
- mani_skill/assets/robots/koch/README.md +8 -0
- mani_skill/assets/robots/koch/follower_arm_v1.1.srdf +9 -0
- mani_skill/assets/robots/koch/follower_arm_v1.1.urdf +635 -0
- mani_skill/assets/robots/koch/meshes/base_link.glb +0 -0
- mani_skill/assets/robots/koch/meshes/base_link.stl +0 -0
- mani_skill/assets/robots/koch/meshes/centered_base_link.stl +0 -0
- mani_skill/assets/robots/koch/meshes/gripper.glb +0 -0
- mani_skill/assets/robots/koch/meshes/gripper.stl +0 -0
- mani_skill/assets/robots/koch/meshes/gripper_collision_part_1.glb +0 -0
- mani_skill/assets/robots/koch/meshes/gripper_collision_part_2.glb +0 -0
- mani_skill/assets/robots/koch/meshes/gripper_collision_part_3.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_1.stl +0 -0
- mani_skill/assets/robots/koch/meshes/link_1_motor.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_2.stl +0 -0
- mani_skill/assets/robots/koch/meshes/link_2_collision_chassis.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_2_collision_motor.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_2_motor.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_2_rotation_connector.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_2_rotation_connector.stl +0 -0
- mani_skill/assets/robots/koch/meshes/link_3.stl +0 -0
- mani_skill/assets/robots/koch/meshes/link_3_collision_chassis_part_1.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_3_collision_chassis_part_2.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_3_collision_chassis_part_3.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_3_collision_chassis_part_4.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_3_collision_chassis_part_5.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_3_collision_motor.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_3_motor.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_3_motor.stl +0 -0
- mani_skill/assets/robots/koch/meshes/link_3_part.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_3_part.stl +0 -0
- mani_skill/assets/robots/koch/meshes/link_4.stl +0 -0
- mani_skill/assets/robots/koch/meshes/link_4_collision_chassis_part_1.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_4_collision_chassis_part_2.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_4_collision_chassis_part_3.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_4_collision_motor.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_4_motor.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_4_part.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_5.stl +0 -0
- mani_skill/assets/robots/koch/meshes/link_5_motor.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_5_part.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_6.stl +0 -0
- mani_skill/assets/robots/koch/meshes/link_6_collision_part_2.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_6_collision_part_3.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_6_collision_part_4.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_6_motor.glb +0 -0
- mani_skill/assets/robots/koch/meshes/link_6_part.glb +0 -0
- mani_skill/assets/robots/so100/LICENSE +201 -0
- mani_skill/assets/robots/so100/README.md +10 -0
- mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Base.STL +0 -0
- mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Fixed_Jaw.STL +0 -0
- mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Fixed_Jaw_part1.ply +0 -0
- mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Fixed_Jaw_part2.ply +0 -0
- mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Lower_Arm.STL +0 -0
- mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Moving Jaw.STL +0 -0
- mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Moving_Jaw_part1.ply +0 -0
- mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Moving_Jaw_part2.ply +0 -0
- mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Moving_Jaw_part3.ply +0 -0
- mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Rotation_Pitch.STL +0 -0
- mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Upper_Arm.STL +0 -0
- mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Wrist_Pitch_Roll.STL +0 -0
- mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/original.srdf +8 -0
- mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/original.urdf +470 -0
- mani_skill/envs/sapien_env.py +70 -9
- mani_skill/envs/sim2real_env.py +381 -0
- mani_skill/envs/tasks/digital_twins/base_env.py +74 -74
- mani_skill/envs/tasks/digital_twins/bridge_dataset_eval/base_env.py +6 -0
- mani_skill/envs/tasks/digital_twins/bridge_dataset_eval/put_on_in_scene.py +14 -1
- mani_skill/envs/utils/randomization/__init__.py +1 -0
- mani_skill/envs/utils/randomization/camera.py +60 -0
- mani_skill/examples/demo_robot.py +1 -0
- mani_skill/utils/sapien_utils.py +7 -6
- mani_skill/utils/structs/articulation.py +44 -18
- {mani_skill_nightly-2025.4.5.444.dist-info → mani_skill_nightly-2025.4.5.2022.dist-info}/METADATA +1 -1
- {mani_skill_nightly-2025.4.5.444.dist-info → mani_skill_nightly-2025.4.5.2022.dist-info}/RECORD +91 -19
- {mani_skill_nightly-2025.4.5.444.dist-info → mani_skill_nightly-2025.4.5.2022.dist-info}/LICENSE +0 -0
- {mani_skill_nightly-2025.4.5.444.dist-info → mani_skill_nightly-2025.4.5.2022.dist-info}/WHEEL +0 -0
- {mani_skill_nightly-2025.4.5.444.dist-info → mani_skill_nightly-2025.4.5.2022.dist-info}/top_level.txt +0 -0
@@ -0,0 +1,635 @@
|
|
1
|
+
<?xml version="1.0" encoding="utf-8"?>
|
2
|
+
<robot
|
3
|
+
name="koch">
|
4
|
+
<material name="white">
|
5
|
+
<color rgba="0.792156862745098 0.819607843137255 0.933333333333333 1" />
|
6
|
+
</material>
|
7
|
+
<material name="motor">
|
8
|
+
<color rgba="0.1 0.1 0.1 1" />
|
9
|
+
</material>
|
10
|
+
<link
|
11
|
+
name="base_link">
|
12
|
+
<inertial>
|
13
|
+
<origin
|
14
|
+
xyz="-0.011141 -0.10061 0.076043"
|
15
|
+
rpy="0 0 0" />
|
16
|
+
<mass
|
17
|
+
value="0.024929" />
|
18
|
+
<inertia
|
19
|
+
ixx="1.0987E-05"
|
20
|
+
ixy="-1.4265E-07"
|
21
|
+
ixz="-2.3161E-06"
|
22
|
+
iyy="4.9192E-05"
|
23
|
+
iyz="-1.8015E-07"
|
24
|
+
izz="3.8411E-05" />
|
25
|
+
</inertial>
|
26
|
+
<visual name="base_link_chassis">
|
27
|
+
<origin
|
28
|
+
xyz="0 0 0"
|
29
|
+
rpy="1.570796327 0 0" />
|
30
|
+
<geometry>
|
31
|
+
<mesh
|
32
|
+
filename="package://koch/meshes/centered_base_link.stl" />
|
33
|
+
</geometry>
|
34
|
+
<material
|
35
|
+
name="white">
|
36
|
+
</material>
|
37
|
+
</visual>
|
38
|
+
<!-- <collision>
|
39
|
+
<origin
|
40
|
+
xyz="0 0 0"
|
41
|
+
rpy="0 0 0" />
|
42
|
+
<geometry>
|
43
|
+
<mesh
|
44
|
+
filename="package://koch/meshes/base_link.stl" />
|
45
|
+
</geometry>
|
46
|
+
</collision> -->
|
47
|
+
</link>
|
48
|
+
<link
|
49
|
+
name="link_1">
|
50
|
+
<inertial>
|
51
|
+
<origin
|
52
|
+
xyz="0.00546148702076507 0.10467880012529 -0.0820307590787204"
|
53
|
+
rpy="0 0 0" />
|
54
|
+
<mass
|
55
|
+
value="0.0421762252650754" />
|
56
|
+
<inertia
|
57
|
+
ixx="1.09781766802375E-05"
|
58
|
+
ixy="4.40820563321132E-09"
|
59
|
+
ixz="5.24547826280305E-09"
|
60
|
+
iyy="6.35571344051651E-06"
|
61
|
+
iyz="-2.55439306832928E-07"
|
62
|
+
izz="9.91180823538587E-06" />
|
63
|
+
</inertial>
|
64
|
+
<visual name="link_1_motor">
|
65
|
+
<origin
|
66
|
+
xyz="0 0 0"
|
67
|
+
rpy="1.570796327 0 0" />
|
68
|
+
<geometry>
|
69
|
+
<mesh
|
70
|
+
filename="package://koch/meshes/link_1_motor.glb" />
|
71
|
+
</geometry>
|
72
|
+
<material
|
73
|
+
name="motor">
|
74
|
+
</material>
|
75
|
+
</visual>
|
76
|
+
<collision>
|
77
|
+
<origin
|
78
|
+
xyz="0 0 0"
|
79
|
+
rpy="0 0 0" />
|
80
|
+
<geometry>
|
81
|
+
<mesh
|
82
|
+
filename="package://koch/meshes/link_1.stl" />
|
83
|
+
</geometry>
|
84
|
+
</collision>
|
85
|
+
</link>
|
86
|
+
<joint
|
87
|
+
name="fixed_joint"
|
88
|
+
type="fixed">
|
89
|
+
<origin
|
90
|
+
xyz="0.0005 -0.056 0.021"
|
91
|
+
rpy="0 0 0" />
|
92
|
+
<parent
|
93
|
+
link="base_link" />
|
94
|
+
<child
|
95
|
+
link="link_1" />
|
96
|
+
<axis
|
97
|
+
xyz="0 0 0" />
|
98
|
+
</joint>
|
99
|
+
<link
|
100
|
+
name="link_2">
|
101
|
+
<inertial>
|
102
|
+
<origin
|
103
|
+
xyz="-0.000599521251599892 -0.01214448812913 -0.0162228482755552"
|
104
|
+
rpy="0 0 0" />
|
105
|
+
<mass
|
106
|
+
value="0.0490602741822512" />
|
107
|
+
<inertia
|
108
|
+
ixx="1.23060578065707E-05"
|
109
|
+
ixy="2.48969011965324E-07"
|
110
|
+
ixz="-5.07587890385691E-09"
|
111
|
+
iyy="7.57948440389379E-06"
|
112
|
+
iyz="2.79698372869455E-08"
|
113
|
+
izz="1.44673534182408E-05" />
|
114
|
+
</inertial>
|
115
|
+
<visual name="link_2_chassis">
|
116
|
+
<origin
|
117
|
+
xyz="0 0 0"
|
118
|
+
rpy="1.570796327 0 0" />
|
119
|
+
<geometry>
|
120
|
+
<mesh
|
121
|
+
filename="package://koch/meshes/link_2_rotation_connector.glb" />
|
122
|
+
</geometry>
|
123
|
+
<material
|
124
|
+
name="white">
|
125
|
+
</material>
|
126
|
+
</visual>
|
127
|
+
<collision>
|
128
|
+
<origin
|
129
|
+
xyz="0 0 0"
|
130
|
+
rpy="1.570796327 0 0" />
|
131
|
+
<geometry>
|
132
|
+
<mesh
|
133
|
+
filename="package://koch/meshes/link_2_collision_chassis.glb" />
|
134
|
+
</geometry>
|
135
|
+
</collision>
|
136
|
+
<visual name="link_2_motor">
|
137
|
+
<origin
|
138
|
+
xyz="0 0 0"
|
139
|
+
rpy="1.570796327 0 0" />
|
140
|
+
<geometry>
|
141
|
+
<mesh
|
142
|
+
filename="package://koch/meshes/link_2_motor.glb" />
|
143
|
+
</geometry>
|
144
|
+
</visual>
|
145
|
+
<collision>
|
146
|
+
<origin
|
147
|
+
xyz="0 0 0"
|
148
|
+
rpy="1.570796327 0 0" />
|
149
|
+
<geometry>
|
150
|
+
<mesh
|
151
|
+
filename="package://koch/meshes/link_2_collision_motor.glb" />
|
152
|
+
</geometry>
|
153
|
+
</collision>
|
154
|
+
</link>
|
155
|
+
<joint
|
156
|
+
name="joint_1"
|
157
|
+
type="revolute">
|
158
|
+
<origin
|
159
|
+
xyz="0 -0.011858 0.020066"
|
160
|
+
rpy="0 0 0" />
|
161
|
+
<parent
|
162
|
+
link="link_1" />
|
163
|
+
<child
|
164
|
+
link="link_2" />
|
165
|
+
<axis
|
166
|
+
xyz="0 0 -1" />
|
167
|
+
<limit lower="-3.14159" upper="3.14159"/>
|
168
|
+
</joint>
|
169
|
+
<link
|
170
|
+
name="link_3">
|
171
|
+
<inertial>
|
172
|
+
<origin
|
173
|
+
xyz="0.000421340473778738 0.00663235728724902 0.0711027578821964"
|
174
|
+
rpy="0 0 0" />
|
175
|
+
<mass
|
176
|
+
value="0.0495780944252854" />
|
177
|
+
<inertia
|
178
|
+
ixx="3.37548285934918E-05"
|
179
|
+
ixy="-2.64464028650966E-09"
|
180
|
+
ixz="1.18369553327327E-10"
|
181
|
+
iyy="3.70078130346226E-05"
|
182
|
+
iyz="2.89589344417314E-06"
|
183
|
+
izz="8.227755425135E-06" />
|
184
|
+
</inertial>
|
185
|
+
<visual name="link_3_motor">
|
186
|
+
<origin
|
187
|
+
xyz="0 0 0"
|
188
|
+
rpy="1.570796327 0 0" />
|
189
|
+
<geometry>
|
190
|
+
<mesh
|
191
|
+
filename="package://koch/meshes/link_3_motor.glb" />
|
192
|
+
</geometry>
|
193
|
+
</visual>
|
194
|
+
<collision>
|
195
|
+
<origin
|
196
|
+
xyz="0 0 0"
|
197
|
+
rpy="1.570796327 0 0" />
|
198
|
+
<geometry>
|
199
|
+
<mesh
|
200
|
+
filename="package://koch/meshes/link_3_collision_motor.glb" />
|
201
|
+
</geometry>
|
202
|
+
</collision>
|
203
|
+
<visual name="link_3_chassis">
|
204
|
+
<origin
|
205
|
+
xyz="0 0 0"
|
206
|
+
rpy="1.570796327 0 0" />
|
207
|
+
<geometry>
|
208
|
+
<mesh
|
209
|
+
filename="package://koch/meshes/link_3_part.glb" />
|
210
|
+
</geometry>
|
211
|
+
<material name="white">
|
212
|
+
</material>
|
213
|
+
</visual>
|
214
|
+
<collision>
|
215
|
+
<origin
|
216
|
+
xyz="0 0 0"
|
217
|
+
rpy="1.570796327 0 0" />
|
218
|
+
<geometry>
|
219
|
+
<mesh
|
220
|
+
filename="package://koch/meshes/link_3_collision_chassis_part_1.glb" />
|
221
|
+
</geometry>
|
222
|
+
</collision>
|
223
|
+
<collision>
|
224
|
+
<origin
|
225
|
+
xyz="0 0 0"
|
226
|
+
rpy="1.570796327 0 0" />
|
227
|
+
<geometry>
|
228
|
+
<mesh
|
229
|
+
filename="package://koch/meshes/link_3_collision_chassis_part_2.glb" />
|
230
|
+
</geometry>
|
231
|
+
</collision>
|
232
|
+
<collision>
|
233
|
+
<origin
|
234
|
+
xyz="0 0 0"
|
235
|
+
rpy="1.570796327 0 0" />
|
236
|
+
<geometry>
|
237
|
+
<mesh
|
238
|
+
filename="package://koch/meshes/link_3_collision_chassis_part_3.glb" />
|
239
|
+
</geometry>
|
240
|
+
</collision>
|
241
|
+
<collision>
|
242
|
+
<origin
|
243
|
+
xyz="0 0 0"
|
244
|
+
rpy="1.570796327 0 0" />
|
245
|
+
<geometry>
|
246
|
+
<mesh
|
247
|
+
filename="package://koch/meshes/link_3_collision_chassis_part_4.glb" />
|
248
|
+
</geometry>
|
249
|
+
</collision>
|
250
|
+
<collision>
|
251
|
+
<origin
|
252
|
+
xyz="0 0 0"
|
253
|
+
rpy="1.570796327 0 0" />
|
254
|
+
<geometry>
|
255
|
+
<mesh
|
256
|
+
filename="package://koch/meshes/link_3_collision_chassis_part_5.glb" />
|
257
|
+
</geometry>
|
258
|
+
</collision>
|
259
|
+
</link>
|
260
|
+
<joint
|
261
|
+
name="joint_2"
|
262
|
+
type="revolute">
|
263
|
+
<origin
|
264
|
+
xyz="0.020713 0 0.015368"
|
265
|
+
rpy="1.5707963 0 0" />
|
266
|
+
<parent
|
267
|
+
link="link_2" />
|
268
|
+
<child
|
269
|
+
link="link_3" />
|
270
|
+
<axis
|
271
|
+
xyz="-1 0 0" />
|
272
|
+
<limit lower="0" upper="2.2"/>
|
273
|
+
</joint>
|
274
|
+
<link
|
275
|
+
name="link_4">
|
276
|
+
<inertial>
|
277
|
+
<origin
|
278
|
+
xyz="-0.000473888588224017 -0.0549425500579234 0.00286748944029759"
|
279
|
+
rpy="0 0 0" />
|
280
|
+
<mass
|
281
|
+
value="0.0631912511759639" />
|
282
|
+
<inertia
|
283
|
+
ixx="2.22133857277613E-05"
|
284
|
+
ixy="-2.60725068002433E-09"
|
285
|
+
ixz="-9.83232693502075E-11"
|
286
|
+
iyy="7.3328440154108E-06"
|
287
|
+
iyz="1.89503580542288E-07"
|
288
|
+
izz="2.44964228707391E-05" />
|
289
|
+
</inertial>
|
290
|
+
<visual name="link_4_chassis">
|
291
|
+
<origin
|
292
|
+
xyz="0 0 0"
|
293
|
+
rpy="1.570796327 0 0" />
|
294
|
+
<geometry>
|
295
|
+
<mesh
|
296
|
+
filename="package://koch/meshes/link_4_part.glb" />
|
297
|
+
</geometry>
|
298
|
+
<material
|
299
|
+
name="white">
|
300
|
+
</material>
|
301
|
+
</visual>
|
302
|
+
<collision>
|
303
|
+
<origin
|
304
|
+
xyz="0 0 0"
|
305
|
+
rpy="1.570796327 0 0" />
|
306
|
+
<geometry>
|
307
|
+
<mesh
|
308
|
+
filename="package://koch/meshes/link_4_collision_chassis_part_1.glb" />
|
309
|
+
</geometry>
|
310
|
+
</collision>
|
311
|
+
<collision>
|
312
|
+
<origin
|
313
|
+
xyz="0 0 0"
|
314
|
+
rpy="1.570796327 0 0" />
|
315
|
+
<geometry>
|
316
|
+
<mesh
|
317
|
+
filename="package://koch/meshes/link_4_collision_chassis_part_2.glb" />
|
318
|
+
</geometry>
|
319
|
+
</collision>
|
320
|
+
<collision>
|
321
|
+
<origin
|
322
|
+
xyz="0 0 0"
|
323
|
+
rpy="1.570796327 0 0" />
|
324
|
+
<geometry>
|
325
|
+
<mesh
|
326
|
+
filename="package://koch/meshes/link_4_collision_chassis_part_3.glb" />
|
327
|
+
</geometry>
|
328
|
+
</collision>
|
329
|
+
<visual name="link_4_motor">
|
330
|
+
<origin
|
331
|
+
xyz="0 0 0"
|
332
|
+
rpy="1.570796327 0 0" />
|
333
|
+
<geometry>
|
334
|
+
<mesh
|
335
|
+
filename="package://koch/meshes/link_4_motor.glb" />
|
336
|
+
</geometry>
|
337
|
+
</visual>
|
338
|
+
<collision>
|
339
|
+
<origin
|
340
|
+
xyz="0 0 0"
|
341
|
+
rpy="1.570796327 0 0" />
|
342
|
+
<geometry>
|
343
|
+
<mesh
|
344
|
+
filename="package://koch/meshes/link_4_collision_motor.glb" />
|
345
|
+
</geometry>
|
346
|
+
</collision>
|
347
|
+
</link>
|
348
|
+
<joint
|
349
|
+
name="joint_3"
|
350
|
+
type="revolute">
|
351
|
+
<origin
|
352
|
+
xyz="-0.038026 -0.014951 0.108424"
|
353
|
+
rpy="-1.5707963 0 0" />
|
354
|
+
<parent
|
355
|
+
link="link_3" />
|
356
|
+
<child
|
357
|
+
link="link_4" />
|
358
|
+
<axis
|
359
|
+
xyz="1 0 0" />
|
360
|
+
<!-- <limit lower="-3.14159" upper="3.14159"/> -->
|
361
|
+
<limit lower="0" upper="3.05"/>
|
362
|
+
</joint>
|
363
|
+
<link
|
364
|
+
name="link_5">
|
365
|
+
<inertial>
|
366
|
+
<origin
|
367
|
+
xyz="0.00504501747147962 -9.06142822537648E-06 -0.0325201529652048"
|
368
|
+
rpy="0 0 0" />
|
369
|
+
<mass
|
370
|
+
value="0.0198049389956388" />
|
371
|
+
<inertia
|
372
|
+
ixx="1.07826423329981E-06"
|
373
|
+
ixy="1.37634813783634E-09"
|
374
|
+
ixz="2.83021319815508E-08"
|
375
|
+
iyy="2.87586796432686E-06"
|
376
|
+
iyz="-1.33100790895479E-10"
|
377
|
+
izz="2.95769278459524E-06" />
|
378
|
+
</inertial>
|
379
|
+
<visual name="link_5_chassis">
|
380
|
+
<origin
|
381
|
+
xyz="0 0 0"
|
382
|
+
rpy="1.570796327 0 0" />
|
383
|
+
<geometry>
|
384
|
+
<mesh
|
385
|
+
filename="package://koch/meshes/link_5_part.glb" />
|
386
|
+
</geometry>
|
387
|
+
<material
|
388
|
+
name="white">
|
389
|
+
</material>
|
390
|
+
</visual>
|
391
|
+
<visual name="link_5_motor">
|
392
|
+
<origin
|
393
|
+
xyz="0 0 0"
|
394
|
+
rpy="1.570796327 0 0" />
|
395
|
+
<geometry>
|
396
|
+
<mesh
|
397
|
+
filename="package://koch/meshes/link_5_motor.glb" />
|
398
|
+
</geometry>
|
399
|
+
</visual>
|
400
|
+
<collision>
|
401
|
+
<origin
|
402
|
+
xyz="0 0 0"
|
403
|
+
rpy="0 0 0" />
|
404
|
+
<geometry>
|
405
|
+
<mesh
|
406
|
+
filename="package://koch/meshes/link_5.stl" />
|
407
|
+
</geometry>
|
408
|
+
</collision>
|
409
|
+
</link>
|
410
|
+
<joint
|
411
|
+
name="joint_4"
|
412
|
+
type="revolute">
|
413
|
+
<origin
|
414
|
+
xyz="-0.000251 -0.100502 0.002641"
|
415
|
+
rpy="-1.5707963 0 0" />
|
416
|
+
<parent
|
417
|
+
link="link_4" />
|
418
|
+
<child
|
419
|
+
link="link_5" />
|
420
|
+
<axis
|
421
|
+
xyz="1 0 0" />
|
422
|
+
<!-- <limit lower="-3.14159" upper="3.14159"/> -->
|
423
|
+
<limit lower="-1.5" upper="2.14159"/>
|
424
|
+
</joint>
|
425
|
+
<link
|
426
|
+
name="link_6">
|
427
|
+
<inertial>
|
428
|
+
<origin
|
429
|
+
xyz="0.0083776132652086 0.221509253380248 -0.000322123870656721"
|
430
|
+
rpy="0 0 0" />
|
431
|
+
<mass
|
432
|
+
value="0.0286782121965461" />
|
433
|
+
<inertia
|
434
|
+
ixx="6.8235194033342E-06"
|
435
|
+
ixy="-2.84299175040268E-09"
|
436
|
+
ixz="1.06006884589027E-06"
|
437
|
+
iyy="8.09477227096767E-06"
|
438
|
+
iyz="4.61842210237313E-08"
|
439
|
+
izz="3.58058771769467E-06" />
|
440
|
+
</inertial>
|
441
|
+
<visual name="link_6_chassis">
|
442
|
+
<origin
|
443
|
+
xyz="0 0 0"
|
444
|
+
rpy="1.570796327 0 0" />
|
445
|
+
<geometry>
|
446
|
+
<mesh
|
447
|
+
filename="package://koch/meshes/link_6_part.glb" />
|
448
|
+
</geometry>
|
449
|
+
<material
|
450
|
+
name="white">
|
451
|
+
</material>
|
452
|
+
</visual>
|
453
|
+
<visual name="link_6_motor">
|
454
|
+
<origin
|
455
|
+
xyz="0 0 0"
|
456
|
+
rpy="1.570796327 0 0" />
|
457
|
+
<geometry>
|
458
|
+
<mesh
|
459
|
+
filename="package://koch/meshes/link_6_motor.glb" />
|
460
|
+
</geometry>
|
461
|
+
</visual>
|
462
|
+
<collision>
|
463
|
+
<origin
|
464
|
+
xyz="-0.01488 0.000177 -0.017179"
|
465
|
+
rpy="0 0 0" />
|
466
|
+
<geometry>
|
467
|
+
<box size="0.011 0.0295 0.0344" />
|
468
|
+
</geometry>
|
469
|
+
</collision>
|
470
|
+
<collision>
|
471
|
+
<origin
|
472
|
+
xyz="-0.015958 0.000027 -0.040602"
|
473
|
+
rpy="1.570796327 0 0" />
|
474
|
+
<geometry>
|
475
|
+
<mesh
|
476
|
+
filename="package://koch/meshes/link_6_collision_part_2.glb" />
|
477
|
+
</geometry>
|
478
|
+
</collision>
|
479
|
+
<collision>
|
480
|
+
<origin
|
481
|
+
xyz="-0.015268 -0.000307 -0.05429"
|
482
|
+
rpy="1.570796327 0 0" />
|
483
|
+
<geometry>
|
484
|
+
<mesh
|
485
|
+
filename="package://koch/meshes/link_6_collision_part_3.glb" />
|
486
|
+
</geometry>
|
487
|
+
</collision>
|
488
|
+
<collision>
|
489
|
+
<origin
|
490
|
+
xyz="0 0 0 "
|
491
|
+
rpy="1.570796327 0 0" />
|
492
|
+
<geometry>
|
493
|
+
<mesh
|
494
|
+
filename="package://koch/meshes/link_6_collision_part_4.glb" />
|
495
|
+
</geometry>
|
496
|
+
</collision>
|
497
|
+
<!-- <collision>
|
498
|
+
<origin
|
499
|
+
xyz="0 0 0"
|
500
|
+
rpy="0 0 0" />
|
501
|
+
<geometry>
|
502
|
+
<mesh
|
503
|
+
filename="package://koch/meshes/link_6.stl" />
|
504
|
+
</geometry>
|
505
|
+
</collision> -->
|
506
|
+
</link>
|
507
|
+
<joint
|
508
|
+
name="joint_5"
|
509
|
+
type="revolute">
|
510
|
+
<origin
|
511
|
+
xyz="0.019234 0.00037 -0.044779"
|
512
|
+
rpy="0 0 -1.5707963" />
|
513
|
+
<parent
|
514
|
+
link="link_5" />
|
515
|
+
<child
|
516
|
+
link="link_6" />
|
517
|
+
<axis
|
518
|
+
xyz="0 0 -1" />
|
519
|
+
<limit lower="-3.14159" upper="3.14159"/>
|
520
|
+
</joint>
|
521
|
+
<link
|
522
|
+
name="gripper">
|
523
|
+
<inertial>
|
524
|
+
<origin
|
525
|
+
xyz="0.0010818 0.032382 -0.019069"
|
526
|
+
rpy="0 0 0" />
|
527
|
+
<mass
|
528
|
+
value="0.012831" />
|
529
|
+
<inertia
|
530
|
+
ixx="3.449E-06"
|
531
|
+
ixy="-3.8704E-09"
|
532
|
+
ixz="3.156E-07"
|
533
|
+
iyy="2.4565E-06"
|
534
|
+
iyz="3.4089E-08"
|
535
|
+
izz="1.5159E-06" />
|
536
|
+
</inertial>
|
537
|
+
<visual name="gripper_chassis">
|
538
|
+
<origin
|
539
|
+
xyz="0 0 0"
|
540
|
+
rpy="1.570796327 0 0" />
|
541
|
+
<geometry>
|
542
|
+
<mesh
|
543
|
+
filename="package://koch/meshes/gripper.glb" />
|
544
|
+
</geometry>
|
545
|
+
<material
|
546
|
+
name="white">
|
547
|
+
</material>
|
548
|
+
</visual>
|
549
|
+
<collision>
|
550
|
+
<origin
|
551
|
+
xyz="0 0 0"
|
552
|
+
rpy="1.570796327 0 0" />
|
553
|
+
<geometry>
|
554
|
+
<mesh
|
555
|
+
filename="package://koch/meshes/gripper_collision_part_1.glb" />
|
556
|
+
</geometry>
|
557
|
+
</collision>
|
558
|
+
<collision>
|
559
|
+
<origin
|
560
|
+
xyz="0 0 0"
|
561
|
+
rpy="1.570796327 0 0" />
|
562
|
+
<geometry>
|
563
|
+
<mesh
|
564
|
+
filename="package://koch/meshes/gripper_collision_part_2.glb" />
|
565
|
+
</geometry>
|
566
|
+
</collision>
|
567
|
+
<collision>
|
568
|
+
<origin
|
569
|
+
xyz="0 0 0"
|
570
|
+
rpy="1.570796327 0 0" />
|
571
|
+
<geometry>
|
572
|
+
<mesh
|
573
|
+
filename="package://koch/meshes/gripper_collision_part_3.glb" />
|
574
|
+
</geometry>
|
575
|
+
</collision>
|
576
|
+
<!-- <collision>
|
577
|
+
<origin
|
578
|
+
xyz="0 0 0"
|
579
|
+
rpy="0 0 0" />
|
580
|
+
<geometry>
|
581
|
+
<mesh
|
582
|
+
filename="package://koch/meshes/gripper_collision.glb" />
|
583
|
+
</geometry>
|
584
|
+
</collision> -->
|
585
|
+
</link>
|
586
|
+
<joint
|
587
|
+
name="joint_6"
|
588
|
+
type="revolute">
|
589
|
+
<origin
|
590
|
+
xyz="0.007429 -0.017441 -0.013336"
|
591
|
+
rpy="0 0 0" />
|
592
|
+
<parent
|
593
|
+
link="link_6" />
|
594
|
+
<child
|
595
|
+
link="gripper" />
|
596
|
+
<axis
|
597
|
+
xyz="0 -1 0" />
|
598
|
+
<limit lower="0" upper="1.6"/>
|
599
|
+
</joint>
|
600
|
+
<!-- Define the hand_tcp frame -->
|
601
|
+
<link name="gripper_tcp"/>
|
602
|
+
<joint name="gripper_tcp_joint" type="fixed">
|
603
|
+
<origin rpy="0 0 0" xyz="-0.008 0 -0.065"/>
|
604
|
+
<parent link="link_6"/>
|
605
|
+
<child link="gripper_tcp"/>
|
606
|
+
</joint>
|
607
|
+
|
608
|
+
<link name="gripper_tcp2"/>
|
609
|
+
<joint name="gripper_tcp_joint2" type="fixed">
|
610
|
+
<origin rpy="0 0 0" xyz="-0.0135 0.0172 -0.0514"/>
|
611
|
+
<parent link="gripper"/>
|
612
|
+
<child link="gripper_tcp2"/>
|
613
|
+
</joint>
|
614
|
+
|
615
|
+
|
616
|
+
<link name="back_tcp"/>
|
617
|
+
<joint name="back_tcp_joint" type="fixed">
|
618
|
+
<origin rpy="0 0 0" xyz="-0.00 0 -0.023"/>
|
619
|
+
<parent link="link_6"/>
|
620
|
+
<child link="back_tcp"/>
|
621
|
+
</joint>
|
622
|
+
<!-- <link name="gripper_tcp"/>
|
623
|
+
<joint name="gripper_tcp_joint" type="fixed">
|
624
|
+
<origin rpy="0 0 0" xyz="-0.011337 0 -0.05574"/>
|
625
|
+
<parent link="link_6"/>
|
626
|
+
<child link="gripper_tcp"/>
|
627
|
+
</joint>
|
628
|
+
|
629
|
+
<link name="gripper_tcp2"/>
|
630
|
+
<joint name="gripper_tcp_joint2" type="fixed">
|
631
|
+
<origin rpy="0 0 0" xyz="-0.010505 0.017151 -0.041535"/>
|
632
|
+
<parent link="gripper"/>
|
633
|
+
<child link="gripper_tcp2"/>
|
634
|
+
</joint> -->
|
635
|
+
</robot>
|
Binary file
|
Binary file
|
Binary file
|
Binary file
|
Binary file
|
Binary file
|
Binary file
|
Binary file
|
Binary file
|
Binary file
|
Binary file
|
Binary file
|
Binary file
|
Binary file
|
Binary file
|
Binary file
|
Binary file
|
Binary file
|
Binary file
|
Binary file
|
Binary file
|
Binary file
|
Binary file
|
Binary file
|
Binary file
|