fetch_sim/teleOp_boxes.xml at master · vikashplus/fetch_sim · GitHub

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
<mujoco model="fetch_teleOP(v2.0)">
<!-- =================================================
	Copyright 2016 Vikash Kumar
	Model   :: Fetch (MuJoCoV2.0)
	Author  :: Vikash Kumar (vikashplus@gmail.com)
	Details :: https://github.com/vikashplus/fetch_sim
	License :: Under Apache License, Version 2.0 (the "License"); you may not use this file except in compliance with the License. You may obtain a copy of the License at http://www.apache.org/licenses/LICENSE-2.0 Unless required by applicable law or agreed to in writing, software distributed under the License is distributed on an "AS IS" BASIS, WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the License for the specific language governing permissions and limitations under the License.
====================================================== -©vk©-->
	<include file="../fetch_sim/assets/asset.xml"/>
	<include file="door/asset.xml"/>
	<include file="table/asset.xml"/>
	<asset>
		<texture name="texplane" type="2d" builtin="checker" rgb1=".2 .3 .4" rgb2=".1 0.15 0.2" width="100" height="100"/>
		<material name='MatPlane' reflectance='0.5' texture="texplane" texrepeat="1 1" texuniform="true"/>
		<texture name="texobj" type="cube" file="texture/marble.png"/>
		<material name="geomObj" texture="texobj" specular="0.95" shininess=".03" rgba=".8 .8 .8 1"/>
	</asset>

	<!-- Bind mocap -©vk©-->
	<equality>
		<weld body1="mocap0" body2="gripper_link" solref="0.01 1" solimp=".02 .1 0.050"/>
	</equality>

	<worldbody>

		<geom name='floor' pos='0 0 0' size='10 10 0.125' type='plane' material="MatPlane" condim='3'/>
		<light directional="false" cutoff="35" exponent="10" diffuse=".7 .7 .7" pos="1 -0.2 2.5" dir="-0.4 1 -1.5" specular=".3 .3 .3"/>

		<!--Mocap body for tele-op-©vk©-->
		<body name="mocap0" mocap="true" pos="0.300 1.234 0.786" euler="1.57 0 0">
			<geom type="mesh" mesh="gripper_link" group="2" euler="1.57 0 -1.57" contype="0" conaffinity="0" rgba=".5 .5 .5 0.15" pos="0 0 -0.16645"/>
			<geom type="mesh" mesh="wrist_roll_link" group="2" euler="0 1.57 0" contype="0" conaffinity="0" rgba=".5 .5 .5 0.15"/>
		</body>

		<include file="../fetch_sim/assets/body.xml"/>

		<body name="Table" pos="0.3 1 0.5">
			<include file="table/chain.xml"/>
		</body>

		<body name="DoorLR" pos="0.075 0.45 0.57" euler="0 0 1.57">
			<include file="door/chain0.xml"/>
		</body>

		<body name="DoorUR" pos="0.075 0.45 1.175" euler="0 0 1.57">
			<include file="door/chain1.xml"/>
		</body>

		<body name="Shelf" pos="-.7 -.2 0.5">
			<include file="shelf/chain.xml"/>
		</body>

		<body name="obj0" pos=".9 .7 .6" euler="0 0 -.4">
			<geom type="box" size=".1 .03 .03" rgba="0.2 0.7 0.9 1.0" material="geomObj"/>
			<joint type="free" limited="false"/>
		</body>
		<body name="obj1" pos=".9 1.0 .6" euler="0 0 .1">
			<geom type="box" size=".03 .03 .1" rgba="0.9 0.7 0.7 1.0" material="geomObj"/>
			<joint type="free" limited="false"/>
		</body>
		<body name="obj2" pos=".6 1.1 .6" euler="0 0 .2">
			<geom type="box" size=".03 .03 .1" rgba="0.8 0.7 0.9 1.0" material="geomObj"/>
			<joint type="free" limited="false"/>
		</body>
		<body name="obj3" pos=".75 1.0 0.7" euler="0 0 -.2">
			<geom type="box" size=".03 .03 .1" rgba="0.7 0.9 0.9 1.0" material="geomObj"/>
			<joint type="free" limited="false"/>
		</body>
		<body name="obj4" pos=".8 0.8 .8"  euler="0 0 .5">
			<geom type="box" size=".1 .03 .03" rgba="0.8 0.9 0.7 1.0" material="geomObj"/>
			<joint type="free" limited="false"/>
		</body>
	</worldbody>

</mujoco>