<?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.011798724284595084 0.025296251384107894 0.00033171763351381853" pos="-0.12645150926539872 0.141974366398415 0.20033171763351382" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.031440265263301063 0.041111211080725546 0.003749642279087384" pos="-0.28723359758379535 0.04174148046734466 0.2037496422790874" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.022482419613363377 0.01870370214484763 0.00496266977366049" pos="0.09417802245314694 -0.14935795611678784 0.2049626697736605" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.0271104368765286 0.005666364722196006 0.003751839070911171" pos="-0.0914089562278037 -0.19866997629669844 0.20375183907091118" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.008958651685992927 0.0017462144031413487 0.003911613240959766" pos="0.13721992541666478 -0.008984464500241707 0.20391161324095977" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.01599227303929278 0.020188970983780235 0.004432033610508492" pos="-0.22722013666627344 -0.28226115592427636 0.2044320336105085" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.011570498035775822 0.02651359603237693 0.0001376462991552269" pos="-0.23744115951393868 0.11871838912002708 0.20013764629915523" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.02295507999897279 0.047483309040699945 0.004562756181252796" pos="-0.1341252621593726 -0.07337044196460249 0.2045627561812528" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04599041483554467 0.029383622141157167 0.0019116373480496305" pos="0.18024402321296984 0.2547024645613655 0.20191163734804965" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
        </body>
        
        <body pos="1.2457554189914999 0.5457554288519999 0.4129999999999999" name="object0">
            <light castshadow="false"/>
            <geom type="mesh" density="316.238132789" rgba="1 1 1 1" material="object" mesh="object_mesh" conaffinity="0" contype="1"/>
            <joint name="object0:joint" type="free" damping="0.7839611182027526"></joint>
            <site name="object0" pos="0.12924458100850011 0.13924457114800015 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.001292445810085 0.001292445810085 0.001292445810085" file="mujoco_models/nidoran_01.stl" name="object_mesh"/>
        <texture file="textures/obj_textures/waffled_0162.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>
    