<?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.006132959174121936 0.003788416177587767 0.003669932943317418" pos="0.09316274839366079 -0.2950805156483555 0.20366993294331742" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.011852546481966882 0.03552941952472073 0.0008454901880493664" pos="0.04605046987569872 -0.17210611994873562 0.20084549018804937" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.02301247995572858 0.04350373002828727 0.0015827224937748315" pos="0.11158343395513876 -0.03703126033031928 0.20158272249377485" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.005711607460772927 0.01867111468893825 0.004222272325105727" pos="0.28382774536093697 0.20704900236960316 0.20422227232510573" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.008949191147903983 0.017929955624005147 0.004172821977173075" pos="0.032337560637459295 0.1657114782686449 0.2041728219771731" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.03911138006422272 0.004483307130875861 0.0017777921714450132" pos="-0.012587096728219671 0.26713483294823276 0.20177779217144504" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04501321124978421 0.02172856716362977 0.0005687630446858837" pos="-0.057274627871770956 0.021541999584768434 0.2005687630446859" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04531546237855254 0.015449084089919636 0.001613434313778038" pos="0.07630994072870456 0.0031149330428273947 0.20161343431377804" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
        </body>
        
        <body pos="1.375 0.67672563947735 0.4129999999999999" name="object0">
            <light castshadow="false"/>
            <geom type="mesh" density="5379.3710035" rgba="1 1 1 1" material="object" mesh="object_mesh" conaffinity="0" contype="1"/>
            <joint name="object0:joint" type="free" damping="1.4176981005188685"></joint>
            <site name="object0" pos="0.0 0.00827436052265007 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.00385000971424 0.00385000971424 0.00385000971424" file="mujoco_models/nonagonal_pyramid.stl" name="object_mesh"/>
        <texture file="textures/obj_textures/freckled_0164.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>
    