<?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.020076508762496132 0.006744966149434746 0.0039681184422390445" pos="-0.18110617083427022 -0.24111182526934416 0.20396811844223905" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.03287707428091275 0.037773495792284756 0.00035698815272739744" pos="0.09645109612963698 0.13240755597606313 0.2003569881527274" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.03166083339978651 0.043006570423306446 0.0002791351199385572" pos="0.2726405946685874 0.07703862902718722 0.20027913511993856" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.024947152754636367 0.005233649674243927 0.00032715135338669347" pos="0.22511996200252132 0.026486939359181616 0.20032715135338672" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.007850199474102818 0.014181258491405828 0.002709841909387676" pos="0.17260069639640568 -0.0659982525686463 0.20270984190938768" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04682372247261641 0.010045354294049638 0.004046027555545943" pos="-0.17500202178406282 -0.08383389171917302 0.20404602755554596" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04533426252630561 0.029922493575782357 0.0007066970195810939" pos="-0.15925500941570642 -0.2991457597538725 0.2007066970195811" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.017000881686426158 0.026913482764179566 0.0028849025418918096" pos="0.26573005422216095 0.22029169679779687 0.20288490254189182" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04378786318504657 0.03815578649940659 0.0026122221152058375" pos="0.09602985052782675 0.06923731695492918 0.20261222211520585" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.026146606561290395 0.03702155005241407 0.004804003398898146" pos="-0.034519144871267615 -0.11083523036741735 0.20480400339889815" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04932929694928582 0.039765665902933 0.004899857744121797" pos="-0.056543499858875024 0.2973572701516684 0.2048998577441218" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.02858585234221134 0.022165982988035487 0.0019781671636203493" pos="-0.08901868787304082 -0.048411312288450636 0.20197816716362035" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.025235591237756802 0.04685992631401288 0.003157674380832426" pos="0.07469402238433742 0.00181571122142421 0.20315767438083243" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
        </body>
        
        <body pos="1.375 0.6701448361704999 0.4129999999999999" name="object0">
            <light castshadow="false"/>
            <geom type="mesh" density="453.769050651" rgba="1 1 1 1" material="object" mesh="object_mesh" conaffinity="0" contype="1"/>
            <joint name="object0:joint" type="free" damping="3.4168918231852543"></joint>
            <site name="object0" pos="0.0 0.01485516382950014 0.007000000000000062" 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.0050843934718 0.0050843934718 0.0050843934718" file="mujoco_models/pentagonal_prism.stl" name="object_mesh"/>
        <texture file="textures/obj_textures/crosshatched_0055.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>
    