<?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.03882678080137964 0.045559201411901555 0.00031416327819544103" pos="-0.27374709912713496 -0.09213784851380971 0.20031416327819546" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.033180470357740556 0.006987804559223443 0.003133035159560742" pos="0.12655589648511817 0.11936267587125071 0.20313303515956074" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.03589367271164528 0.012524941945144797 0.0019479647104720511" pos="-0.11031748311208237 0.15025623447744613 0.20194796471047205" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.013732435707704788 0.03596130043512425 0.003308362866666373" pos="0.20113374931800826 0.11022155224693203 0.20330836286666637" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.014206536781573652 0.0011266325203050896 0.003164532806408764" pos="-0.07504818969824856 0.044015360140387705 0.20316453280640878" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04544233362410491 0.03511044956973378 0.004969226962375992" pos="0.08155423216245256 0.07342418501674963 0.20496922696237602" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.03166526318265943 0.035363743938390646 0.0038725313037128346" pos="0.2589620529430237 0.236665569558057 0.20387253130371286" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04699687324235504 0.01256313908597554 0.003520895749607158" pos="0.18505859589661028 0.11595797075789765 0.20352089574960716" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04044867247879369 0.03394902607044218 0.0036014865589282844" pos="0.1873261340197105 -0.1046836642579001 0.2036014865589283" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04247595403592847 0.009607023396291627 0.0021953812170214396" pos="-0.0858206086390339 0.24541953310998826 0.20219538121702146" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.035724532191945324 0.04715821463944565 0.003922946744101243" pos="0.10098624130542455 -0.1583274944135471 0.20392294674410125" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
        </body>
        
        <body pos="1.3790566520774998 0.6917491766928999 0.41300000029899997" name="object0">
            <light castshadow="false"/>
            <geom type="mesh" density="1586.26645322" rgba="1 1 1 1" material="object" mesh="object_mesh" conaffinity="0" contype="1"/>
            <joint name="object0:joint" type="free" damping="2.0297795419141993"></joint>
            <site name="object0" pos="-0.004056652077499834 -0.006749176692899872 0.006999999701000015" 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.000837458834645 0.000837458834645 0.000837458834645" file="mujoco_models/Love_Box_1.stl" name="object_mesh"/>
        <texture file="textures/obj_textures/fibrous_0108.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>
    