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.
Files changed (91) hide show
  1. mani_skill/agents/base_real_agent.py +202 -0
  2. mani_skill/agents/controllers/base_controller.py +13 -2
  3. mani_skill/agents/controllers/passive_controller.py +2 -0
  4. mani_skill/agents/controllers/pd_joint_pos.py +2 -0
  5. mani_skill/agents/controllers/pd_joint_pos_vel.py +2 -0
  6. mani_skill/agents/controllers/pd_joint_vel.py +2 -0
  7. mani_skill/agents/robots/__init__.py +2 -0
  8. mani_skill/agents/robots/koch/__init__.py +1 -0
  9. mani_skill/agents/robots/koch/koch.py +163 -0
  10. mani_skill/agents/robots/koch/koch_real.py +5 -0
  11. mani_skill/agents/robots/so100/__init__.py +1 -0
  12. mani_skill/agents/robots/so100/so_100.py +118 -0
  13. mani_skill/agents/robots/so100/so_100_real.py +5 -0
  14. mani_skill/assets/robots/koch/LICENSE +507 -0
  15. mani_skill/assets/robots/koch/README.md +8 -0
  16. mani_skill/assets/robots/koch/follower_arm_v1.1.srdf +9 -0
  17. mani_skill/assets/robots/koch/follower_arm_v1.1.urdf +635 -0
  18. mani_skill/assets/robots/koch/meshes/base_link.glb +0 -0
  19. mani_skill/assets/robots/koch/meshes/base_link.stl +0 -0
  20. mani_skill/assets/robots/koch/meshes/centered_base_link.stl +0 -0
  21. mani_skill/assets/robots/koch/meshes/gripper.glb +0 -0
  22. mani_skill/assets/robots/koch/meshes/gripper.stl +0 -0
  23. mani_skill/assets/robots/koch/meshes/gripper_collision_part_1.glb +0 -0
  24. mani_skill/assets/robots/koch/meshes/gripper_collision_part_2.glb +0 -0
  25. mani_skill/assets/robots/koch/meshes/gripper_collision_part_3.glb +0 -0
  26. mani_skill/assets/robots/koch/meshes/link_1.stl +0 -0
  27. mani_skill/assets/robots/koch/meshes/link_1_motor.glb +0 -0
  28. mani_skill/assets/robots/koch/meshes/link_2.stl +0 -0
  29. mani_skill/assets/robots/koch/meshes/link_2_collision_chassis.glb +0 -0
  30. mani_skill/assets/robots/koch/meshes/link_2_collision_motor.glb +0 -0
  31. mani_skill/assets/robots/koch/meshes/link_2_motor.glb +0 -0
  32. mani_skill/assets/robots/koch/meshes/link_2_rotation_connector.glb +0 -0
  33. mani_skill/assets/robots/koch/meshes/link_2_rotation_connector.stl +0 -0
  34. mani_skill/assets/robots/koch/meshes/link_3.stl +0 -0
  35. mani_skill/assets/robots/koch/meshes/link_3_collision_chassis_part_1.glb +0 -0
  36. mani_skill/assets/robots/koch/meshes/link_3_collision_chassis_part_2.glb +0 -0
  37. mani_skill/assets/robots/koch/meshes/link_3_collision_chassis_part_3.glb +0 -0
  38. mani_skill/assets/robots/koch/meshes/link_3_collision_chassis_part_4.glb +0 -0
  39. mani_skill/assets/robots/koch/meshes/link_3_collision_chassis_part_5.glb +0 -0
  40. mani_skill/assets/robots/koch/meshes/link_3_collision_motor.glb +0 -0
  41. mani_skill/assets/robots/koch/meshes/link_3_motor.glb +0 -0
  42. mani_skill/assets/robots/koch/meshes/link_3_motor.stl +0 -0
  43. mani_skill/assets/robots/koch/meshes/link_3_part.glb +0 -0
  44. mani_skill/assets/robots/koch/meshes/link_3_part.stl +0 -0
  45. mani_skill/assets/robots/koch/meshes/link_4.stl +0 -0
  46. mani_skill/assets/robots/koch/meshes/link_4_collision_chassis_part_1.glb +0 -0
  47. mani_skill/assets/robots/koch/meshes/link_4_collision_chassis_part_2.glb +0 -0
  48. mani_skill/assets/robots/koch/meshes/link_4_collision_chassis_part_3.glb +0 -0
  49. mani_skill/assets/robots/koch/meshes/link_4_collision_motor.glb +0 -0
  50. mani_skill/assets/robots/koch/meshes/link_4_motor.glb +0 -0
  51. mani_skill/assets/robots/koch/meshes/link_4_part.glb +0 -0
  52. mani_skill/assets/robots/koch/meshes/link_5.stl +0 -0
  53. mani_skill/assets/robots/koch/meshes/link_5_motor.glb +0 -0
  54. mani_skill/assets/robots/koch/meshes/link_5_part.glb +0 -0
  55. mani_skill/assets/robots/koch/meshes/link_6.stl +0 -0
  56. mani_skill/assets/robots/koch/meshes/link_6_collision_part_2.glb +0 -0
  57. mani_skill/assets/robots/koch/meshes/link_6_collision_part_3.glb +0 -0
  58. mani_skill/assets/robots/koch/meshes/link_6_collision_part_4.glb +0 -0
  59. mani_skill/assets/robots/koch/meshes/link_6_motor.glb +0 -0
  60. mani_skill/assets/robots/koch/meshes/link_6_part.glb +0 -0
  61. mani_skill/assets/robots/so100/LICENSE +201 -0
  62. mani_skill/assets/robots/so100/README.md +10 -0
  63. mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Base.STL +0 -0
  64. mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Fixed_Jaw.STL +0 -0
  65. mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Fixed_Jaw_part1.ply +0 -0
  66. mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Fixed_Jaw_part2.ply +0 -0
  67. mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Lower_Arm.STL +0 -0
  68. mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Moving Jaw.STL +0 -0
  69. mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Moving_Jaw_part1.ply +0 -0
  70. mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Moving_Jaw_part2.ply +0 -0
  71. mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Moving_Jaw_part3.ply +0 -0
  72. mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Rotation_Pitch.STL +0 -0
  73. mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Upper_Arm.STL +0 -0
  74. mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/meshes/Wrist_Pitch_Roll.STL +0 -0
  75. mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/original.srdf +8 -0
  76. mani_skill/assets/robots/so100/SO_5DOF_ARM100_8j/original.urdf +470 -0
  77. mani_skill/envs/sapien_env.py +70 -9
  78. mani_skill/envs/sim2real_env.py +381 -0
  79. mani_skill/envs/tasks/digital_twins/base_env.py +74 -74
  80. mani_skill/envs/tasks/digital_twins/bridge_dataset_eval/base_env.py +6 -0
  81. mani_skill/envs/tasks/digital_twins/bridge_dataset_eval/put_on_in_scene.py +14 -1
  82. mani_skill/envs/utils/randomization/__init__.py +1 -0
  83. mani_skill/envs/utils/randomization/camera.py +60 -0
  84. mani_skill/examples/demo_robot.py +1 -0
  85. mani_skill/utils/sapien_utils.py +7 -6
  86. mani_skill/utils/structs/articulation.py +44 -18
  87. {mani_skill_nightly-2025.4.5.444.dist-info → mani_skill_nightly-2025.4.5.2022.dist-info}/METADATA +1 -1
  88. {mani_skill_nightly-2025.4.5.444.dist-info → mani_skill_nightly-2025.4.5.2022.dist-info}/RECORD +91 -19
  89. {mani_skill_nightly-2025.4.5.444.dist-info → mani_skill_nightly-2025.4.5.2022.dist-info}/LICENSE +0 -0
  90. {mani_skill_nightly-2025.4.5.444.dist-info → mani_skill_nightly-2025.4.5.2022.dist-info}/WHEEL +0 -0
  91. {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>