1- <mujoco model =" umi_model" >
1+ <mujoco model =" umi_gripper" >
2+ <compiler angle =" radian" meshdir =" assets" texturedir =" assets" />
23
3- <compiler angle =" radian" meshdir =" assets/" texturedir =" assets/" />
4-
5- <!-- Simulation Options -->
6- <option integrator =" implicitfast" impratio =" 1" cone =" elliptic" noslip_iterations =" 2" >
4+ <option integrator =" implicitfast" impratio =" 10" cone =" elliptic" noslip_iterations =" 2" >
75 <flag multiccd =" enable" />
86 </option >
97
10- <!-- Assets -->
118 <asset >
12- <mesh name =" base_link" file =" base_link.STL " />
13- <mesh name =" finger_holder_left " file =" finger_holder_left.STL " />
14- <mesh name =" finger_left " file =" finger_left.STL " />
15- <mesh name =" finger_holder_right " file =" finger_holder_right.STL " />
16- <mesh name =" finger_right " file =" finger_right.STL " />
17- <mesh name =" gopro" file =" gopro.STL " />
18- < material name = " mirror " rgba = " 0 0 0 1 " texrepeat = " 5 5 " reflectance = " 1.0 " />
9+ <mesh name =" base_link" file =" base_link.stl " />
10+ <mesh name =" left_finger_holder " file =" left_finger_holder.stl " />
11+ <mesh name =" left_finger " file =" left_finger.stl " />
12+ <mesh name =" right_finger_holder " file =" right_finger_holder.stl " />
13+ <mesh name =" right_finger " file =" right_finger.stl " />
14+ <mesh name =" gopro" file =" gopro.stl " />
15+
1916 <texture name =" right_aruco_sticker" type =" 2d" file =" right_aruco_sticker.png" />
2017 <texture name =" left_aruco_sticker" type =" 2d" file =" left_aruco_sticker.png" />
21- <material name =" Aruco_Right_Base_Sticker" texture =" right_aruco_sticker" />
22- <material name =" Aruco_Left_Base_Sticker" texture =" left_aruco_sticker" />
18+ <material name =" Right_Aruco_Base_Sticker" texture =" right_aruco_sticker" />
19+ <material name =" Left_Aruco_Base_Sticker" texture =" left_aruco_sticker" />
20+
21+ <material name =" mirror" rgba =" 0 0 0 1" texrepeat =" 5 5" reflectance =" 1.0" />
22+ <material name =" white" rgba =" 1 1 1 1" />
23+ <material name =" gray" rgba =" 0.15 0.15 0.15 1" />
24+ <material name =" light_gray" rgba =" 0.6 0.6 0.6 1" />
25+ <material name =" orange" rgba =" 0.92 0.68 0.24 1" />
26+ <material name =" black" rgba =" 0 0 0 1" />
2327 </asset >
2428
25- <!-- Default settings -->
2629 <default >
27- <default class =" umi_model" >
28- <!-- Joint Defaults -->
30+ <default class =" umi_gripper" >
2931 <joint frictionloss =" 0.1" armature =" 0.1" />
32+ <position kp =" 1000" />
33+
34+ <default class =" screw" >
35+ <geom type =" cylinder" size =" 0.0035 0.0035 0.01" material =" black" contype =" 0" conaffinity =" 0" />
36+ </default >
3037
31- <!-- Gripper Joints -->
3238 <default class =" gripper_slide" >
3339 <joint type =" slide" damping =" 0.1" range =" -1.2 1.2" />
3440 <position kp =" 100" dampratio =" 1" ctrlrange =" -1.2 1.2" />
3743 <joint type =" hinge" damping =" 10.1" range =" -31.415 31.415" />
3844 <position kp =" 10" dampratio =" 0.1" ctrlrange =" -3.1415 3.1415" />
3945 </default >
40-
41- <!-- Finger Joints -->
4246 <default class =" finger_slide" >
4347 <joint type =" slide" stiffness =" 100" damping =" 10.1" range =" 0 0.05" />
4448 </default >
4549
46- <!-- Actuator Defaults -->
47- <position kp =" 1000" />
4850 <default class =" finger_actuator" >
4951 <position ctrlrange =" 0 0.05" />
5052 </default >
5557 <position kp =" 10" dampratio =" 0.1" ctrlrange =" -3.1415 3.1415" />
5658 </default >
5759
58- <!-- Geom Defaults -->
60+ <default class =" visual" >
61+ <geom type =" mesh" contype =" 0" conaffinity =" 0" density =" 0" group =" 2" />
62+ </default >
63+ <default class =" collision" >
64+ <geom type =" mesh" group =" 3" />
65+ </default >
66+
5967 <default class =" marker" >
60- <geom type =" box" size =" 0.009 0.009 0.00001" euler = " 0 0 0 " rgba = " 1 1 1 1 " contype =" 0" conaffinity =" 0" mass =" 0.0" />
68+ <geom type =" box" size =" 0.009 0.009 0.00001" material = " white " contype =" 0" conaffinity =" 0" mass =" 0.0" />
6169 </default >
6270 <default class =" finger_holder_geom" >
63- <geom type =" mesh" contype =" 0" conaffinity =" 0" group =" 1" density =" 0" rgba = " 1 1 1 1 " />
71+ <geom type =" mesh" contype =" 0" conaffinity =" 0" group =" 1" density =" 0" material = " white " />
6472 </default >
6573
6674 </default >
6775 </default >
6876
6977 <worldbody >
78+ <body quat =" -1 1 0 0" >
7079
71- <body pos =' 0 0 0' euler =" -1.571 0 0" >
72-
73- <body name =" camera" pos =" 0 -0.092 0.005" euler =" 3.14 0 0.0" >
74- <camera name =" top_camera" mode =" fixed" fovy =" 145" />
75- </body >
80+ <!-- Gripper Camera -->
81+ <camera name =" gripper_gopro" pos =" 0 -0.092 0.04" quat =" 0 1 0 0" mode =" fixed" fovy =" 155" />
7682
7783 <!-- Positional Joints -->
7884 <joint name =" gripper_joint_x" axis =" 1 0 0" class =" gripper_slide" />
8490 <joint name =" gripper_joint_ry" axis =" 0 0 1" class =" gripper_hinge" />
8591 <joint name =" gripper_joint_rz" axis =" 0 -1 0" class =" gripper_hinge" />
8692
93+ <!-- Linear Rail -->
94+ <geom name =" linear_guide_rail" type =" box" pos =" 0 -0.002 0.062" size =" 0.08 0.003 0.004" material =" light_gray"
95+ class =" visual" />
96+
8797 <!-- Mirrors -->
88- <geom name =" left_mirror" type =" box" pos =" -0.069 -0.057 0.04" size =" 0.03 0.0187 0.0001" euler =" 0 1.19 0"
89- rgba = " 0 0 0 1 " material =" mirror" contype = " 0 " conaffinity = " 0 " />
90- <geom name =" right_mirror" type =" box" pos =" 0.069 -0.057 0.04" size =" 0.03 0.0187 0.0001" euler =" 0 -1.19 0"
91- rgba = " 0 0 0 1 " material =" mirror" contype = " 0 " conaffinity = " 0 " />
98+ <geom name =" left_mirror" type =" box" pos =" -0.069 -0.057 0.04" size =" 0.03 0.0187 0.0001" quat =" 0.828 0 0.5605 0"
99+ material =" mirror" class = " visual " />
100+ <geom name =" right_mirror" type =" box" pos =" 0.069 -0.057 0.04" size =" 0.03 0.0187 0.0001" quat =" 0.828 0 -0.5605 0"
101+ material =" mirror" class = " visual " />
92102
93103 <!-- Base Link -->
94- <geom type =" mesh" rgba =" 1 1 1 1" mesh =" base_link" />
104+ <geom mesh =" base_link" class =" visual" material =" white" />
105+ <geom mesh =" base_link" class =" collision" />
106+ <geom name =" left_center_base_screw" pos =" -0.076 -0.018 0.036" quat =" -1 1 0 0" class =" screw" />
107+ <geom name =" right_center_base_screw" pos =" 0.076 -0.018 0.036" quat =" -1 1 0 0" class =" screw" />
108+ <geom name =" left_back_base_screw" pos =" -0.0137 -0.018 -0.018" quat =" -1 1 0 0" class =" screw" />
109+ <geom name =" right_back_base_screw" pos =" 0.0137 -0.018 -0.018" quat =" -1 1 0 0" class =" screw" />
95110
96111 <!-- GoPro Camera -->
97- <geom pos =" 0.01965 -0.07875 -0.0187" quat =" 0 0 -0.707108 0.707105" type =" mesh" rgba =" 0.2 0.2 0.2 1" mesh =" gopro" />
112+ <geom pos =" 0.01965 -0.07875 -0.0187" quat =" 0 0 -1 1" mesh =" gopro" class =" visual" material =" gray" />
113+ <geom pos =" 0.01965 -0.07875 -0.0187" quat =" 0 0 -1 1" mesh =" gopro" class =" collision" />
98114
99115 <!-- Left Finger -->
100- <body name =" finger_holder_left" quat =" 0.707105 0.707108 0 0" >
101- <geom name =" left_marker" pos =" -0.062 0.088 0.0164" material =" Aruco_Left_Base_Sticker" class =" marker" />
116+ <body name =" left_finger_holder" quat =" 1 1 0 0" >
117+ <geom name =" left_screw_back_outside" pos =" -0.0515 0.07 0.012" class =" screw" />
118+ <geom name =" left_screw_back_inside" pos =" -0.0615 0.07 0.012" class =" screw" />
119+ <geom name =" left_screw_middle_outside" pos =" -0.0768 0.0835 0.012" class =" screw" />
120+ <geom name =" left_screw_middle_inside" pos =" -0.047 0.0835 0.012" class =" screw" />
121+ <geom name =" left_screw_front" pos =" -0.0764 0.119 0.012" class =" screw" />
122+ <geom name =" left_rail_block" type =" box" pos =" -0.051 0.063 0.006" size =" 0.009 0.012 0.004" material =" gray"
123+ class =" visual" />
124+ <geom name =" left_marker" pos =" -0.062 0.088 0.0164" material =" Left_Aruco_Base_Sticker" class =" marker" />
102125 <inertial pos =" -0.0613355 0.104073 -0.0013157" quat =" 0.49913 0.411547 -0.543302 0.53509" mass =" 0.080081"
103126 diaginertia =" 0.000104597 0.000102992 1.90532e-05" />
104- <joint name =" finger_left_joint" pos =" 0 0 0" axis =" 1 0 0" class =" finger_slide" />
105- <geom mesh =" finger_holder_left" class =" finger_holder_geom" />
106- <geom pos =" -0.041722 0.0779 -0.0159" quat =" 0 0 -0.707108 0.707105" type =" mesh"
107- rgba =" 0.92156862745 0.67843137254 0.235 1" mesh =" finger_left" />
127+ <joint name =" left_finger_joint" axis =" 1 0 0" class =" finger_slide" />
128+ <geom mesh =" left_finger_holder" class =" visual" material =" white" />
129+ <geom mesh =" left_finger_holder" class =" collision" />
130+ <geom pos =" -0.041722 0.0779 -0.0159" quat =" 0 0 -1 1" mesh =" left_finger" class =" visual" material =" orange" />
131+ <geom pos =" -0.041722 0.0779 -0.0159" quat =" 0 0 -1 1" mesh =" left_finger" class =" collision" />
108132 </body >
109133
110134 <!-- Right Finger -->
111- <body name =" finger_holder_right" quat =" 0.707105 0.707108 0 0" >
112- <geom name =" right_marker" pos =" 0.062 0.088 0.0164" material =" Aruco_Right_Base_Sticker" class =" marker" />
135+ <body name =" right_finger_holder" quat =" 1 1 0 0" >
136+ <geom name =" right_screw_back_outside" pos =" 0.0515 0.07 0.012" class =" screw" />
137+ <geom name =" right_screw_back_inside" pos =" 0.0615 0.07 0.012" class =" screw" />
138+ <geom name =" right_screw_middle_outside" pos =" 0.0764 0.0835 0.012" class =" screw" />
139+ <geom name =" right_screw_middle_inside" pos =" 0.047 0.0835 0.012" class =" screw" />
140+ <geom name =" right_screw_front" pos =" 0.0764 0.119 0.012" class =" screw" />
141+ <geom name =" right_rail_block" type =" box" pos =" 0.051 0.063 0.006" size =" 0.009 0.012 0.004" material =" gray"
142+ class =" visual" />
143+ <geom name =" right_marker" pos =" 0.062 0.088 0.0164" material =" Right_Aruco_Base_Sticker" class =" marker" />
113144 <inertial pos =" 0.0613353 0.104073 -0.00131574" quat =" 0.535092 0.543308 -0.41154 0.499127" mass =" 0.080081"
114145 diaginertia =" 0.000104597 0.000102992 1.90532e-05" />
115- <joint name =" finger_right_joint" pos =" 0 0 0" axis =" -1 0 0" class =" finger_slide" />
116- <geom mesh =" finger_holder_right" class =" finger_holder_geom" />
117- <geom pos =" 0.041722 0.0779 0.0099" quat =" 0.707105 0.707108 0 0" type =" mesh"
118- rgba =" 0.92156862745 0.67843137254 0.235 1" mesh =" finger_right" />
146+ <joint name =" right_finger_joint" axis =" -1 0 0" class =" finger_slide" />
147+ <geom mesh =" right_finger_holder" class =" visual" material =" white" />
148+ <geom mesh =" right_finger_holder" class =" collision" />
149+ <geom pos =" 0.041722 0.0779 0.0099" quat =" 1 1 0 0" mesh =" right_finger" class =" visual" material =" orange" />
150+ <geom pos =" 0.041722 0.0779 0.0099" quat =" 1 1 0 0" mesh =" right_finger" class =" collision" />
119151 </body >
120152
121153 </body >
122154 </worldbody >
123155
124156 <tendon >
125157 <fixed name =" split" >
126- <joint joint =" finger_right_joint " coef =" 0.5" />
127- <joint joint =" finger_left_joint " coef =" 0.5" />
158+ <joint joint =" right_finger_joint " coef =" 0.5" />
159+ <joint joint =" left_finger_joint " coef =" 0.5" />
128160 </fixed >
129161 </tendon >
130162
137169 <position name =" gripper_joint_ry_act" joint =" gripper_joint_ry" class =" gripper_rot_actuator" />
138170 <position name =" gripper_joint_rz_act" joint =" gripper_joint_rz" class =" gripper_rot_actuator" />
139171 </actuator >
140-
141172</mujoco >
0 commit comments