From 542a803b869ce9151a0c5847b175c87a29ec5c27 Mon Sep 17 00:00:00 2001
From: archielee <archie_lee7@hotmail.com>
Date: Tue, 2 Feb 2016 10:21:42 -0500
Subject: [PATCH] Added sanity checking in .xacro so no errors pop up if both
 KINECT2 and KINECT1 are set true

---
 pr2_description/robots/pr2.urdf.xacro | 44 ++++++++++++++-------------
 1 file changed, 23 insertions(+), 21 deletions(-)

diff --git a/pr2_description/robots/pr2.urdf.xacro b/pr2_description/robots/pr2.urdf.xacro
index 576955b..d686f0f 100644
--- a/pr2_description/robots/pr2.urdf.xacro
+++ b/pr2_description/robots/pr2.urdf.xacro
@@ -136,27 +136,6 @@
   </xacro:wge100_camera_v0>
 
   <!-- Kinect models -->
-  <!-- Kinect1 xacro -->
-  <xacro:if value="$(optenv KINECT1 false)">
-    <xacro:include filename="$(find pr2_description)/urdf/sensors/kinect_prosilica_camera.urdf.xacro" />
-    <!-- Base of Kinect/Prosilica Mount -->
-    <xacro:kinect_prosilica_camera_swept_back_v0 name="head_mount" parent="head_plate_frame" >
-      <origin xyz="-0.137376 0 0.091746" rpy="0 0 0" />
-      <!--
-            Was -0.1 0 0.09225, -0.138 0 0.09225 looks good front back and sheet metal on bolt pattern,
-            -0.138 0 0.06225 is where Prosilica FOV just clears the head.
-            This is 30 mm (!) below the position in SolidWorks.
-            Lowering the Prosilica by this amount in SW makes the FOV hit around the aluminum / plastic junction.
-            Turns out that head_plate_frame is in some random position in space.
-            It is [0.0232 0 0.0645 from its parent, head_tilt_link.
-            The distance from head_plate_frame to the head_kinect_prosilica is 137.376 mm X and 91.746 mm Z.
-            So the origin should in fact be -0.137376 0 0.091746.
-            John is changing the Prosilica FOV based on my numbers.
-            Just need to roscd and svn up.
-      -->
-    </xacro:kinect_prosilica_camera_swept_back_v0>
-  </xacro:if>
-
   <!-- Kinect2 xacro -->
   <xacro:if value="$(optenv KINECT2 false)">
     <xacro:include filename="$(find pr2_description)/urdf/sensors/kinect2.urdf.xacro" />
@@ -165,4 +144,27 @@
     </xacro:kinect2_v0>
   </xacro:if>
 
+  <!-- Kinect1 xacro -->
+  <xacro:unless value="$(optenv KINECT2 false">
+    <xacro:if value="$(optenv KINECT1 false)">
+      <xacro:include filename="$(find pr2_description)/urdf/sensors/kinect_prosilica_camera.urdf.xacro" />
+      <!-- Base of Kinect/Prosilica Mount -->
+      <xacro:kinect_prosilica_camera_swept_back_v0 name="head_mount" parent="head_plate_frame" >
+        <origin xyz="-0.137376 0 0.091746" rpy="0 0 0" />
+        <!--
+              Was -0.1 0 0.09225, -0.138 0 0.09225 looks good front back and sheet metal on bolt pattern,
+              -0.138 0 0.06225 is where Prosilica FOV just clears the head.
+              This is 30 mm (!) below the position in SolidWorks.
+              Lowering the Prosilica by this amount in SW makes the FOV hit around the aluminum / plastic junction.
+              Turns out that head_plate_frame is in some random position in space.
+              It is [0.0232 0 0.0645 from its parent, head_tilt_link.
+              The distance from head_plate_frame to the head_kinect_prosilica is 137.376 mm X and 91.746 mm Z.
+              So the origin should in fact be -0.137376 0 0.091746.
+              John is changing the Prosilica FOV based on my numbers.
+              Just need to roscd and svn up.
+        -->
+      </xacro:kinect_prosilica_camera_swept_back_v0>
+    </xacro:if>
+  </xacro:unless>
+
 </robot>