<?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.0426410638092431 0.04534104576431437 0.002911000206298836" pos="-0.12350918860729176 -0.181484996173974 0.20291100020629885" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.02686572410676052 0.033904270536416134 0.003734764312106133" pos="-0.19777007246222228 0.021532795542637262 0.20373476431210613" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.022369381184665686 0.011202986337912786 0.002809515355058237" pos="-0.1344517669161255 0.021032734265730102 0.20280951535505826" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.010805357900142986 0.04509718430887446 0.0017567038421059935" pos="0.0662007615946758 -0.22684020754806244 0.201756703842106" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.031870842433894896 0.01432997662527901 0.00478700479281872" pos="-0.06350744037520148 0.06444393402711479 0.20478700479281872" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.011574854917501522 0.043212333940943606 0.004041231298790285" pos="-0.15261881263453708 0.24662910480366346 0.2040412312987903" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.0029675960796722565 0.03787608290532025 0.002343557048178957" pos="0.20127563668617837 -0.020708419538395195 0.20234355704817897" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.004213522687849745 0.012100731082496503 0.004972436690112998" pos="-0.09949343833837879 -0.20381686978474028 0.204972436690113" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04048571046446896 0.0032084215421345394 0.00042540288219693656" pos="-0.12148873232738033 -0.271559415218762 0.20042540288219696" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04978992151072298 0.0348653154180245 0.00264597356020105" pos="0.18309983397375817 0.09749208036716017 0.20264597356020106" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.009489982730118834 0.011762056182795577 0.004351702000034328" pos="-0.09782320393570715 -0.031415794425072974 0.20435170200003433" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.020165649894043982 0.0035494607882470787 0.0035524112146897353" pos="0.024044448471729374 0.10568404908835816 0.20355241121468975" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.014633338093690024 0.020938781508021868 0.001043983835131075" pos="-0.04819042113768135 0.0920948470782203 0.20104398383513108" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
<geom size="0.04728976311643094 0.03350940279441438 0.0026732826769656935" pos="-0.05017966650110317 -0.23667018944341178 0.20267328267696572" type="box" mass="200" rgba="0.4 0.4 0.4 1"></geom>
        </body>
        
        <body pos="1.374985616277 0.6750015586886 0.4129999999999999" name="object0">
            <light castshadow="false"/>
            <geom type="mesh" density="1385.30214953" rgba="1 1 1 1" material="object" mesh="object_mesh" conaffinity="0" contype="1"/>
            <joint name="object0:joint" type="free" damping="0.5170489600495346"></joint>
            <site name="object0" pos="1.4383722999999904e-05 0.009998441311400041 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.00421238002239 0.00421238002239 0.00421238002239" file="mujoco_models/hollow_cylinder_20mm.stl" name="object_mesh"/>
        <texture file="textures/obj_textures/marbled_0143.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>
    