RobotDescription

Atlas DRC (v3)

Boston Dynamics · licence BSD-3-Clause · source: github.com/RobotLocomotion/drake @ 7abea0556

What you are looking at is RobotDescription.from_urdf(original).to_urdf_string(): the reference implementation's re-serialisation of the original file, not the original file itself.

MuJoCo is unavailable for this robot: Error: size 0 must be positive in geom.

Loading the model…

drag to orbit · scroll to zoom · right-drag to pan

robot.urdf

<?xml version="1.0" encoding="UTF-8"?>
<!-- generated by bam_robot_descriptions (py backend), content cc2aa84fe8b66e48 -->
<robot name="atlas">
  <link name="l_clav">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_clav.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_clav_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.0 0.0 -0.084" rpy="0.0 0.0 0.0" />
      <mass value="4.466" />
      <inertia ixx="0.011" ixy="0.0" ixz="0.0" iyy="0.009" iyz="0.004" izz="0.004" />
    </inertial>
  </link>
  <link name="l_foot">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/l_foot.obj" />
      </geometry>
    </visual>
    <visual>
      <origin xyz="-0.0876 0.066 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.01" />
      </geometry>
    </visual>
    <visual>
      <origin xyz="-0.0876 -0.0626 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.01" />
      </geometry>
    </visual>
    <visual>
      <origin xyz="0.1728 0.066 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.01" />
      </geometry>
    </visual>
    <visual>
      <origin xyz="0.1728 -0.0626 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.01" />
      </geometry>
    </visual>
    <visual>
      <origin xyz="-0.0426 0.066 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.01" />
      </geometry>
    </visual>
    <visual>
      <origin xyz="-0.0426 -0.0626 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.01" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/l_foot_chull.obj" />
      </geometry>
    </collision>
    <collision>
      <origin xyz="-0.0876 0.066 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.0" />
      </geometry>
    </collision>
    <collision>
      <origin xyz="-0.0876 -0.0626 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.0" />
      </geometry>
    </collision>
    <collision>
      <origin xyz="0.1728 0.066 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.0" />
      </geometry>
    </collision>
    <collision>
      <origin xyz="0.1728 -0.0626 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.0" />
      </geometry>
    </collision>
    <collision>
      <origin xyz="-0.0426 0.066 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.0" />
      </geometry>
    </collision>
    <collision>
      <origin xyz="-0.0426 -0.0626 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.0" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.027 0.0 -0.067" rpy="0.0 0.0 0.0" />
      <mass value="2.41" />
      <inertia ixx="0.002" ixy="0.0" ixz="0.0" iyy="0.007" iyz="0.0" izz="0.008" />
    </inertial>
  </link>
  <link name="l_hand">
    <inertial>
      <origin xyz="0.00016 -0.08159 2e-05" rpy="0.0 0.0 0.0" />
      <mass value="0.5839" />
      <inertia ixx="0.000388" ixy="0.0" ixz="0.0" iyy="0.000477" iyz="0.0" izz="0.000379" />
    </inertial>
  </link>
  <link name="l_larm">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_larm.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_larm_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <mass value="3.248" />
      <inertia ixx="0.00265" ixy="0.0" ixz="0.0" iyy="0.00446" iyz="0.0" izz="0.00446" />
    </inertial>
  </link>
  <link name="l_lfarm">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_hand.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_hand_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.00017 -0.02515 0.00163" rpy="0.0 0.0 0.0" />
      <mass value="0.648" />
      <inertia ixx="0.000764" ixy="0.0" ixz="0.0" iyy="0.000429" iyz="0.0" izz="0.000825" />
    </inertial>
  </link>
  <link name="l_lglut">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/l_lglut.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/l_lglut_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.0133341 0.0170484 -0.0312052" rpy="0.0 0.0 0.0" />
      <mass value="0.898" />
      <inertia ixx="0.000691326" ixy="-2.24344e-05" ixz="2.50508e-06" iyy="0.00126856" iyz="0.000137862" izz="0.00106487" />
    </inertial>
  </link>
  <link name="l_lleg">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/l_lleg.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/l_lleg_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.001 0.0 -0.187" rpy="0.0 0.0 0.0" />
      <mass value="4.515" />
      <inertia ixx="0.077" ixy="0.0" ixz="-0.003" iyy="0.076" iyz="0.0" izz="0.01" />
    </inertial>
  </link>
  <link name="l_scap">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_scap.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_scap_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <mass value="3.899" />
      <inertia ixx="0.00319" ixy="0.0" ixz="0.0" iyy="0.00583" iyz="0.0" izz="0.00583" />
    </inertial>
  </link>
  <link name="l_talus">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/l_talus.obj" />
      </geometry>
    </visual>
    <inertial>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <mass value="0.125" />
      <inertia ixx="1.01674e-05" ixy="0.0" ixz="0.0" iyy="8.42775e-06" iyz="0.0" izz="1.30101e-05" />
    </inertial>
  </link>
  <link name="l_uarm">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_uarm.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_uarm_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.0 0.065 0.0" rpy="0.0 0.0 0.0" />
      <mass value="4.386" />
      <inertia ixx="0.00656" ixy="0.0" ixz="0.0" iyy="0.00358" iyz="0.0" izz="0.00656" />
    </inertial>
  </link>
  <link name="l_ufarm">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_farm.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_farm_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.00015 0.08296 0.00037" rpy="0.0 0.0 0.0" />
      <mass value="2.4798" />
      <inertia ixx="0.012731" ixy="0.0" ixz="0.0" iyy="0.002857" iyz="0.0" izz="0.011948" />
    </inertial>
  </link>
  <link name="l_uglut">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/l_uglut.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/l_uglut_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.00529262 -0.00344732 0.00313046" rpy="0.0 0.0 0.0" />
      <mass value="1.959" />
      <inertia ixx="0.00074276" ixy="-3.79607e-08" ixz="-2.79549e-05" iyy="0.000688179" iyz="-3.2735e-08" izz="0.00041242" />
    </inertial>
  </link>
  <link name="l_uleg">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/l_uleg.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/l_uleg_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.0 0.0 -0.21" rpy="0.0 0.0 0.0" />
      <mass value="8.204" />
      <inertia ixx="0.09" ixy="0.0" ixz="0.0" iyy="0.09" iyz="0.0" izz="0.02" />
    </inertial>
  </link>
  <link name="ltorso">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/ltorso.obj" />
      </geometry>
    </visual>
    <inertial>
      <origin xyz="-0.0112984 -3.15366e-06 0.0746835" rpy="0.0 0.0 0.0" />
      <mass value="2.27" />
      <inertia ixx="0.0039092" ixy="-5.04491e-08" ixz="-0.000342157" iyy="0.00341694" iyz="4.87119e-07" izz="0.00174492" />
    </inertial>
  </link>
  <link name="mtorso">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/mtorso.obj" />
      </geometry>
    </visual>
    <inertial>
      <origin xyz="-0.00816266 -0.0131245 0.0305974" rpy="0.0 0.0 0.0" />
      <mass value="0.799" />
      <inertia ixx="0.000454181" ixy="-6.10764e-05" ixz="3.94009e-05" iyy="0.000483282" iyz="5.27463e-05" izz="0.000444215" />
    </inertial>
  </link>
  <link name="pelvis">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/pelvis.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/pelvis_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.0111 0.0 0.0271" rpy="0.0 0.0 0.0" />
      <mass value="9.509" />
      <inertia ixx="0.1244" ixy="0.0008" ixz="-0.0007" iyy="0.0958" iyz="-0.0005" izz="0.1167" />
    </inertial>
  </link>
  <link name="r_clav">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_clav.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_clav_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.0 0.0 -0.084" rpy="0.0 0.0 0.0" />
      <mass value="4.466" />
      <inertia ixx="0.011" ixy="0.0" ixz="0.0" iyy="0.009" iyz="0.004" izz="0.004" />
    </inertial>
  </link>
  <link name="r_foot">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_foot.obj" />
      </geometry>
    </visual>
    <visual>
      <origin xyz="-0.0876 0.0626 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.01" />
      </geometry>
    </visual>
    <visual>
      <origin xyz="-0.0876 -0.066 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.01" />
      </geometry>
    </visual>
    <visual>
      <origin xyz="0.1728 0.0626 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.01" />
      </geometry>
    </visual>
    <visual>
      <origin xyz="0.1728 -0.066 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.01" />
      </geometry>
    </visual>
    <visual>
      <origin xyz="0.0426 0.0626 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.01" />
      </geometry>
    </visual>
    <visual>
      <origin xyz="0.0426 -0.066 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.01" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_foot_chull.obj" />
      </geometry>
    </collision>
    <collision>
      <origin xyz="-0.0876 0.0626 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.0" />
      </geometry>
    </collision>
    <collision>
      <origin xyz="-0.0876 -0.066 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.0" />
      </geometry>
    </collision>
    <collision>
      <origin xyz="0.1728 0.0626 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.0" />
      </geometry>
    </collision>
    <collision>
      <origin xyz="0.1728 -0.066 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.0" />
      </geometry>
    </collision>
    <collision>
      <origin xyz="0.0426 0.0626 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.0" />
      </geometry>
    </collision>
    <collision>
      <origin xyz="0.0426 -0.066 -0.07645" rpy="0.0 0.0 0.0" />
      <geometry>
        <sphere radius="0.0" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.027 0.0 -0.067" rpy="0.0 0.0 0.0" />
      <mass value="2.41" />
      <inertia ixx="0.002" ixy="0.0" ixz="0.0" iyy="0.007" iyz="0.0" izz="0.008" />
    </inertial>
  </link>
  <link name="r_hand">
    <inertial>
      <origin xyz="0.00016 -0.08159 2e-05" rpy="0.0 0.0 0.0" />
      <mass value="0.5839" />
      <inertia ixx="0.000388" ixy="0.0" ixz="0.0" iyy="0.000477" iyz="0.0" izz="0.000379" />
    </inertial>
  </link>
  <link name="r_larm">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_larm.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_larm_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <mass value="3.248" />
      <inertia ixx="0.00265" ixy="0.0" ixz="0.0" iyy="0.00446" iyz="0.0" izz="0.00446" />
    </inertial>
  </link>
  <link name="r_lfarm">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_hand.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_hand_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.00017 -0.02515 0.00163" rpy="0.0 0.0 0.0" />
      <mass value="0.648" />
      <inertia ixx="0.000764" ixy="0.0" ixz="0.0" iyy="0.000429" iyz="0.0" izz="0.000825" />
    </inertial>
  </link>
  <link name="r_lglut">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_lglut.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_lglut_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.0133341 -0.0170484 -0.0312052" rpy="0.0 0.0 0.0" />
      <mass value="0.898" />
      <inertia ixx="0.000691326" ixy="2.24344e-05" ixz="2.50508e-06" iyy="0.00126856" iyz="-0.000137862" izz="0.00106487" />
    </inertial>
  </link>
  <link name="r_lleg">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_lleg.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_lleg_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.001 0.0 -0.187" rpy="0.0 0.0 0.0" />
      <mass value="4.515" />
      <inertia ixx="0.077" ixy="-0.0" ixz="-0.003" iyy="0.076" iyz="-0.0" izz="0.01" />
    </inertial>
  </link>
  <link name="r_scap">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_scap.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_scap_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <mass value="3.899" />
      <inertia ixx="0.00319" ixy="0.0" ixz="0.0" iyy="0.00583" iyz="0.0" izz="0.00583" />
    </inertial>
  </link>
  <link name="r_talus">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_talus.obj" />
      </geometry>
    </visual>
    <inertial>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <mass value="0.125" />
      <inertia ixx="1.01674e-05" ixy="0.0" ixz="0.0" iyy="8.42775e-06" iyz="0.0" izz="1.30101e-05" />
    </inertial>
  </link>
  <link name="r_uarm">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_uarm.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_uarm_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.0 0.065 0.0" rpy="0.0 0.0 0.0" />
      <mass value="4.386" />
      <inertia ixx="0.00656" ixy="0.0" ixz="0.0" iyy="0.00358" iyz="0.0" izz="0.00656" />
    </inertial>
  </link>
  <link name="r_ufarm">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_farm.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_farm_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.00015 0.08296 0.00037" rpy="0.0 0.0 0.0" />
      <mass value="2.4798" />
      <inertia ixx="0.012731" ixy="0.0" ixz="0.0" iyy="0.002857" iyz="0.0" izz="0.011948" />
    </inertial>
  </link>
  <link name="r_uglut">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_uglut.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_uglut_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.00529262 0.00344732 0.00313046" rpy="0.0 0.0 0.0" />
      <mass value="1.959" />
      <inertia ixx="0.00074276" ixy="3.79607e-08" ixz="-2.79549e-05" iyy="0.000688179" iyz="3.2735e-08" izz="0.00041242" />
    </inertial>
  </link>
  <link name="r_uleg">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_uleg.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/r_uleg_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.0 0.0 -0.21" rpy="0.0 0.0 0.0" />
      <mass value="8.204" />
      <inertia ixx="0.09" ixy="0.0" ixz="0.0" iyy="0.09" iyz="0.0" izz="0.02" />
    </inertial>
  </link>
  <link name="utorso">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/utorso.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/utorso_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="-0.0622 0.0023 0.3157" rpy="0.0 0.0 0.0" />
      <mass value="84.409" />
      <inertia ixx="1.577" ixy="-0.032" ixz="0.102" iyy="1.602" iyz="0.047" izz="0.565" />
    </inertial>
  </link>
  <joint name="back_bkx" type="revolute">
    <origin xyz="0.0 0.0 0.05" rpy="0.0 0.0 0.0" />
    <parent link="mtorso" />
    <child link="utorso" />
    <axis xyz="1.0 0.0 0.0" />
    <limit effort="300.0" velocity="12.0" lower="-0.523599" upper="0.523599" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="back_bky" type="revolute">
    <origin xyz="0.0 0.0 0.162" rpy="0.0 0.0 0.0" />
    <parent link="ltorso" />
    <child link="mtorso" />
    <axis xyz="0.0 1.0 0.0" />
    <limit effort="445.0" velocity="9.0" lower="-0.219388" upper="0.538783" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="back_bkz" type="revolute">
    <origin xyz="-0.0125 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="pelvis" />
    <child link="ltorso" />
    <axis xyz="0.0 0.0 1.0" />
    <limit effort="106.0" velocity="12.0" lower="-0.663225" upper="0.663225" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="l_arm_elx" type="revolute">
    <origin xyz="0.0 -0.119 0.0092" rpy="0.0 0.0 0.0" />
    <parent link="l_uarm" />
    <child link="l_larm" />
    <axis xyz="-1.0 -0.0 -0.0" />
    <limit effort="112.0" velocity="12.0" lower="0.0" upper="2.35619" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="l_arm_ely" type="revolute">
    <origin xyz="0.0 -0.187 -0.016" rpy="0.0 0.0 0.0" />
    <parent link="l_scap" />
    <child link="l_uarm" />
    <axis xyz="-0.0 -1.0 -0.0" />
    <limit effort="63.0" velocity="12.0" lower="0.0" upper="3.14159" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="l_arm_shx" type="revolute">
    <origin xyz="0.0 -0.11 -0.245" rpy="0.0 0.0 0.0" />
    <parent link="l_clav" />
    <child link="l_scap" />
    <axis xyz="-1.0 -0.0 -0.0" />
    <limit effort="99.0" velocity="12.0" lower="-1.5708" upper="1.5708" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="l_arm_shz" type="revolute">
    <origin xyz="0.1406 0.2256 0.4776" rpy="0.0 0.0 3.14159265359" />
    <parent link="utorso" />
    <child link="l_clav" />
    <axis xyz="0.0 0.0 1.0" />
    <limit effort="87.0" velocity="12.0" lower="-1.5708" upper="0.785398" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="l_arm_mwx" type="revolute">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="l_ufarm" />
    <child link="l_lfarm" />
    <axis xyz="1.0 0.0 0.0" />
    <limit effort="25.0" velocity="10.0" lower="-1.7628" upper="1.7628" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="l_arm_uwy" type="revolute">
    <origin xyz="0.0 -0.29955 -0.00921" rpy="0.0 3.14159265359 0.0" />
    <parent link="l_larm" />
    <child link="l_ufarm" />
    <axis xyz="-0.0 -1.0 -0.0" />
    <limit effort="25.0" velocity="10.0" lower="-3.011" upper="3.011" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="l_arm_lwy" type="revolute">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 3.14159265359 0.0" />
    <parent link="l_lfarm" />
    <child link="l_hand" />
    <axis xyz="-0.0 -1.0 -0.0" />
    <limit effort="25.0" velocity="10.0" lower="-2.9671" upper="2.9671" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="l_leg_akx" type="revolute">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="l_talus" />
    <child link="l_foot" />
    <axis xyz="1.0 0.0 0.0" />
    <limit effort="360.0" velocity="12.0" lower="-0.8" upper="0.8" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="l_leg_aky" type="revolute">
    <origin xyz="0.0 0.0 -0.422" rpy="0.0 0.0 0.0" />
    <parent link="l_lleg" />
    <child link="l_talus" />
    <axis xyz="0.0 1.0 0.0" />
    <limit effort="740.0" velocity="12.0" lower="-1.0" upper="0.7" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="l_leg_hpx" type="revolute">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="l_uglut" />
    <child link="l_lglut" />
    <axis xyz="1.0 0.0 0.0" />
    <limit effort="530.0" velocity="12.0" lower="-0.523599" upper="0.523599" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="l_leg_hpy" type="revolute">
    <origin xyz="0.05 0.0225 -0.066" rpy="0.0 0.0 0.0" />
    <parent link="l_lglut" />
    <child link="l_uleg" />
    <axis xyz="0.0 1.0 0.0" />
    <limit effort="840.0" velocity="12.0" lower="-1.61234" upper="0.65764" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="l_leg_hpz" type="revolute">
    <origin xyz="0.0 0.089 0.0" rpy="0.0 0.0 0.0" />
    <parent link="pelvis" />
    <child link="l_uglut" />
    <axis xyz="0.0 0.0 1.0" />
    <limit effort="275.0" velocity="12.0" lower="-0.174358" upper="0.786794" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="l_leg_kny" type="revolute">
    <origin xyz="-0.05 0.0 -0.374" rpy="0.0 0.0 0.0" />
    <parent link="l_uleg" />
    <child link="l_lleg" />
    <axis xyz="0.0 1.0 0.0" />
    <limit effort="890.0" velocity="12.0" lower="0.0" upper="2.35637" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="neck_ay" type="revolute">
    <origin xyz="0.2546 0.0 0.6215" rpy="0.0 0.0 0.0" />
    <parent link="utorso" />
    <child link="head" />
    <axis xyz="0.0 1.0 0.0" />
    <limit effort="25.0" velocity="6.28" lower="-0.602139" upper="1.14319" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="r_arm_elx" type="revolute">
    <origin xyz="0.0 -0.119 0.0092" rpy="0.0 0.0 0.0" />
    <parent link="r_uarm" />
    <child link="r_larm" />
    <axis xyz="1.0 0.0 0.0" />
    <limit effort="112.0" velocity="12.0" lower="-2.35619" upper="0.0" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="r_arm_ely" type="revolute">
    <origin xyz="0.0 -0.187 -0.016" rpy="0.0 0.0 0.0" />
    <parent link="r_scap" />
    <child link="r_uarm" />
    <axis xyz="0.0 1.0 0.0" />
    <limit effort="63.0" velocity="12.0" lower="0.0" upper="3.14159" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="r_arm_shx" type="revolute">
    <origin xyz="0.0 -0.11 -0.245" rpy="0.0 0.0 0.0" />
    <parent link="r_clav" />
    <child link="r_scap" />
    <axis xyz="1.0 0.0 0.0" />
    <limit effort="99.0" velocity="12.0" lower="-1.5708" upper="1.5708" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="r_arm_shz" type="revolute">
    <origin xyz="0.1406 -0.2256 0.4776" rpy="0.0 0.0 0.0" />
    <parent link="utorso" />
    <child link="r_clav" />
    <axis xyz="0.0 0.0 1.0" />
    <limit effort="87.0" velocity="12.0" lower="-0.785398" upper="1.5708" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="r_arm_mwx" type="revolute">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="r_ufarm" />
    <child link="r_lfarm" />
    <axis xyz="1.0 0.0 0.0" />
    <limit effort="25.0" velocity="10.0" lower="-1.7628" upper="1.7628" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="r_arm_uwy" type="revolute">
    <origin xyz="0.0 -0.29955 -0.00921" rpy="0.0 0.0 0.0" />
    <parent link="r_larm" />
    <child link="r_ufarm" />
    <axis xyz="0.0 1.0 0.0" />
    <limit effort="25.0" velocity="10.0" lower="-3.011" upper="3.011" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="r_arm_lwy" type="revolute">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="r_lfarm" />
    <child link="r_hand" />
    <axis xyz="0.0 1.0 0.0" />
    <limit effort="25.0" velocity="10.0" lower="-2.9671" upper="2.9671" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="r_leg_akx" type="revolute">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="r_talus" />
    <child link="r_foot" />
    <axis xyz="1.0 0.0 0.0" />
    <limit effort="360.0" velocity="12.0" lower="-0.8" upper="0.8" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="r_leg_aky" type="revolute">
    <origin xyz="0.0 0.0 -0.422" rpy="0.0 0.0 0.0" />
    <parent link="r_lleg" />
    <child link="r_talus" />
    <axis xyz="0.0 1.0 0.0" />
    <limit effort="740.0" velocity="12.0" lower="-1.0" upper="0.7" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="r_leg_hpx" type="revolute">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="r_uglut" />
    <child link="r_lglut" />
    <axis xyz="1.0 0.0 0.0" />
    <limit effort="530.0" velocity="12.0" lower="-0.523599" upper="0.523599" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="r_leg_hpy" type="revolute">
    <origin xyz="0.05 -0.0225 -0.066" rpy="0.0 0.0 0.0" />
    <parent link="r_lglut" />
    <child link="r_uleg" />
    <axis xyz="0.0 1.0 0.0" />
    <limit effort="840.0" velocity="12.0" lower="-1.61234" upper="0.65764" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="r_leg_hpz" type="revolute">
    <origin xyz="0.0 -0.089 0.0" rpy="0.0 0.0 0.0" />
    <parent link="pelvis" />
    <child link="r_uglut" />
    <axis xyz="0.0 0.0 1.0" />
    <limit effort="275.0" velocity="12.0" lower="-0.786794" upper="0.174358" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <joint name="r_leg_kny" type="revolute">
    <origin xyz="-0.05 0.0 -0.374" rpy="0.0 0.0 0.0" />
    <parent link="r_uleg" />
    <child link="r_lleg" />
    <axis xyz="0.0 1.0 0.0" />
    <limit effort="890.0" velocity="12.0" lower="0.0" upper="2.35637" />
    <dynamics damping="0.1" friction="0.0" />
  </joint>
  <link name="r_situational_awareness_camera_link">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <box size="0.01 0.01 0.01" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <box size="0.01 0.01 0.01" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.0 0.0 0.0" />
      <mass value="0.1" />
      <inertia ixx="1e-05" ixy="0.0" ixz="0.0" iyy="1e-05" iyz="0.0" izz="1e-05" />
    </inertial>
  </link>
  <joint name="r_situational_awareness_camera_joint" type="fixed">
    <origin xyz="0.155 -0.121 0.785" rpy="0.0 0.0 -1.309" />
    <parent link="utorso" />
    <child link="r_situational_awareness_camera_link" />
  </joint>
  <joint name="r_situational_awareness_camera_optical_frame_joint" type="fixed">
    <origin xyz="0.0 0.0 0.0" rpy="-1.5708 0.0 -1.5708" />
    <parent link="r_situational_awareness_camera_link" />
    <child link="r_situational_awareness_camera_optical_frame" />
  </joint>
  <link name="r_situational_awareness_camera_optical_frame" />
  <link name="l_situational_awareness_camera_link">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <box size="0.01 0.01 0.01" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <box size="0.01 0.01 0.01" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.0 0.0 0.0" />
      <mass value="0.1" />
      <inertia ixx="1e-05" ixy="0.0" ixz="0.0" iyy="1e-05" iyz="0.0" izz="1e-05" />
    </inertial>
  </link>
  <joint name="l_situational_awareness_camera_joint" type="fixed">
    <origin xyz="0.155 0.121 0.785" rpy="0.0 0.0 1.309" />
    <parent link="utorso" />
    <child link="l_situational_awareness_camera_link" />
  </joint>
  <joint name="l_situational_awareness_camera_optical_frame_joint" type="fixed">
    <origin xyz="0.0 0.0 0.0" rpy="-1.5708 0.0 -1.5708" />
    <parent link="l_situational_awareness_camera_link" />
    <child link="l_situational_awareness_camera_optical_frame" />
  </joint>
  <link name="l_situational_awareness_camera_optical_frame" />
  <link name="head">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/head_chull.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/head_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="-0.075493 3.3383e-05 0.02774" rpy="0.0 0.0 0.0" />
      <mass value="1.4199" />
      <inertia ixx="0.0039688" ixy="-1.5797e-06" ixz="-0.00089293" iyy="0.0041178" iyz="-6.8415e-07" izz="0.0035243" />
    </inertial>
  </link>
  <link name="pre_spindle" />
  <joint name="pre_spindle_joint" type="fixed">
    <origin xyz="-0.0446 0.0 0.088" rpy="0.0 0.0 0.0" />
    <parent link="head" />
    <child link="pre_spindle" />
  </joint>
  <link name="pre_spindle_cal_x" />
  <link name="pre_spindle_cal_y" />
  <link name="pre_spindle_cal_z" />
  <link name="pre_spindle_cal_roll" />
  <link name="pre_spindle_cal_pitch" />
  <link name="pre_spindle_cal_yaw" />
  <joint name="pre_spindle_cal_x_joint" type="fixed">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="pre_spindle" />
    <child link="pre_spindle_cal_x" />
  </joint>
  <joint name="pre_spindle_cal_y_joint" type="fixed">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="pre_spindle_cal_x" />
    <child link="pre_spindle_cal_y" />
  </joint>
  <joint name="pre_spindle_cal_z_joint" type="fixed">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="pre_spindle_cal_y" />
    <child link="pre_spindle_cal_z" />
  </joint>
  <joint name="pre_spindle_cal_roll_joint" type="fixed">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="pre_spindle_cal_z" />
    <child link="pre_spindle_cal_roll" />
  </joint>
  <joint name="pre_spindle_cal_pitch_joint" type="fixed">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="pre_spindle_cal_roll" />
    <child link="pre_spindle_cal_pitch" />
  </joint>
  <joint name="pre_spindle_cal_yaw_joint" type="fixed">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="pre_spindle_cal_pitch" />
    <child link="pre_spindle_cal_yaw" />
  </joint>
  <joint name="hokuyo_joint" type="fixed">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="pre_spindle_cal_yaw" />
    <child link="post_spindle" />
  </joint>
  <link name="post_spindle" />
  <link name="post_spindle_cal_x" />
  <link name="post_spindle_cal_y" />
  <link name="post_spindle_cal_z" />
  <link name="post_spindle_cal_roll" />
  <link name="post_spindle_cal_pitch" />
  <joint name="post_spindle_cal_x_joint" type="fixed">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="post_spindle" />
    <child link="post_spindle_cal_x" />
  </joint>
  <joint name="post_spindle_cal_y_joint" type="fixed">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="post_spindle_cal_x" />
    <child link="post_spindle_cal_y" />
  </joint>
  <joint name="post_spindle_cal_z_joint" type="fixed">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="post_spindle_cal_y" />
    <child link="post_spindle_cal_z" />
  </joint>
  <joint name="post_spindle_cal_roll_joint" type="fixed">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="post_spindle_cal_z" />
    <child link="post_spindle_cal_roll" />
  </joint>
  <joint name="post_spindle_cal_pitch_joint" type="fixed">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="post_spindle_cal_roll" />
    <child link="post_spindle_cal_pitch" />
  </joint>
  <joint name="post_spindle_cal_yaw_joint" type="fixed">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="post_spindle_cal_pitch" />
    <child link="hokuyo_link" />
  </joint>
  <link name="hokuyo_link">
    <visual>
      <origin xyz="0.045 -0.0261018277 -0.08342369" rpy="-0.314 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/head_camera_chull.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.045 -0.0261018277 -0.08342369" rpy="-0.314 0.0 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/head_camera_chull.obj" />
      </geometry>
    </collision>
    <inertial>
      <origin xyz="0.012428 0.0004084 -0.0041835" rpy="0.0 0.0 0.0" />
      <mass value="0.057664" />
      <inertia ixx="3.7174e-05" ixy="4.9927e-08" ixz="1.1015e-05" iyy="4.2412e-05" iyz="-9.8165e-09" izz="4.167e-05" />
    </inertial>
  </link>
  <joint name="head_hokuyo_fixed_joint" type="fixed">
    <origin xyz="0.03 0.0 0.015" rpy="0.0 0.0 0.0" />
    <parent link="hokuyo_link" />
    <child link="head_hokuyo_frame" />
  </joint>
  <link name="head_hokuyo_frame">
    <inertial>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <mass value="0.01" />
      <inertia ixx="1e-05" ixy="0.0" ixz="0.0" iyy="1e-05" iyz="0.0" izz="1e-05" />
    </inertial>
  </link>
  <joint name="left_camera_frame_joint" type="fixed">
    <origin xyz="0.0 0.035 -0.002" rpy="0.0 0.0 0.0" />
    <parent link="head" />
    <child link="left_camera_frame" />
  </joint>
  <link name="left_camera_frame">
    <inertial>
      <origin xyz="0.0 0.0 0.0" />
      <mass value="0.1" />
      <inertia ixx="0.001" ixy="0.0" ixz="0.0" iyy="0.001" iyz="0.0" izz="0.001" />
    </inertial>
  </link>
  <joint name="left_camera_optical_frame_joint" type="fixed">
    <origin xyz="0.0 0.0 0.0" rpy="-1.5708 0.0 -1.5708" />
    <parent link="left_camera_frame" />
    <child link="left_camera_optical_frame" />
  </joint>
  <link name="left_camera_optical_frame" />
  <joint name="right_camera_frame_joint" type="fixed">
    <origin xyz="0.0 -0.035 -0.002" rpy="0.0 0.0 0.0" />
    <parent link="head" />
    <child link="right_camera_frame" />
  </joint>
  <link name="right_camera_frame">
    <inertial>
      <origin xyz="0.0 0.0 0.0" />
      <mass value="0.1" />
      <inertia ixx="0.001" ixy="0.0" ixz="0.0" iyy="0.001" iyz="0.0" izz="0.001" />
    </inertial>
  </link>
  <joint name="right_camera_optical_frame_joint" type="fixed">
    <origin xyz="0.0 0.0 0.0" rpy="-1.5708 0.0 -1.5708" />
    <parent link="right_camera_frame" />
    <child link="right_camera_optical_frame" />
  </joint>
  <link name="right_camera_optical_frame" />
  <joint name="center_top_led_frame_joint" type="fixed">
    <origin xyz="0.01125 0.0 0.0105" rpy="0.0 0.0 0.0" />
    <parent link="head" />
    <child link="center_top_led_frame" />
  </joint>
  <link name="center_top_led_frame">
    <inertial>
      <origin xyz="0.0 0.0 0.0" />
      <mass value="0.1" />
      <inertia ixx="0.001" ixy="0.0" ixz="0.0" iyy="0.001" iyz="0.0" izz="0.001" />
    </inertial>
  </link>
  <joint name="center_bottom_led_frame_joint" type="fixed">
    <origin xyz="0.01125 0.0 -0.0155" rpy="0.0 0.0 0.0" />
    <parent link="head" />
    <child link="center_bottom_led_frame" />
  </joint>
  <link name="center_bottom_led_frame">
    <inertial>
      <origin xyz="0.0 0.0 0.0" />
      <mass value="0.1" />
      <inertia ixx="0.001" ixy="0.0" ixz="0.0" iyy="0.001" iyz="0.0" izz="0.001" />
    </inertial>
  </link>
  <joint name="left_led_frame_joint" type="fixed">
    <origin xyz="-0.01443 0.07452 0.050346" rpy="0.0 -0.15 0.53" />
    <parent link="head" />
    <child link="left_led_frame" />
  </joint>
  <link name="left_led_frame">
    <inertial>
      <origin xyz="0.0 0.0 0.0" />
      <mass value="0.1" />
      <inertia ixx="0.001" ixy="0.0" ixz="0.0" iyy="0.001" iyz="0.0" izz="0.001" />
    </inertial>
  </link>
  <joint name="right_led_frame_joint" type="fixed">
    <origin xyz="-0.01443 -0.07452 0.050346" rpy="0.0 -0.15 -0.53" />
    <parent link="head" />
    <child link="right_led_frame" />
  </joint>
  <link name="right_led_frame">
    <inertial>
      <origin xyz="0.0 0.0 0.0" />
      <mass value="0.1" />
      <inertia ixx="0.001" ixy="0.0" ixz="0.0" iyy="0.001" iyz="0.0" izz="0.001" />
    </inertial>
  </link>
  <link name="l_hand_force_torque">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <box size="0.01 0.01 0.01" />
      </geometry>
    </visual>
    <inertial>
      <origin xyz="0.0 0.0 0.0" />
      <mass value="0.1" />
      <inertia ixx="1e-05" ixy="0.0" ixz="0.0" iyy="1e-05" iyz="0.0" izz="1e-05" />
    </inertial>
  </link>
  <joint name="l_hand_force_torque_joint" type="fixed">
    <origin xyz="0.0 -0.1245 0.0" rpy="0.0 0.0 3.141592" />
    <parent link="l_hand" />
    <child link="l_hand_force_torque" />
  </joint>
  <link name="r_hand_force_torque">
    <visual>
      <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
      <geometry>
        <box size="0.01 0.01 0.01" />
      </geometry>
    </visual>
    <inertial>
      <origin xyz="0.0 0.0 0.0" />
      <mass value="0.1" />
      <inertia ixx="1e-05" ixy="0.0" ixz="0.0" iyy="1e-05" iyz="0.0" izz="1e-05" />
    </inertial>
  </link>
  <joint name="r_hand_force_torque_joint" type="fixed">
    <origin xyz="0.0 -0.1245 0.0" rpy="0.0 0.0 3.141592" />
    <parent link="r_hand" />
    <child link="r_hand_force_torque" />
  </joint>
  <link name="left_palm">
    <visual>
      <origin xyz="0.0 0.1725 0.0" rpy="-1.57079 -1.57079 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/GRIPPER_OPEN_chull.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.1725 0.0" rpy="-1.57079 -1.57079 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/GRIPPER_OPEN_chull.obj" />
      </geometry>
    </collision>
  </link>
  <joint name="left_palm_joint" type="fixed">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="l_hand_force_torque" />
    <child link="left_palm" />
  </joint>
  <link name="right_palm">
    <visual>
      <origin xyz="0.0 0.1725 0.0" rpy="-1.57079 -1.57079 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/GRIPPER_OPEN_chull.obj" />
      </geometry>
    </visual>
    <collision>
      <origin xyz="0.0 0.1725 0.0" rpy="-1.57079 -1.57079 0.0" />
      <geometry>
        <mesh filename="package://drake/examples/atlas/urdf/meshes/GRIPPER_OPEN_chull.obj" />
      </geometry>
    </collision>
  </link>
  <joint name="right_palm_joint" type="fixed">
    <origin xyz="0.0 0.0 0.0" rpy="0.0 0.0 0.0" />
    <parent link="r_hand_force_torque" />
    <child link="right_palm" />
  </joint>
  <joint name="l_hand_face_joint" type="fixed">
    <origin xyz="0.0 0.12 0.0" rpy="0.0 0.0 0.0" />
    <parent link="l_hand_force_torque" />
    <child link="l_hand_face" />
  </joint>
  <link name="l_hand_face" />
  <joint name="l_hand_gripper_joint" type="fixed">
    <origin xyz="0.0 0.18 0.0" rpy="0.0 0.0 0.0" />
    <parent link="l_hand_force_torque" />
    <child link="l_hand_gripper" />
  </joint>
  <link name="l_hand_gripper" />
  <link name="l_hand_camera_link" />
  <joint name="l_hand_camera_joint" type="fixed">
    <origin xyz="-0.09892 0.01431 0.0" rpy="-1.57079 0.0 1.5708" />
    <parent link="l_hand_force_torque" />
    <child link="l_hand_camera_link" />
  </joint>
  <joint name="l_hand_camera_optical_frame_joint" type="fixed">
    <origin xyz="0.0 0.0 0.0" rpy="-1.57079 0.0 -1.57079" />
    <parent link="l_hand_camera_link" />
    <child link="l_hand_camera_optical_frame" />
  </joint>
  <link name="l_hand_camera_optical_frame" />
  <joint name="r_hand_face_joint" type="fixed">
    <origin xyz="0.0 0.12 0.0" rpy="0.0 0.0 0.0" />
    <parent link="r_hand_force_torque" />
    <child link="r_hand_face" />
  </joint>
  <link name="r_hand_face" />
  <joint name="r_hand_gripper_joint" type="fixed">
    <origin xyz="0.0 0.18 0.0" rpy="0.0 0.0 0.0" />
    <parent link="r_hand_force_torque" />
    <child link="r_hand_gripper" />
  </joint>
  <link name="r_hand_gripper" />
  <link name="r_hand_camera_link" />
  <joint name="r_hand_camera_joint" type="fixed">
    <origin xyz="0.09892 0.01431 0.0" rpy="1.57079 0.0 1.5708" />
    <parent link="r_hand_force_torque" />
    <child link="r_hand_camera_link" />
  </joint>
  <joint name="r_hand_camera_optical_frame_joint" type="fixed">
    <origin xyz="0.0 0.0 0.0" rpy="-1.57079 0.0 -1.57079" />
    <parent link="r_hand_camera_link" />
    <child link="r_hand_camera_optical_frame" />
  </joint>
  <link name="r_hand_camera_optical_frame" />
</robot>