<?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.02202890752594775 0.04513884280657869 0.003210763944997297" pos="-0.2302519232100219 0.004628863538743699 0.20321076394499732" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.025663978622293512 0.027359505370621984 0.0016847750484120334" pos="-0.29324391445765624 0.28758791060932914 0.20168477504841203" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.009204447806742799 0.037942441054874466 0.0049794559871586" pos="-0.09904349192803341 -0.14412667038761898 0.2049794559871586" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.03291073384254476 0.017613543440641918 0.0006121452337664343" pos="-0.06358995964911995 -0.24563820932941838 0.20061214523376644" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.02100899401354244 0.013067360488879947 0.002218616015670549" pos="-0.2980574341269983 -0.1851231376321808 0.20221861601567057" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.007150323251066727 0.028366269171509667 0.004884565261453674" pos="-0.11395811253761437 -0.23896022482334692 0.20488456526145368" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.018184355745549895 0.007032058135078365 0.004947881639967337" pos="-0.00895220267341268 -0.010734617222704135 0.20494788163996736" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.048550734346718354 0.017741165013792352 0.0008982839026094534" pos="-0.26894765482625027 -0.2202557741195706 0.20089828390260947" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.02319830726824707 0.04376909637906516 0.0021266373022977678" pos="0.020488431834376764 0.2348904897736102 0.20212663730229777" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.00933327398548215 0.02032444963182165 0.00019157008455239014" pos="0.22884487421303917 -0.13416092797029736 0.2001915700845524" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.03382049381743649 0.03337308030367898 0.00013113880114059144" pos="-0.04413629189147722 -0.2628664800921329 0.2001311388011406" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
        </body>
        
        <body pos="1.375 0.6749999999999999 0.4129999999999999" name="object0">
            <light castshadow="false"/>
            <geom type="mesh" density="784.619909127" rgba="1 1 1 1" material="object" mesh="object_mesh" conaffinity="0" contype="1"/>
            <joint name="object0:joint" type="free" damping="1.8515722767765068"></joint>
            <site name="object0" pos="0.0 0.01000000000000012 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.00181240932801 0.00181240932801 0.00181240932801" file="mujoco_models/Rook.stl" name="object_mesh"/>
        <texture file="textures/obj_textures/stained_0060.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>
    