support to pass ROBOT_INITIAL_POSE via argument, in addition to environment

Author: k-okada

pr2_gazebo/launch/pr2.launch

@@ -1,12 +1,12 @@
 <launch>
   <arg name="KINECT1" default="$(optenv KINECT1 false)" />
   <arg name="KINECT2" default="$(optenv KINECT2 false)" />
+  <arg name="ROBOT_INITIAL_POSE" default="$(optenv ROBOT_INITIAL_POSE)" />
 
   <!-- Startup PR2 without any mechanism controllers -->
-  <include file="$(find pr2_gazebo)/launch/pr2_no_controllers.launch" pass_all_args="true"/>
+  <include file="$(find obinata_pr2_73b2_cleanup)/launch/pr2_no_controllers.launch" pass_all_args="true"/>
 
   <!-- Load and Start Default Controllers -->
   <include file="$(find pr2_controller_configuration_gazebo)/launch/pr2_default_controllers.launch" />
 
 </launch>
-

pr2_gazebo/launch/pr2_empty_world.launch

@@ -12,6 +12,7 @@
 
   <arg name="KINECT1" default="$(optenv KINECT1 false)" />
   <arg name="KINECT2" default="$(optenv KINECT2 false)" />
+  <arg name="ROBOT_INITIAL_POSE" default="$(optenv ROBOT_INITIAL_POSE)" />
 
   <include file="$(find gazebo_ros)/launch/empty_world.launch">
     <arg name="gui" value="$(arg gui)" />
@@ -26,9 +27,10 @@
   </include>
 
   <!-- start pr2 robot -->
-  <include file="$(find pr2_gazebo)/launch/pr2.launch">
+  <include file="$(find obinata_pr2_73b2_cleanup)/launch/pr2.launch">
     <arg name="KINECT1" value="$(arg KINECT1)" />
     <arg name="KINECT2" value="$(arg KINECT2)" />
+    <arg name="ROBOT_INITIAL_POSE" value="$(arg ROBOT_INITIAL_POSE)" />
   </include>
 
 </launch>

pr2_gazebo/launch/pr2_no_controllers.launch

@@ -1,12 +1,13 @@
 <launch>
   <arg name="KINECT1" default="$(optenv KINECT1 false)" />
   <arg name="KINECT2" default="$(optenv KINECT2 false)" />
+  <arg name="ROBOT_INITIAL_POSE" default="$(optenv ROBOT_INITIAL_POSE)" />
 
   <!-- send pr2 urdf to param server -->
   <include file="$(find pr2_description)/robots/upload_pr2.launch" pass_all_args="true" />
 
   <!-- push robot_description to factory and spawn robot in gazebo -->
-  <node name="spawn_pr2_model" pkg="gazebo_ros" type="spawn_model" args="$(optenv ROBOT_INITIAL_POSE) -unpause -urdf -param robot_description -model pr2" respawn="false" output="screen" />
+  <node name="spawn_pr2_model" pkg="gazebo_ros" type="spawn_model" args="$(arg ROBOT_INITIAL_POSE) -unpause -urdf -param robot_description -model pr2" respawn="false" output="screen" />
 
   <!-- default bringup script -->
   <include file="$(find pr2_gazebo)/launch/pr2_bringup.launch" />