<?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.022933403299661315 0.028458918719791546 0.0021448870889805454" pos="-0.0001692994905417855 0.24298388068284021 0.20214488708898057" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.015874416442792562 0.02365963328890241 0.003012424104934725" pos="0.12175080146462613 -0.12865754969281346 0.20301242410493472" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.038050539278840875 0.03723024307999136 0.000987984428987798" pos="-0.19256420439604693 0.07252387376860742 0.2009879844289878" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.0062071357976133884 0.048011057146954486 0.003988336420765006" pos="0.09127439978417584 0.28017685418170707 0.20398833642076503" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.018786996400450427 0.026084918496482912 0.0016226125451565588" pos="-0.019430533199554845 0.22739428340977358 0.20162261254515657" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.00921626461285648 0.0355428136421961 0.0001144352093212329" pos="0.21473647765184306 0.2882723483628878 0.20011443520932123" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.016898332351574494 0.031196821871754415 0.003956410822426947" pos="-0.21179491918687676 -0.11714874408435827 0.20395641082242696" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.039956352234230885 0.045105580007188464 0.0030123950972309197" pos="0.0761796172076441 0.22327302535514576 0.20301239509723093" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.02912528654922096 0.048923276484242696 0.0024963566411188975" pos="0.04909264157798077 0.14350935782848118 0.2024963566411189" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.017933961121737393 0.03594798629201275 0.00300705160619586" pos="-0.029324708214141904 -0.13973382103227258 0.20300705160619587" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.013513503903766575 0.04647665013926486 0.0024335481107043895" pos="0.0003519460889260251 -0.008243001917347614 0.2024335481107044" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.002476698486198003 0.007754456562629286 0.0032741759978936373" pos="0.2101325978476441 0.25692108479369086 0.20327417599789366" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
        </body>
        
        <body pos="1.375 0.6749999999999999 0.46237923786849994" name="object0">
            <light castshadow="false"/>
            <geom type="mesh" density="686.565196003" rgba="1 1 1 1" material="object" mesh="object_mesh" conaffinity="0" contype="1"/>
            <joint name="object0:joint" type="free" damping="2.75176838653438"></joint>
            <site name="object0" pos="0.0 0.01000000000000012 -0.04237923786849995" 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.004937923786865 0.004937923786865 0.004937923786865" file="mujoco_models/dodecagonal_prism.stl" name="object_mesh"/>
        <texture file="textures/obj_textures/swirly_0081.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>
    