<?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.032423738124987125 0.04634642571489332 0.004469815313539277" pos="0.10827674091440043 0.27661616241568693 0.20446981531353928" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.01221908939769966 0.001960509420034651 0.004616363211845983" pos="-0.1414032145499511 0.28386178030346526 0.20461636321184598" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.011977913883854198 0.014644520174126346 0.00455630413159769" pos="0.1875930946604954 -0.2415652644804301 0.2045563041315977" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.029198091177850456 0.00872982870495141 0.00045119071884551547" pos="0.06742909728279167 -0.25316848779004597 0.20045119071884554" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.024122854306945992 0.03111112530175843 0.004701603091310303" pos="0.25276331945753766 0.06447447269304585 0.2047016030913103" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.02563291343641581 0.032869167930406125 0.004632330914871949" pos="0.2945642519304405 -0.28014580025435015 0.20463233091487196" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04850805234941893 0.04035611299258064 0.000467523715031153" pos="0.18010072704534735 0.09757974620620058 0.20046752371503115" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04538115912652148 0.02343206680195996 0.0025663584685926954" pos="0.20238798720641843 -0.009727323288427736 0.2025663584685927" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.026792027167635783 0.012973585070801642 0.0017190703091142386" pos="-0.12741097477026544 -0.2726020692800014 0.20171907030911426" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.029568655698251546 0.04228992368827962 0.00387453200214103" pos="-0.15204861626053723 0.051785813409982284 0.20387453200214103" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.025031102159612465 0.04101114222413786 0.0018320516232117102" pos="-0.27804182935692984 0.23236548721215172 0.20183205162321172" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
        </body>
        
        <body pos="1.342871667758 0.646084500982 0.36480750163649994" name="object0">
            <light castshadow="false"/>
            <geom type="mesh" density="314.450354784" rgba="1 1 1 1" material="object" mesh="object_mesh" conaffinity="0" contype="1"/>
            <joint name="object0:joint" type="free" damping="0.7450700706975093"></joint>
            <site name="object0" pos="0.03212833224200007 0.038915499018000066 0.05519249836350004" 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.003212833224225 0.003212833224225 0.003212833224225" file="mujoco_models/Simple_Filament_Guide.stl" name="object_mesh"/>
        <texture file="textures/obj_textures/dotted_0108.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>
    