<?xml version="1.0" encoding="utf-8"?>
<mujoco>
    <compiler angle="radian" coordinate="local" meshdir="../stls/fetch" texturedir="../textures"></compiler>
    <option timestep="0.002">
        <flag warmstart="enable"></flag>
    </option>

    <include file="shared.xml"></include>
    
    <worldbody>
        <geom name="floor0" pos="1.42 0.75 0" size="1.0 0.7 1" type="plane" condim="3" material="floor_mat"></geom>
        <body name="floor0" pos="1.42 0.75 0">
            <site name="target0" pos="0 0 0.5" size="0.02 0.02 0.02" rgba="1 0 0 1" type="sphere"></site>
        </body>

        <include file="robot.xml"></include>
        
        <body pos="1.65 0.75 0.2" name="table0">
            <geom size="0.5 0.45 0.2" type="box" mass="20000" material="table_mat"></geom><geom size="0.015187550499197348 0.03762451809501793 0.0036050771188684523" pos="-0.07297429990000229 -0.2767772125058003 0.20360507711886847" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.0341566064524622 0.02156977149851846 0.0023577622151743655" pos="-0.02619511598987717 0.1677045705231991 0.20235776221517437" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.02478810726072396 0.02980190131032202 0.0006608416137753515" pos="0.03483738341584908 -0.2531915693899597 0.20066084161377537" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.002207708203824056 0.031312194998799225 0.0018684330316814564" pos="-0.2851601333338286 0.14235402598555202 0.20186843303168148" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.01209652740434226 0.007528955976190288 0.0011445494211243822" pos="0.29503576754236444 0.2716459551268812 0.2011445494211244" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.01629774449130712 0.02880725969934061 0.0034871959800397275" pos="-0.24047234813355756 0.09081147773525633 0.20348719598003973" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.0045290869768722 0.024499084621469217 0.004908637949358886" pos="0.28859997761027595 0.27699760003332136 0.2049086379493589" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.0124012946853716 0.038844846693881406 0.0008014300062809646" pos="0.0672866150288105 -0.20432296238588174 0.20080143000628098" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04278384233878331 0.047722685707745696 0.002213809341243781" pos="0.2141217857836451 0.15136568279885299 0.2022138093412438" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04136202370215473 0.006227346450392646 0.002145214420569708" pos="-0.04877901375463506 -0.040914002342063105 0.2021452144205697" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
        </body>
        
        <body pos="1.371438128825 0.6644606468316 0.39240839826999996" name="object0">
            <light castshadow="false"/>
            <geom type="mesh" density="4886.57253087" rgba="1 1 1 1" material="object" mesh="object_mesh" conaffinity="0" contype="1"/>
            <joint name="object0:joint" type="free" damping="1.4477785986770533"></joint>
            <site name="object0" pos="0.0035618711750000642 0.020539353168400054 0.027591601730000026" size="0.002 0.002 0.002" rgba="1 0 0 0" type="sphere"></site>
        </body>

        <body name="hook" pos="1.0 0.025 0.025">
            <joint name="hook:joint" type="free" damping="0.01"></joint>
            <geom size="0.4 0.015 0.015" type="box" condim="3" name="hook_base" material="block_mat" mass="2"></geom>
            <geom size="0.015 0.1 0.015" pos="0.4 0.085 0." type="box" condim="3" name="hook_head" material="block_mat" mass="2"></geom>
            <site name="hook" pos="-0.25 0 0" size="0.002 0.002 0.002" rgba="1 0 0 1" type="sphere"></site>
        </body>

        <light directional="true" ambient="0.2 0.2 0.2" diffuse="0.8 0.8 0.8" specular="0.3 0.3 0.3" castshadow="false" pos="0 0 4" dir="0 0 -1" name="light0"></light>
    </worldbody>

    <asset>
        <mesh scale="0.000911314392 0.000911314392 0.000911314392" file="mujoco_models/TD_Mushroom_cap.stl" name="object_mesh"/>
        <texture file="textures/obj_textures/interlaced_0103.png" name="object"/>
        <material specular="1" texture="object" rgba="0.9 0.9 0.9 1" shininess="0.3" name="object"/>
    </asset>
    
    <actuator>
        <position ctrllimited="true" ctrlrange="0 0.2" joint="robot0:l_gripper_finger_joint" kp="30000" name="robot0:l_gripper_finger_joint" user="1"></position>
        <position ctrllimited="true" ctrlrange="0 0.2" joint="robot0:r_gripper_finger_joint" kp="30000" name="robot0:r_gripper_finger_joint" user="1"></position>
    </actuator>
</mujoco>
    