<?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.027708492796456863 0.04293015871254782 0.000291070264196562" pos="-0.16297410341840057 0.024707105420112008 0.20029107026419657" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.0030432816309929377 0.025796359224517597 0.002883141509245543" pos="0.010441914093023252 -0.2313075285315807 0.20288314150924555" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04014290579538768 0.031487592136009004 0.0037404852322309996" pos="-0.0535370356407846 0.1892907436046546 0.203740485232231" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.014805111287138958 0.046367713362628245 0.002262017772314771" pos="-0.1441145351173674 0.19300298429837953 0.20226201777231478" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.02809403763700156 0.015052393869798387 0.0008637751165306992" pos="0.27164147262561017 0.12742687357312643 0.20086377511653072" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04692507149027105 0.03687537437812374 0.0029971640287947488" pos="0.004749665748573717 0.2999512466679361 0.20299716402879475" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.013819976310536771 0.019220595455523178 0.004286449399171976" pos="-0.01374966452417642 -0.2060030362454946 0.20428644939917198" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.02511107767394576 0.029544019009389456 0.003527294621297673" pos="-0.24124423751545898 0.17003131695480916 0.20352729462129768" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.01411119032552003 0.014947739748592266 0.0035967104523901144" pos="-0.19099304104002987 0.2365868392995794 0.20359671045239014" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.033062130614039384 0.014821516355324992 0.004467314994082221" pos="-0.09499280489452402 -0.27430987027157633 0.20446731499408224" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.0479765670425094 0.013009889840624976 0.004409748889004867" pos="0.050793246196068675 0.270407590194449 0.20440974888900487" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04184496784644991 0.03122315669536503 0.0014541174963668198" pos="0.2864767352865624 0.09172861329068338 0.20145411749636682" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.008347417814445795 0.011236448127181633 0.0017835834894644677" pos="-0.0010213212745753264 -0.11811517095451496 0.20178358348946449" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
        </body>
        
        <body pos="1.375 0.68411669401875 0.44946677607499996" name="object0">
            <light castshadow="false"/>
            <geom type="mesh" density="2562.19976935" rgba="1 1 1 1" material="object" mesh="object_mesh" conaffinity="0" contype="1"/>
            <joint name="object0:joint" type="free" damping="1.8861316016308203"></joint>
            <site name="object0" pos="0.0 0.0008833059812500821 -0.02946677607499998" 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.003646677607505 0.003646677607505 0.003646677607505" file="mujoco_models/triangular_prism.stl" name="object_mesh"/>
        <texture file="textures/obj_textures/paisley_0027.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>
    