<?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.04479217854661395 0.023580715710827073 0.0009797038756483556" pos="-0.04496105195195038 -0.07102402249880269 0.20097970387564837" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.03681229017024387 0.04219594770199228 0.000155528085312173" pos="-0.00311091954517273 -0.1396397764324149 0.20015552808531217" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.00905720179421151 0.033619577710997356 0.004194173641742523" pos="0.026643452393597 -0.18372350576334218 0.20419417364174253" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.03781298102311304 0.026545300778911082 0.004042726821297507" pos="0.2788336958805789 -0.04838940495913591 0.2040427268212975" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.016631102676861183 0.014821895943418036 0.003485833686595619" pos="0.28312644490789823 -0.12850862753919795 0.20348583368659562" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.023651632567556514 0.0292402153966361 0.0047742255961275605" pos="-0.15171290040531893 0.27697978540507867 0.20477422559612757" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.02667727863495525 0.03669096114241025 0.003928570394118105" pos="-0.20123446266195893 0.28484676300012796 0.2039285703941181" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04882990831260016 0.04344233270760312 0.004232438595815978" pos="-0.10424134696188014 0.21123987642072867 0.204232438595816" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.044528069899186694 0.014059796110075962 0.0009362154776423424" pos="0.15418724948621754 0.046641176335946 0.20093621547764234" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.006285296791922803 0.020575774353847113 0.0017267997313115703" pos="0.09641448839818367 -0.04775690758912937 0.20172679973131158" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
        </body>
        
        <body pos="1.353716748573 0.6924522661700999 0.41299829733999993" name="object0">
            <light castshadow="false"/>
            <geom type="mesh" density="17726.8552661" rgba="1 1 1 1" material="object" mesh="object_mesh" conaffinity="0" contype="1"/>
            <joint name="object0:joint" type="free" damping="0.558009059416612"></joint>
            <site name="object0" pos="0.02128325142700005 -0.007452266170099864 0.007001702660000053" 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.00085133005708 0.00085133005708 0.00085133005708" file="mujoco_models/Stackable_Square_Container.stl" name="object_mesh"/>
        <texture file="textures/obj_textures/meshed_0126.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>
    