<?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.014061605931699406 0.016894239974545304 0.004117960760831454" pos="0.2324382707822919 -0.14058239096717615 0.20411796076083147" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.0173923786306559 0.004755684825320619 0.001651410595980512" pos="-0.13709350301895332 -0.2117328750325844 0.20165141059598052" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.02026253532130555 0.013377325959723196 0.0029254230709496926" pos="0.21660153014491818 -0.055300001161726425 0.2029254230709497" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.01730201252213181 0.021529411565895364 0.0004295897449458114" pos="0.15106766628721408 -0.20874878710251474 0.20042958974494582" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.015886149030467048 0.019646364237975302 0.003982509817137177" pos="0.2588716770804525 -0.24023777330771742 0.2039825098171372" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.043250380717416166 0.03810174848726756 0.0013834163440263922" pos="0.018089471171292504 0.22358374698927813 0.2013834163440264" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.048449912252051155 0.035766499998831795 0.002533972725548195" pos="0.27118817226615105 -0.2426954228477652 0.2025339727255482" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.026387408964286665 0.04777590426062632 0.0025346642078421947" pos="-0.23944405221774723 -0.11941646755022586 0.20253466420784222" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.018631107108461116 0.007092608972003067 0.0004516375220721814" pos="0.21916992506074812 0.264678024735902 0.20045163752207218" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.012493676423008561 0.026407956764713053 0.000977113249095967" pos="-0.07774565776096956 -0.28977018914264435 0.20097711324909598" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.03770467888912534 0.03311915879302991 0.0018207400289449638" pos="0.17575230463045827 -0.11171890578719204 0.20182074002894498" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.026879165838101265 0.004649587384694739 0.0012769591336685131" pos="0.01764594539956288 -0.08688012498316164 0.20127695913366853" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
        </body>
        
        <body pos="1.3413590469715 0.70258558148353 0.41299730872349993" name="object0">
            <light castshadow="false"/>
            <geom type="mesh" density="4002.65327986" rgba="1 1 1 1" material="object" mesh="object_mesh" conaffinity="0" contype="1"/>
            <joint name="object0:joint" type="free" damping="2.101151637782026"></joint>
            <site name="object0" pos="0.03364095302850001 -0.017585581483529955 0.00700269127650005" 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.00134563812115 0.00134563812115 0.00134563812115" file="mujoco_models/Stackable_Square_Container.stl" name="object_mesh"/>
        <texture file="textures/obj_textures/freckled_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>
    