<?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.02564368878861471 0.04664699649725803 0.00393682970221528" pos="0.18806296794491162 0.09018750572902023 0.2039368297022153" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.016704722371598788 0.03486952834046484 0.0017043320484901598" pos="0.18509675532560682 0.2668492340173361 0.20170433204849017" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.028701573328823636 0.04655603437260267 0.0024534902975897736" pos="-0.09768501369127283 0.06458718764150395 0.20245349029758977" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.014241475427754537 0.00813495192684371 0.0005274695951738467" pos="-0.11197043057147293 0.16714909838834568 0.20052746959517387" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.039656118054623254 0.008152623403788837 0.001360318005159511" pos="0.18688294560137558 -0.23067775197229132 0.20136031800515952" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04237139477600502 0.03510091067358867 0.00017342474504980108" pos="-0.006051654261708894 -0.22612341387924279 0.20017342474504982" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.017967588882405634 0.03590102145265544 0.0005414037471340353" pos="-0.14526194046957766 0.019245524281853832 0.20054140374713406" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.006043185328814573 0.02333217285508982 0.004648831000350081" pos="0.17438165158226404 0.02943972654341359 0.20464883100035008" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.01975126467001856 0.03197010682830757 0.0007355371810880176" pos="-0.2839971207025758 0.19642889622047094 0.20073553718108803" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.036948145891754 0.04472590908729004 0.00293430603689293" pos="0.20387300798171765 0.047095515194671256 0.20293430603689294" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.013089227312749696 0.03478222457245568 0.0046122190417914105" pos="0.2651965434019377 -0.18690300939148302 0.20461221904179142" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04132768075982843 0.03253335062655508 0.003184216527364442" pos="0.19523288932142652 -0.15937633274294194 0.20318421652736446" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.025061379264552344 0.03783667078781392 0.0019427773094177635" pos="-0.12155952534967401 -0.2664264539806241 0.2019427773094178" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.028730485163120018 0.01840806327369701 0.001974716672981239" pos="-0.018597420907708773 0.14655348234371623 0.20197471667298125" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
        </body>
        
        <body pos="1.4303036340614999 0.6190991575464999 0.4129999999999999" name="object0">
            <light castshadow="false"/>
            <geom type="mesh" density="2066.04772906" rgba="1 1 1 1" material="object" mesh="object_mesh" conaffinity="0" contype="1"/>
            <joint name="object0:joint" type="free" damping="2.6558420247686576"></joint>
            <site name="object0" pos="-0.05530363406149985 0.06590084245350014 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.00072488376609 0.00072488376609 0.00072488376609" file="mujoco_models/Stepped_Pencil_Holder.stl" name="object_mesh"/>
        <texture file="textures/obj_textures/dotted_0139.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>
    