<?xml version="1.0" ?>
<!-- =================================================================================== -->
<!-- |    This document was autogenerated by xacro from urdf/genie.robot.xacro         | -->
<!-- |    EDITING THIS FILE BY HAND IS NOT RECOMMENDED                                 | -->
<!-- =================================================================================== -->
<robot name="genie">
  <!-- Index -->
  <!-- body: [G1, G2] -->
  <!-- gripper: [dummy_hand, omnipicker, 120s, roh, skillhands6] -->
  <!-- <xacro:arg name="robot_model" default="G1" />
  <xacro:arg name="robot_model" default="G1" /> -->
  <!-- robot -->
  <!-- Material Definition -->
  <material name="black">
    <color rgba="0.0 0.0 0.0 1.0"/>
  </material>
  <material name="blue">
    <color rgba="0.0 0.0 0.8 1.0"/>
  </material>
  <material name="green">
    <color rgba="0.0 1.0 0.0 1.0"/>
  </material>
  <material name="grey">
    <color rgba="0.2 0.2 0.2 1.0"/>
  </material>
  <material name="orange">
    <color rgba="1.0 0.4235294117647059 0.0392156862745098 1.0"/>
  </material>
  <material name="brown">
    <color rgba="0.8705882352941177 0.8117647058823529 0.7647058823529411 1.0"/>
  </material>
  <material name="red">
    <color rgba="0.8 0.0 0.0 1.0"/>
  </material>
  <material name="white">
    <color rgba="1.0 1.0 1.0 1.0"/>
  </material>
  <!-- transparent is not working properly -->
  <material name="transparent">
    <color rgba="1.0 1.0 1.0 0.999"/>
  </material>
  <material name="default">
    <color rgba="0.752941176470588 0.752941176470588 0.752941176470588 1"/>
  </material>
  <!-- links -->
  <link name="base_link">
    <inertial>
      <origin rpy="0.0 0.0 0.0" xyz="-0.0134486971267798 0.00152103941353612 -0.0320076754329413"/>
      <mass value="23.2085382238952"/>
      <inertia ixx="0.386955641760608" ixy="0.000135417314593726" ixz="0.00669301645720665" iyy="0.366800407621218" iyz="0.000105713634260505" izz="0.546852919828475"/>
    </inertial>
    <visual>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/G1/base_link.fbx"/>
      </geometry>
      <origin rpy="0.0 0.0 0.0" xyz="0.0 0.0 0.0"/>
    </visual>
    <!-- <collision>
        <origin
          rpy="0.0 0.0 0.0"
          xyz="-0.10913086 0.0 0.51171875" />
        <geometry>
          <box size="0.29833984 0.3376392 1.0" />
        </geometry>
      </collision>
      <collision>
        <origin
          rpy="0.0 0.0 0.0"
          xyz="0.0 0.0 0.15" />
        <geometry>
          <box size="0.5996094 0.449 0.30273438" />
        </geometry>
      </collision> -->
  </link>
  <link name="body_link1">
    <inertial>
      <origin rpy="0.0 0.0 0.0" xyz="0.0338351537064605 -0.00248044044451858 0.000838431095422365"/>
      <mass value="3.26275452360108"/>
      <inertia ixx="0.0128301877197417" ixy="8.24967996575627e-06" ixz="1.38254543337324e-05" iyy="0.006104110250297" iyz="-7.99392548994692e-06" izz="0.0111721084996867"/>
    </inertial>
    <visual>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/G1/body_link1.fbx"/>
      </geometry>
      <origin rpy="0.0 0.0 0.0" xyz="0.0 0.0 0.0"/>
    </visual>
    <!-- <collision>
        <origin
          rpy="0.0 0.0 0.0"
          xyz="0.10278320000000002 0.1 -0.013671875" />
        <geometry>
          <box size="0.16064453 0.05555534399999999 0.1328125" />
        </geometry>
      </collision>
      <collision>
        <origin
          rpy="0.0 0.0 0.0"
          xyz="0.10180664 -0.1 0.0" />
        <geometry>
          <box size="0.16259765999999998 0.04375648500000001 0.16015625" />
        </geometry>
      </collision> -->
  </link>
  <link name="body_link2">
    <inertial>
      <origin rpy="0.0 0.0 0.0" xyz="0.193733558855111 -0.000484180179482319 -0.00124011422952511"/>
      <mass value="7.53199207979272"/>
      <inertia ixx="0.016546682835947" ixy="0.000274441382484697" ixz="0.00102757387076422" iyy="0.0445441227006132" iyz="-0.000236858278708531" izz="0.0402036337794082"/>
    </inertial>
    <visual>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/G1/body_link2.fbx"/>
      </geometry>
      <origin rpy="0.0 0.0 -1.5707963267948966" xyz="0.0 0.0 0.0"/>
    </visual>
    <!-- <collision>
        <origin
          rpy="0 0 0"
          xyz="0.0068359375 -0.00034356117 0.0" />
        <geometry>
          <cylinder radius="0.09662318" length="0.08697056999999997" />
        </geometry>
      </collision>
      <collision>
        <origin
          xyz="0.0068359375 -0.00034356117 0.043485284999999985" />
        <geometry>
          <sphere radius="0.09662318" />
        </geometry>
      </collision>
      <collision>
        <origin
          xyz="0.0068359375 -0.00034356117 -0.043485284999999985" />
        <geometry>
          <sphere radius="0.09662318" />
        </geometry>
      </collision>
      <collision>
        <origin
          rpy="0.0 0.0 -${PI_2}"
          xyz="0.008 -0.248 0.0" />
        <geometry>
          <box size="0.34570312 0.18107724 0.3125" />
        </geometry>
      </collision> -->
  </link>
  <link name="head_link1">
    <inertial>
      <origin rpy="0.0 0.0 0.0" xyz="0.0446068140025754 0.00241753143645124 0.0528373754603559"/>
      <mass value="0.414342871921048"/>
      <inertia ixx="0.000158695728344024" ixy="-1.04590928109554e-06" ixz="-6.58530903139189e-06" iyy="0.000117742864399469" iyz="-2.65011299996072e-06" izz="0.000170947040827065"/>
    </inertial>
    <visual>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/G1/head_link1.fbx"/>
      </geometry>
      <origin rpy="0.0 0.0 0.0" xyz="0.0 0.0 0.0"/>
    </visual>
  </link>
  <link name="head_link2">
    <inertial>
      <origin rpy="0.0 0.0 0.0" xyz="0.0257009265816389 0.0316254080188787 -3.77390122592164e-05"/>
      <mass value="0.707063977171202"/>
      <inertia ixx="0.00205409595373573" ixy="0.000347730118005016" ixz="-2.13857752451204e-06" iyy="0.00200357281313449" iyz="5.16150600423908e-08" izz="0.00184999028444405"/>
    </inertial>
    <visual>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/G1/head_link2.fbx"/>
      </geometry>
      <origin rpy="-3.141592653589793 0.0 0.0" xyz="0.0 0.0 0.0"/>
    </visual>
    <!-- <collision>
        <geometry>
          <sphere radius="0.11257068650657154" />
        </geometry>
        <origin
          xyz="0.011500973396434619 -0.0252600143348118 0.0008537154007319386"
          rpy="0.0 0.0 0.0" />
      </collision> -->
  </link>
  <link name="arm_base_link"/>
  <link name="arm_l_base_link">
    <inertial>
      <origin rpy="0.0 0.0 0.0" xyz="-0.00020641 0.00057488 0.032296"/>
      <mass value="0.37595"/>
      <inertia ixx="0.00024335" ixy="1.2188e-06" ixz="-2.4281e-06" iyy="0.00024039" iyz="6.6932e-06" izz="0.00032195"/>
    </inertial>
    <visual>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/G1/arm_l_base_link.fbx"/>
      </geometry>
      <origin rpy="0.0 0.0 0.0" xyz="0.0 0.0 0.0"/>
    </visual>
    <!-- <collision>
        <geometry>
          <cylinder radius="0.05426921699310094" length="0.09134995751082897" />
        </geometry>
        <origin
          xyz="-0.0017106435846521925 0.0013720927967423996 0.02822502050548792"
          rpy="0.0 0.0 0.0" />
      </collision> -->
  </link>
  <link name="arm_r_base_link">
    <inertial>
      <origin rpy="0.0 0.0 0.0" xyz="0.00020641 -0.00057488 0.034396"/>
      <mass value="0.37595"/>
      <inertia ixx="0.00024335" ixy="1.2188e-06" ixz="2.4281e-06" iyy="0.00024039" iyz="-6.6932e-06" izz="0.00032195"/>
    </inertial>
    <visual>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/G1/arm_r_base_link.fbx"/>
      </geometry>
      <origin rpy="0.0 0.0 0.0" xyz="0.0 0.0 0.0"/>
    </visual>
    <!-- <collision>
        <geometry>
          <cylinder radius="0.05447215073540005" length="0.0913499565795064" />
        </geometry>
        <origin
          xyz="0.001163549527588341 -0.0020492302944608923 0.030325019266456366"
          rpy="0.0 0.0 0.0" />
      </collision> -->
  </link>
  <!-- joints waist -->
  <joint name="idx01_body_joint1" type="prismatic">
    <parent link="base_link"/>
    <child link="body_link1"/>
    <origin rpy="0.0 0.0 0.0" xyz="0.0 0.0 0.6485"/>
    <axis xyz="0.0 0.0 1.0"/>
    <limit effort="100.0" lower="0.0" upper="0.55" velocity="0.1"/>
  </joint>
  <joint name="idx02_body_joint2" type="revolute">
    <parent link="body_link1"/>
    <child link="body_link2"/>
    <origin rpy="-1.5707963267948966 0.0 0.0" xyz="0.131 0.0 0.0"/>
    <axis xyz="0.0 0.0 1.0"/>
    <limit effort="100.0" lower="0.0" upper="1.5707963267948966" velocity="0.5"/>
  </joint>
  <!-- joints head -->
  <joint name="idx11_head_joint1" type="revolute">
    <parent link="body_link2"/>
    <child link="head_link1"/>
    <origin rpy="1.5707963267948966 0.0 0.0" xyz="0.0 -0.441 0.0"/>
    <axis xyz="0.0 0.0 1.0"/>
    <limit effort="50.0" lower="-1.5707963267948966" upper="1.5707963267948966" velocity="1.0"/>
  </joint>
  <joint name="idx12_head_joint2" type="revolute">
    <parent link="head_link1"/>
    <child link="head_link2"/>
    <origin rpy="-1.5707963267948966 0.0 0.0" xyz="0.050238 0.0 0.060065"/>
    <axis xyz="0.0 0.0 1.0"/>
    <limit effort="50.0" lower="-0.3490658503988659" upper="0.5235987755982988" velocity="1.0"/>
  </joint>
  <!-- joints arm base -->
  <joint name="idx10_arm_base_joint" type="fixed">
    <parent link="body_link2"/>
    <child link="arm_base_link"/>
    <origin rpy="1.5707963267948966 0.0 0.0" xyz="0.0 -0.305 0.0"/>
    <axis xyz="0.0 0.0 1.0"/>
  </joint>
  <joint name="idx11_arm_l_base_joint" type="fixed">
    <parent link="arm_base_link"/>
    <child link="arm_l_base_link"/>
    <origin rpy="-1.5707963267948966 0.0 0.0" xyz="0.0 0.025 0.0"/>
    <axis xyz="1.0 0.0 0.0"/>
  </joint>
  <joint name="idx12_arm_r_base_joint" type="fixed">
    <parent link="arm_base_link"/>
    <child link="arm_r_base_link"/>
    <origin rpy="-1.5707963267948966 0.0 3.141592653589793" xyz="0.0 -0.025 0.0"/>
    <axis xyz="1.0 0.0 0.0"/>
  </joint>
  <!-- properties -->
  <!-- links -->
  <link name="arm_l_link1">
    <inertial>
      <origin rpy="0 0 0" xyz="-0.0012655 -0.00043778 -0.018388"/>
      <mass value="0.4936"/>
      <inertia ixx="0.00075396" ixy="6.6935e-06" ixz="6.1141e-06" iyy="0.00065755" iyz="1.2196e-06" izz="0.00031848"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/G1/arm_l_link1.fbx"/>
      </geometry>
      <material name="white"/>
    </visual>
    <collision>
      <geometry>
        <cylinder length="0.16642063483595848" radius="0.05579268228774888"/>
      </geometry>
      <origin rpy="0.0 0.0 -1.2566370614359172" xyz="0.0026814433577366636 0.0006133775157398935 -0.04071124829351902"/>
    </collision>
  </link>
  <link name="arm_l_link2">
    <inertial>
      <origin rpy="0 0 0" xyz="5.3037e-05 -0.078258 0.0047084"/>
      <mass value="0.46245"/>
      <inertia ixx="0.00065719" ixy="3.7112e-07" ixz="-3.6668e-06" iyy="0.00043459" iyz="-2.517e-05" izz="0.00072571"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/G1/arm_l_link2.fbx"/>
      </geometry>
      <material name="white"/>
    </visual>
    <collision>
      <origin rpy="1.5707963267948966 0 0" xyz="0.0 -0.044062052 0.0009765625"/>
      <geometry>
        <cylinder length="0.18085919" radius="0.06302423"/>
      </geometry>
    </collision>
  </link>
  <link name="arm_l_link3">
    <inertial>
      <origin rpy="0 0 0" xyz="-0.0012032 0.0008714 -0.055265"/>
      <mass value="0.50026"/>
      <inertia ixx="0.0013016" ixy="3.1401e-06" ixz="1.4255e-05" iyy="0.001427" iyz="2.4361e-05" izz="0.00033587"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/G1/arm_l_link3.fbx"/>
      </geometry>
      <material name="white"/>
    </visual>
    <collision>
      <origin rpy="3.141592653589793 -1.2246467991473532e-16 2.5132741228718345" xyz="-0.002745052027917949 0.000636008250640886 -0.07223940640687943"/>
      <geometry>
        <cylinder length="0.22069887816905975" radius="0.05423258091998755"/>
      </geometry>
    </collision>
  </link>
  <link name="arm_l_link4">
    <inertial>
      <origin rpy="0 0 0" xyz="3.7035e-05 -0.06248 0.0025377"/>
      <mass value="0.27473"/>
      <inertia ixx="0.00029284" ixy="4.6615e-07" ixz="6.2359e-08" iyy="0.00018853" iyz="-1.1062e-06" izz="0.00031238"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/G1/arm_l_link4.fbx"/>
      </geometry>
      <material name="white"/>
    </visual>
    <collision>
      <origin rpy="1.5707963267948966 0 0" xyz="0.0 -0.03817895 -0.0043945312"/>
      <geometry>
        <cylinder length="0.154955404" radius="0.057891708"/>
      </geometry>
    </collision>
  </link>
  <link name="arm_l_link5">
    <inertial>
      <origin rpy="0 0 0" xyz="-7.9404e-07 -0.00023094 -0.024143"/>
      <mass value="0.25139"/>
      <inertia ixx="0.00023516" ixy="-1.3496e-09" ixz="-2.0314e-08" iyy="0.00028808" iyz="-1.2106e-05" izz="0.00013069"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/G1/arm_l_link5.fbx"/>
      </geometry>
      <material name="white"/>
    </visual>
    <collision>
      <origin rpy="0.0 0.0 -0.6283185307179586" xyz="0.00013161953185003987 -5.835551655943335e-05 -0.033305803313851357"/>
      <geometry>
        <cylinder length="0.13452399894595146" radius="0.045614576801007695"/>
      </geometry>
    </collision>
  </link>
  <link name="arm_l_link6">
    <inertial>
      <origin rpy="0 0 0" xyz="1.769e-06 -0.086692 0.0025571"/>
      <mass value="0.26634"/>
      <inertia ixx="0.00031434" ixy="-2.9254e-09" ixz="1.0017e-07" iyy="0.00014464" iyz="-2.0329e-05" izz="0.0003245"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/G1/arm_l_link6.fbx"/>
      </geometry>
      <material name="white"/>
    </visual>
    <collision>
      <origin rpy="-5.990089690983079e-19 -1.4805425285141327 -1.5677635369963552" xyz="0.0002549462426528953 -0.055477687883556816 -0.0019394332157672595"/>
      <geometry>
        <cylinder length="0.1816599826988493" radius="0.048507387167967514"/>
      </geometry>
    </collision>
  </link>
  <link name="arm_l_end_link">
    <inertial>
      <origin rpy="0 0 0" xyz="-7.5113e-05 -0.00024521 -0.016705"/>
      <mass value="0.06158"/>
      <inertia ixx="1.8407e-05" ixy="3.4796e-08" ixz="-3.2424e-09" iyy="1.818e-05" iyz="1.1327e-07" izz="2.8547e-05"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/G1/arm_l_link7.fbx"/>
      </geometry>
      <material name="white"/>
    </visual>
    <collision>
      <origin rpy="3.141592653589793 -1.2246467991473532e-16 3.141592653589793" xyz="-4.552953707661759e-05 -0.002300474691790042 -0.02249999972991645"/>
      <geometry>
        <cylinder length="0.045999998692423105" radius="0.030799950382754494"/>
      </geometry>
    </collision>
  </link>
  <!-- joints -->
  <joint name="idx21_arm_l_joint1" type="revolute">
    <parent link="arm_l_base_link"/>
    <child link="arm_l_link1"/>
    <origin rpy="0 0 0" xyz="0.0 0.0 0.1859"/>
    <axis xyz="0.0 0.0 1.0"/>
    <limit effort="60.0" lower="-3.14" upper="3.14" velocity="3.14"/>
  </joint>
  <joint name="idx22_arm_l_joint2" type="revolute">
    <parent link="arm_l_link1"/>
    <child link="arm_l_link2"/>
    <origin rpy="-1.5707963267948966 0.0 1.5707963267948966" xyz="0.0 0.0 0.0"/>
    <axis xyz="0.0 0.0 1.0"/>
    <limit effort="60.0" lower="-2.09" upper="1.48" velocity="3.14"/>
  </joint>
  <joint name="idx23_arm_l_joint3" type="revolute">
    <parent link="arm_l_link2"/>
    <child link="arm_l_link3"/>
    <origin rpy="-1.5707963267948966 1.5707963267948966 3.141592653589793" xyz="0.0 -0.305 0.0"/>
    <axis xyz="0.0 0.0 1.0"/>
    <limit effort="60.0" lower="-3.10" upper="3.10" velocity="3.14"/>
  </joint>
  <joint name="idx24_arm_l_joint4" type="revolute">
    <parent link="arm_l_link3"/>
    <child link="arm_l_link4"/>
    <origin rpy="-1.5707963267948966 0.0 3.141592653589793" xyz="0.0 0.0 0.0"/>
    <axis xyz="0.0 0.0 1.0"/>
    <limit effort="60.0" lower="-1.48" upper="1.48" velocity="3.14"/>
  </joint>
  <joint name="idx25_arm_l_joint5" type="revolute">
    <parent link="arm_l_link4"/>
    <child link="arm_l_link5"/>
    <origin rpy="-1.5707963267948966 0.0 -3.141592653589793" xyz="0.0 -0.1975 0.0"/>
    <axis xyz="0.0 0.0 1.0"/>
    <limit effort="30.0" lower="-3.10" upper="3.10" velocity="3.14"/>
  </joint>
  <joint name="idx26_arm_l_joint6" type="revolute">
    <parent link="arm_l_link5"/>
    <child link="arm_l_link6"/>
    <origin rpy="-1.5707963267948966 0.0 0.0" xyz="0.0 0.0 0.0"/>
    <axis xyz="0.0 0.0 1.0"/>
    <limit effort="30.0" lower="-1.74" upper="1.74" velocity="3.14"/>
  </joint>
  <joint name="idx27_arm_l_joint7" type="revolute">
    <origin rpy="1.5707963267948966 0.0 0.0" xyz="0.0 -0.1805 0.0"/>
    <parent link="arm_l_link6"/>
    <child link="arm_l_end_link"/>
    <axis xyz="0.0 0.0 1.0"/>
    <limit effort="30.0" lower="-3.10" upper="3.10" velocity="3.14"/>
  </joint>
  <!-- properties -->
  <!-- links -->
  <link name="arm_r_link1">
    <inertial>
      <origin rpy="0 0 0" xyz="0.0012679 -0.0001581 -0.018109"/>
      <mass value="0.4936"/>
      <inertia ixx="0.00075396" ixy="-2.4144e-06" ixz="-1.8364e-06" iyy="0.0006605" iyz="1.2174e-06" izz="0.00031553"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/G1/arm_r_link1.fbx"/>
      </geometry>
      <material name="white"/>
    </visual>
    <collision>
      <origin rpy="-3.141592653589793 -1.2246467991473535e-16 1.2566370614359175" xyz="0.00018724019569230644 -0.002004870648449318 -0.04071185737848282"/>
      <geometry>
        <cylinder length="0.16642716526985168" radius="0.0548390473201415"/>
      </geometry>
    </collision>
  </link>
  <link name="arm_r_link2">
    <inertial>
      <origin rpy="0 0 0" xyz="-0.00044207 -0.082298 0.00019486"/>
      <mass value="0.41662"/>
      <inertia ixx="0.00054592" ixy="4.7265e-06" ixz="2.4946e-06" iyy="0.00039507" iyz="-2.0629e-05" izz="0.00057791"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/G1/arm_r_link2.fbx"/>
      </geometry>
      <material name="white"/>
    </visual>
    <collision>
      <origin rpy="1.5707963267948966 0 0" xyz="0.0 -0.044062052 0.0009765625"/>
      <geometry>
        <cylinder length="0.18085919" radius="0.06302423"/>
      </geometry>
    </collision>
  </link>
  <link name="arm_r_link3">
    <inertial>
      <origin rpy="0 0 0" xyz="0.0010558 4.4416e-05 -0.056128"/>
      <mass value="0.49413"/>
      <inertia ixx="0.0013405" ixy="-6.8527e-07" ixz="-1.3381e-05" iyy="0.00142" iyz="2.8511e-05" izz="0.00037605"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/G1/arm_r_link3.fbx"/>
      </geometry>
      <material name="white"/>
    </visual>
    <collision>
      <origin rpy="0 0 0" xyz="0.0006559932284637068 -2.2628975236450855e-05 -0.07219303026795387"/>
      <geometry>
        <cylinder length="0.22061403840780258" radius="0.05216156143823925"/>
      </geometry>
    </collision>
  </link>
  <link name="arm_r_link4">
    <inertial>
      <origin rpy="0 0 0" xyz="2.4212e-05 -0.06248 0.002536"/>
      <mass value="0.27473"/>
      <inertia ixx="0.00029283" ixy="4.5586e-07" ixz="5.8042e-08" iyy="0.00018852" iyz="-1.116e-06" izz="0.00031238"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/G1/arm_r_link4.fbx"/>
      </geometry>
      <material name="white"/>
    </visual>
    <collision>
      <origin rpy="1.5707963267948966 0 0" xyz="0.0 -0.03817895 -0.0043945312"/>
      <geometry>
        <cylinder length="0.154955404" radius="0.057891708"/>
      </geometry>
    </collision>
  </link>
  <link name="arm_r_link5">
    <inertial>
      <origin rpy="0 0 0" xyz="2.6223e-06 -0.00023041 -0.024141"/>
      <mass value="0.25139"/>
      <inertia ixx="0.00023516" ixy="-6.5868e-09" ixz="-1.9428e-08" iyy="0.00028807" iyz="-1.2108e-05" izz="0.00013068"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/G1/arm_r_link5.fbx"/>
      </geometry>
      <material name="white"/>
    </visual>
    <collision>
      <origin rpy="0 0 0" xyz="-0.00022255510134868567 -4.227476414728204e-05 -0.03344946540892124"/>
      <geometry>
        <cylinder length="0.13423806056380272" radius="0.04562028545392604"/>
      </geometry>
    </collision>
  </link>
  <link name="arm_r_link6">
    <inertial>
      <origin rpy="0 0 0" xyz="5.0382e-06 -0.086696 0.002556"/>
      <mass value="0.26634"/>
      <inertia ixx="0.00031434" ixy="-1.2113e-09" ixz="1.0011e-07" iyy="0.00014464" iyz="-2.033e-05" izz="0.00032449"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/G1/arm_r_link6.fbx"/>
      </geometry>
      <material name="white"/>
    </visual>
    <collision>
      <origin rpy="0.0 -1.4835107730827122 -1.56897465223053" xyz="-1.7782549414354032e-05 -0.05507596972928094 -0.0017447156928267265"/>
      <geometry>
        <cylinder length="0.18272488500982115" radius="0.04857149291994264"/>
      </geometry>
    </collision>
  </link>
  <link name="arm_r_end_link">
    <inertial>
      <origin rpy="0 0 0" xyz="-7.5134e-05 -0.00024521 -0.016705"/>
      <mass value="0.06158"/>
      <inertia ixx="1.8407e-05" ixy="3.4818e-08" ixz="-3.2902e-09" iyy="1.818e-05" iyz="1.1326e-07" izz="2.8547e-05"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/G1/arm_r_link7.fbx"/>
      </geometry>
      <material name="white"/>
    </visual>
    <collision>
      <origin rpy="3.141592653589793 -1.2246467991473532e-16 3.141592653589793" xyz="-4.552953707661759e-05 -0.002300474691790042 -0.02249999972991645"/>
      <geometry>
        <cylinder length="0.045999998692423105" radius="0.030799950382754494"/>
      </geometry>
    </collision>
  </link>
  <!-- joints -->
  <joint name="idx61_arm_r_joint1" type="revolute">
    <parent link="arm_r_base_link"/>
    <child link="arm_r_link1"/>
    <origin rpy="0 0 0" xyz="0.0 0.0 0.188"/>
    <axis xyz="0.0 0.0 1.0"/>
    <limit effort="60.0" lower="-3.14" upper="3.14" velocity="3.14"/>
  </joint>
  <joint name="idx62_arm_r_joint2" type="revolute">
    <parent link="arm_r_link1"/>
    <child link="arm_r_link2"/>
    <origin rpy="-1.5707963267948966 0.0 -1.5707963267948966" xyz="0.0 0.0 0.0"/>
    <axis xyz="0.0 0.0 1.0"/>
    <limit effort="60.0" lower="-1.48" upper="2.09" velocity="3.14"/>
  </joint>
  <joint name="idx63_arm_r_joint3" type="revolute">
    <parent link="arm_r_link2"/>
    <child link="arm_r_link3"/>
    <origin rpy="-1.5707963267948966 -1.5707963267948966 3.141592653589793" xyz="0.0 -0.305 0.0"/>
    <axis xyz="0.0 0.0 1.0"/>
    <limit effort="60.0" lower="-3.10" upper="3.10" velocity="3.14"/>
  </joint>
  <joint name="idx64_arm_r_joint4" type="revolute">
    <parent link="arm_r_link3"/>
    <child link="arm_r_link4"/>
    <origin rpy="-1.5707963267948966 0.0 3.141592653589793" xyz="0.0 0.0 0.0"/>
    <axis xyz="0.0 0.0 1.0"/>
    <limit effort="60.0" lower="-1.48" upper="1.48" velocity="3.14"/>
  </joint>
  <joint name="idx65_arm_r_joint5" type="revolute">
    <parent link="arm_r_link4"/>
    <child link="arm_r_link5"/>
    <origin rpy="-1.5707963267948966 0.0 -3.141592653589793" xyz="0.0 -0.1975 0.0"/>
    <axis xyz="0.0 0.0 1.0"/>
    <limit effort="30.0" lower="-3.10" upper="3.10" velocity="3.14"/>
  </joint>
  <joint name="idx66_arm_r_joint6" type="revolute">
    <parent link="arm_r_link5"/>
    <child link="arm_r_link6"/>
    <origin rpy="-1.5707963267948966 0.0 0.0" xyz="0.0 0.0 0.0"/>
    <axis xyz="0.0 0.0 1.0"/>
    <limit effort="30.0" lower="-1.74" upper="1.74" velocity="3.14"/>
  </joint>
  <joint name="idx67_arm_r_joint7" type="revolute">
    <origin rpy="1.5707963267948966 0.0 0.0" xyz="0.0 -0.1805 0.0"/>
    <parent link="arm_r_link6"/>
    <child link="arm_r_end_link"/>
    <axis xyz="0.0 0.0 1.0"/>
    <limit effort="30.0" lower="-3.10" upper="3.10" velocity="3.14"/>
  </joint>
  <!-- Gripper L-->
  <link name="gripper_l_base_link">
    <inertial>
      <origin rpy="0 0 0" xyz="-0.00013356 1.5301E-05 0.03322"/>
      <mass value="0.23588"/>
      <inertia ixx="8.1548E-05" ixy="-1.2617E-08" ixz="-2.05E-07" iyy="5.6921E-05" iyz="6.6903E-08" izz="7.1611E-05"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/gripper_base_link.dae"/>
      </geometry>
      <!-- <material name="white" /> -->
    </visual>
    <collision>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/gripper_base_link.dae"/>
      </geometry>
    </collision>
  </link>
  <link name="gripper_l_inner_link1">
    <inertial>
      <origin rpy="0 0 0" xyz="0.0094685 0.0068806 6.5437E-05"/>
      <mass value="0.025428"/>
      <inertia ixx="1.9574E-06" ixy="-4.2911E-07" ixz="-3.7111E-11" iyy="2.3919E-06" iyz="-3.008E-10" izz="1.5501E-06"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/inner_link1.dae"/>
      </geometry>
      <!-- <material name="orange" /> -->
    </visual>
    <collision>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/inner_link1.dae"/>
      </geometry>
    </collision>
  </link>
  <joint name="idx31_gripper_l_inner_joint1" type="revolute">
    <origin rpy="-2.9951 -1.5707963267948966 -0.15964" xyz="0 -0.0195 0.0565"/>
    <parent link="gripper_l_base_link"/>
    <child link="gripper_l_inner_link1"/>
    <axis xyz="0 0 -1"/>
    <limit effort="10" lower="-0.7853981633974483" upper="0" velocity="10"/>
    <mimic joint="idx41_gripper_l_outer_joint1" multiplier="-1" offset="0"/>
  </joint>
  <link name="gripper_l_inner_link3">
    <inertial>
      <origin rpy="0 0 0" xyz="0.0088027 -0.007035 1.6424E-05"/>
      <mass value="0.0040132"/>
      <inertia ixx="1.0307E-07" ixy="5.7851E-08" ixz="9.5801E-11" iyy="1.1385E-07" iyz="-2.81E-11" izz="1.7009E-07"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/inner_link3.dae"/>
      </geometry>
      <!-- <material name="green" /> -->
    </visual>
    <collision>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/inner_link3.dae"/>
      </geometry>
    </collision>
  </link>
  <joint name="idx32_gripper_l_inner_joint3" type="revolute">
    <origin rpy="0 0 0" xyz="0.030852 0.018551 0"/>
    <parent link="gripper_l_inner_link1"/>
    <child link="gripper_l_inner_link3"/>
    <axis xyz="0 0 -1"/>
    <limit effort="10" lower="-2" upper="2" velocity="10"/>
  </joint>
  <link name="gripper_l_inner_link4">
    <inertial>
      <origin rpy="0 0 0" xyz="0.012508 -0.0079729 9.4339E-05"/>
      <mass value="0.018029"/>
      <inertia ixx="1.1403E-06" ixy="5.5159E-07" ixz="-4.0096E-13" iyy="2.5704E-06" iyz="1.0951E-12" izz="2.3252E-06"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/inner_link4.dae"/>
      </geometry>
      <!-- <material name="white" /> -->
    </visual>
    <collision>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/inner_link4.dae"/>
      </geometry>
    </collision>
  </link>
  <joint name="idx33_gripper_l_inner_joint4" type="revolute">
    <origin rpy="0 0 0" xyz="0.018118 -0.01574 0"/>
    <parent link="gripper_l_inner_link3"/>
    <child link="gripper_l_inner_link4"/>
    <axis xyz="0 0 -1"/>
    <limit effort="10" lower="-2" upper="2" velocity="10"/>
  </joint>
  <link name="gripper_l_inner_link2">
    <inertial>
      <origin rpy="0 0 0" xyz="0.014869 -0.0036066 0.00029307"/>
      <mass value="0.022591"/>
      <inertia ixx="4.3916E-06" ixy="1.114E-07" ixz="-4.9655E-12" iyy="4.737E-06" iyz="1.7121E-11" izz="6.0445E-07"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/inner_link2.dae"/>
      </geometry>
      <!-- <material name="blue" /> -->
    </visual>
    <collision>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/inner_link2.dae"/>
      </geometry>
    </collision>
  </link>
  <joint name="idx39_gripper_l_inner_joint2" type="revolute">
    <origin rpy="-2.9951 -1.5707963267948966 -0.15964" xyz="0 -0.021633 0.07387"/>
    <parent link="gripper_l_base_link"/>
    <child link="gripper_l_inner_link2"/>
    <axis xyz="0 0 -1"/>
    <limit effort="10" lower="-2" upper="2" velocity="10"/>
  </joint>
  <link name="gripper_l_outer_link1">
    <inertial>
      <origin rpy="0 0 0" xyz="0.0095051 -0.0068479 6.8268E-05"/>
      <mass value="0.025428"/>
      <inertia ixx="1.9565E-06" ixy="4.2798E-07" ixz="2.3844E-10" iyy="2.3928E-06" iyz="-1.4454E-10" izz="1.5501E-06"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/outer_link1.dae"/>
      </geometry>
      <!-- <material name="orange" /> -->
    </visual>
    <collision>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/outer_link1.dae"/>
      </geometry>
    </collision>
  </link>
  <joint name="idx41_gripper_l_outer_joint1" type="revolute">
    <origin rpy="-2.9951 -1.5707963267948966 -0.15964" xyz="0 0.0195 0.0565"/>
    <parent link="gripper_l_base_link"/>
    <child link="gripper_l_outer_link1"/>
    <axis xyz="0 0 -1"/>
    <limit effort="10" lower="0" upper="0.7853981633974483" velocity="10"/>
  </joint>
  <link name="gripper_l_outer_link3">
    <inertial>
      <origin rpy="0 0 0" xyz="0.0088027 0.007035 -1.6424E-05"/>
      <mass value="0.0040132"/>
      <inertia ixx="1.0307E-07" ixy="-5.7851E-08" ixz="-9.58E-11" iyy="1.1385E-07" iyz="-2.81E-11" izz="1.7009E-07"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/outer_link3.dae"/>
      </geometry>
      <!-- <material name="green" /> -->
    </visual>
    <collision>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/outer_link3.dae"/>
      </geometry>
    </collision>
  </link>
  <joint name="idx42_gripper_l_outer_joint3" type="revolute">
    <origin rpy="0 0 0" xyz="0.030852 -0.018551 0"/>
    <parent link="gripper_l_outer_link1"/>
    <child link="gripper_l_outer_link3"/>
    <axis xyz="0 0 -1"/>
    <limit effort="10" lower="-2" upper="2" velocity="10"/>
  </joint>
  <link name="gripper_l_outer_link4">
    <inertial>
      <origin rpy="0 0 0" xyz="0.016206 0.0094593 4.7668E-05"/>
      <mass value="0.035835"/>
      <inertia ixx="8.5056E-06" ixy="-1.1363E-06" ixz="-4.2908E-11" iyy="1.1235E-05" iyz="-2.9251E-11" izz="4.6309E-06"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/outer_link4.dae"/>
      </geometry>
      <!-- <material name="white" /> -->
    </visual>
    <collision>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/outer_link4.dae"/>
      </geometry>
    </collision>
  </link>
  <joint name="idx43_gripper_l_outer_joint4" type="revolute">
    <origin rpy="0 0 0" xyz="0.018118 0.01574 0"/>
    <parent link="gripper_l_outer_link3"/>
    <child link="gripper_l_outer_link4"/>
    <axis xyz="0 0 -1"/>
    <limit effort="10" lower="-2" upper="2" velocity="10"/>
  </joint>
  <link name="gripper_l_outer_link2">
    <inertial>
      <origin rpy="0 0 0" xyz="0.016268 0.0040555 0.00030323"/>
      <mass value="0.025142"/>
      <inertia ixx="5.887E-06" ixy="-1.1234E-07" ixz="2.1954E-11" iyy="6.236E-06" iyz="-9.473E-12" izz="6.2389E-07"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/outer_link2.dae"/>
      </geometry>
      <!-- <material name="blue" /> -->
    </visual>
    <collision>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/outer_link2.dae"/>
      </geometry>
    </collision>
  </link>
  <joint name="idx49_gripper_l_outer_joint2" type="revolute">
    <origin rpy="-2.9951 -1.5707963267948966 -0.15964" xyz="0 0.021633 0.07387"/>
    <parent link="gripper_l_base_link"/>
    <child link="gripper_l_outer_link2"/>
    <axis xyz="0 0 -1"/>
    <limit effort="10" lower="-2" upper="2" velocity="10"/>
  </joint>
  <!-- Gripper Connector -->
  <joint name="idx51_ee_l_joint" type="fixed">
    <origin rpy="0 0 1.5707963267948966" xyz="0 0 0"/>
    <parent link="arm_l_end_link"/>
    <child link="gripper_l_base_link"/>
    <axis xyz="0 0 0"/>
  </joint>
  <link name="gripper_l_center_link">
    </link>
  <joint name="idx52_gripper_l_center_joint" type="fixed">
    <origin rpy="0 0 -1.5707963267948966" xyz="0.0 0.0 0.14308"/>
    <parent link="gripper_l_base_link"/>
    <child link="gripper_l_center_link"/>
  </joint>
  <!-- Gripper Finger Close-loop Structure -->
  <loop_joint name="idx53_gripper_l_outer_joint0" type="spherical">
    <link1 link="gripper_l_outer_link2" rpy="0 0 0" xyz="0.03123003 0.010280428 0"/>
    <link2 link="gripper_l_outer_link4" rpy="0 0 0" xyz="0 0.010280428 0"/>
    <axis xyz="0 0 1"/>
  </loop_joint>
  <loop_joint name="idx54_gripper_l_inner_joint0" type="spherical">
    <link1 link="gripper_l_inner_link2" rpy="0 0 0" xyz="0.03123003 -0.010280428 0"/>
    <link2 link="gripper_l_inner_link4" rpy="0 0 0" xyz="0 -0.010280428 0"/>
    <axis xyz="0 0 1"/>
  </loop_joint>
  <!-- Gripper R-->
  <link name="gripper_r_base_link">
    <inertial>
      <origin rpy="0 0 0" xyz="-0.00013356 1.5301E-05 0.03322"/>
      <mass value="0.23588"/>
      <inertia ixx="8.1548E-05" ixy="-1.2617E-08" ixz="-2.05E-07" iyy="5.6921E-05" iyz="6.6903E-08" izz="7.1611E-05"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/gripper_base_link.dae"/>
      </geometry>
      <!-- <material name="white" /> -->
    </visual>
    <collision>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/gripper_base_link.dae"/>
      </geometry>
    </collision>
  </link>
  <link name="gripper_r_inner_link1">
    <inertial>
      <origin rpy="0 0 0" xyz="0.0094685 0.0068806 6.5437E-05"/>
      <mass value="0.025428"/>
      <inertia ixx="1.9574E-06" ixy="-4.2911E-07" ixz="-3.7111E-11" iyy="2.3919E-06" iyz="-3.008E-10" izz="1.5501E-06"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/inner_link1.dae"/>
      </geometry>
      <!-- <material name="orange" /> -->
    </visual>
    <collision>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/inner_link1.dae"/>
      </geometry>
    </collision>
  </link>
  <joint name="idx71_gripper_r_inner_joint1" type="revolute">
    <origin rpy="-2.9951 -1.5707963267948966 -0.15964" xyz="0 -0.0195 0.0565"/>
    <parent link="gripper_r_base_link"/>
    <child link="gripper_r_inner_link1"/>
    <axis xyz="0 0 -1"/>
    <limit effort="10" lower="-0.7853981633974483" upper="0" velocity="10"/>
    <mimic joint="idx81_gripper_r_outer_joint1" multiplier="-1" offset="0"/>
  </joint>
  <link name="gripper_r_inner_link3">
    <inertial>
      <origin rpy="0 0 0" xyz="0.0088027 -0.007035 1.6424E-05"/>
      <mass value="0.0040132"/>
      <inertia ixx="1.0307E-07" ixy="5.7851E-08" ixz="9.5801E-11" iyy="1.1385E-07" iyz="-2.81E-11" izz="1.7009E-07"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/inner_link3.dae"/>
      </geometry>
      <!-- <material name="green" /> -->
    </visual>
    <collision>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/inner_link3.dae"/>
      </geometry>
    </collision>
  </link>
  <joint name="idx72_gripper_r_inner_joint3" type="revolute">
    <origin rpy="0 0 0" xyz="0.030852 0.018551 0"/>
    <parent link="gripper_r_inner_link1"/>
    <child link="gripper_r_inner_link3"/>
    <axis xyz="0 0 -1"/>
    <limit effort="10" lower="-2" upper="2" velocity="10"/>
  </joint>
  <link name="gripper_r_inner_link4">
    <inertial>
      <origin rpy="0 0 0" xyz="0.012508 -0.0079729 9.4339E-05"/>
      <mass value="0.018029"/>
      <inertia ixx="1.1403E-06" ixy="5.5159E-07" ixz="-4.0096E-13" iyy="2.5704E-06" iyz="1.0951E-12" izz="2.3252E-06"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/inner_link4.dae"/>
      </geometry>
      <!-- <material name="white" /> -->
    </visual>
    <collision>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/inner_link4.dae"/>
      </geometry>
    </collision>
  </link>
  <joint name="idx73_gripper_r_inner_joint4" type="revolute">
    <origin rpy="0 0 0" xyz="0.018118 -0.01574 0"/>
    <parent link="gripper_r_inner_link3"/>
    <child link="gripper_r_inner_link4"/>
    <axis xyz="0 0 -1"/>
    <limit effort="10" lower="-2" upper="2" velocity="10"/>
  </joint>
  <link name="gripper_r_inner_link2">
    <inertial>
      <origin rpy="0 0 0" xyz="0.014869 -0.0036066 0.00029307"/>
      <mass value="0.022591"/>
      <inertia ixx="4.3916E-06" ixy="1.114E-07" ixz="-4.9655E-12" iyy="4.737E-06" iyz="1.7121E-11" izz="6.0445E-07"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/inner_link2.dae"/>
      </geometry>
      <!-- <material name="blue" /> -->
    </visual>
    <collision>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/inner_link2.dae"/>
      </geometry>
    </collision>
  </link>
  <joint name="idx79_gripper_r_inner_joint2" type="revolute">
    <origin rpy="-2.9951 -1.5707963267948966 -0.15964" xyz="0 -0.021633 0.07387"/>
    <parent link="gripper_r_base_link"/>
    <child link="gripper_r_inner_link2"/>
    <axis xyz="0 0 -1"/>
    <limit effort="10" lower="-2" upper="2" velocity="10"/>
  </joint>
  <link name="gripper_r_outer_link1">
    <inertial>
      <origin rpy="0 0 0" xyz="0.0095051 -0.0068479 6.8268E-05"/>
      <mass value="0.025428"/>
      <inertia ixx="1.9565E-06" ixy="4.2798E-07" ixz="2.3844E-10" iyy="2.3928E-06" iyz="-1.4454E-10" izz="1.5501E-06"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/outer_link1.dae"/>
      </geometry>
      <!-- <material name="orange" /> -->
    </visual>
    <collision>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/outer_link1.dae"/>
      </geometry>
    </collision>
  </link>
  <joint name="idx81_gripper_r_outer_joint1" type="revolute">
    <origin rpy="-2.9951 -1.5707963267948966 -0.15964" xyz="0 0.0195 0.0565"/>
    <parent link="gripper_r_base_link"/>
    <child link="gripper_r_outer_link1"/>
    <axis xyz="0 0 -1"/>
    <limit effort="10" lower="0" upper="0.7853981633974483" velocity="10"/>
  </joint>
  <link name="gripper_r_outer_link3">
    <inertial>
      <origin rpy="0 0 0" xyz="0.0088027 0.007035 -1.6424E-05"/>
      <mass value="0.0040132"/>
      <inertia ixx="1.0307E-07" ixy="-5.7851E-08" ixz="-9.58E-11" iyy="1.1385E-07" iyz="-2.81E-11" izz="1.7009E-07"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/outer_link3.dae"/>
      </geometry>
      <!-- <material name="green" /> -->
    </visual>
    <collision>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/outer_link3.dae"/>
      </geometry>
    </collision>
  </link>
  <joint name="idx82_gripper_r_outer_joint3" type="revolute">
    <origin rpy="0 0 0" xyz="0.030852 -0.018551 0"/>
    <parent link="gripper_r_outer_link1"/>
    <child link="gripper_r_outer_link3"/>
    <axis xyz="0 0 -1"/>
    <limit effort="10" lower="-2" upper="2" velocity="10"/>
  </joint>
  <link name="gripper_r_outer_link4">
    <inertial>
      <origin rpy="0 0 0" xyz="0.016206 0.0094593 4.7668E-05"/>
      <mass value="0.035835"/>
      <inertia ixx="8.5056E-06" ixy="-1.1363E-06" ixz="-4.2908E-11" iyy="1.1235E-05" iyz="-2.9251E-11" izz="4.6309E-06"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/outer_link4.dae"/>
      </geometry>
      <!-- <material name="white" /> -->
    </visual>
    <collision>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/outer_link4.dae"/>
      </geometry>
    </collision>
  </link>
  <joint name="idx83_gripper_r_outer_joint4" type="revolute">
    <origin rpy="0 0 0" xyz="0.018118 0.01574 0"/>
    <parent link="gripper_r_outer_link3"/>
    <child link="gripper_r_outer_link4"/>
    <axis xyz="0 0 -1"/>
    <limit effort="10" lower="-2" upper="2" velocity="10"/>
  </joint>
  <link name="gripper_r_outer_link2">
    <inertial>
      <origin rpy="0 0 0" xyz="0.016268 0.0040555 0.00030323"/>
      <mass value="0.025142"/>
      <inertia ixx="5.887E-06" ixy="-1.1234E-07" ixz="2.1954E-11" iyy="6.236E-06" iyz="-9.473E-12" izz="6.2389E-07"/>
    </inertial>
    <visual>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/outer_link2.dae"/>
      </geometry>
      <!-- <material name="blue" /> -->
    </visual>
    <collision>
      <origin rpy="0 0 0" xyz="0 0 0"/>
      <geometry>
        <mesh filename="package://genie_robot_description/meshes/omnipicker/outer_link2.dae"/>
      </geometry>
    </collision>
  </link>
  <joint name="idx89_gripper_r_outer_joint2" type="revolute">
    <origin rpy="-2.9951 -1.5707963267948966 -0.15964" xyz="0 0.021633 0.07387"/>
    <parent link="gripper_r_base_link"/>
    <child link="gripper_r_outer_link2"/>
    <axis xyz="0 0 -1"/>
    <limit effort="10" lower="-2" upper="2" velocity="10"/>
  </joint>
  <!-- Gripper Connector -->
  <joint name="idx91_ee_r_joint" type="fixed">
    <origin rpy="0 0 -1.5707963267948966" xyz="0 0 0"/>
    <parent link="arm_r_end_link"/>
    <child link="gripper_r_base_link"/>
    <axis xyz="0 0 0"/>
  </joint>
  <link name="gripper_r_center_link">
    </link>
  <joint name="idx92_gripper_r_center_joint" type="fixed">
    <origin rpy="0 0 -1.5707963267948966" xyz="0.0 0.0 0.14308"/>
    <parent link="gripper_r_base_link"/>
    <child link="gripper_r_center_link"/>
  </joint>
  <!-- Gripper Finger Close-loop Structure -->
  <loop_joint name="idx93_gripper_r_outer_joint0" type="spherical">
    <link1 link="gripper_r_outer_link2" rpy="0 0 0" xyz="0.03123003 0.010280428 0"/>
    <link2 link="gripper_r_outer_link4" rpy="0 0 0" xyz="0 0.010280428 0"/>
    <axis xyz="0 0 1"/>
  </loop_joint>
  <loop_joint name="idx94_gripper_r_inner_joint0" type="spherical">
    <link1 link="gripper_r_inner_link2" rpy="0 0 0" xyz="0.03123003 -0.010280428 0"/>
    <link2 link="gripper_r_inner_link4" rpy="0 0 0" xyz="0 -0.010280428 0"/>
    <axis xyz="0 0 1"/>
  </loop_joint>
  <!-- Eastern Eggs -->
  <!-- All Together -->
</robot>
