2014-11-13 16:53:56 +00:00
<launch>
2014-11-13 22:32:12 +00:00
<!--
Demo of outdoor stereo mapping.
From bag:
$ rosbag record
/stereo_camera/left/image_raw_throttle/compressed
/stereo_camera/right/image_raw_throttle/compressed
/stereo_camera/left/camera_info_throttle
/stereo_camera/right/camera_info_throttle
/tf
2014-11-13 16:53:56 +00:00
2014-11-13 22:32:12 +00:00
$ roslaunch rtabmap demo_stereo_outdoor.launch
$ rosbag play -.-clock stereo_oudoorA.bag
-->
2015-02-03 11:16:06 -05:00
<!-- Choose visualization -->
<arg name= "rviz" default= "true" />
<arg name= "rtabmapviz" default= "false" />
2014-11-13 22:32:12 +00:00
<param name= "use_sim_time" type= "bool" value= "True" />
<!-- Just to uncompress images for stereo_image_rect -->
2016-03-13 18:05:27 -04:00
<node name= "republish_left" type= "republish" pkg= "image_transport" args= "compressed in:=/stereo_camera/left/image_raw_throttle raw out:=/stereo_camera/left/image_raw_throttle_relay" />
2014-11-13 22:32:12 +00:00
<node name= "republish_right" type= "republish" pkg= "image_transport" args= "compressed in:=/stereo_camera/right/image_raw_throttle raw out:=/stereo_camera/right/image_raw_throttle_relay" />
<!-- Run the ROS package stereo_image_proc for image rectification -->
<group ns= "/stereo_camera" >
<node pkg= "nodelet" type= "nodelet" name= "stereo_nodelet" args= "manager" />
<node pkg= "stereo_image_proc" type= "stereo_image_proc" name= "stereo_image_proc" >
<remap from= "left/image_raw" to= "left/image_raw_throttle_relay" />
<remap from= "left/camera_info" to= "left/camera_info_throttle" />
<remap from= "right/image_raw" to= "right/image_raw_throttle_relay" />
<remap from= "right/camera_info" to= "right/camera_info_throttle" />
<param name= "disparity_range" value= "128" />
</node>
</group>
2016-03-13 17:01:48 -04:00
2014-11-13 22:32:12 +00:00
<group ns= "rtabmap" >
2016-03-13 17:01:48 -04:00
<!-- Stereo Odometry -->
<node pkg= "rtabmap_ros" type= "stereo_odometry" name= "stereo_odometry" output= "screen" >
<remap from= "left/image_rect" to= "/stereo_camera/left/image_rect" />
<remap from= "right/image_rect" to= "/stereo_camera/right/image_rect" />
<remap from= "left/camera_info" to= "/stereo_camera/left/camera_info_throttle" />
<remap from= "right/camera_info" to= "/stereo_camera/right/camera_info_throttle" />
<remap from= "odom" to= "/stereo_odometry" />
2016-03-13 18:05:27 -04:00
<param name= "frame_id" type= "string" value= "base_footprint" />
2016-03-13 17:01:48 -04:00
<param name= "odom_frame_id" type= "string" value= "odom" />
2016-03-13 18:05:27 -04:00
<param name= "Odom/Strategy" type= "string" value= "0" /> <!-- 0=Frame-to-Map, 1=Frame=to=Frame -->
2016-03-13 17:01:48 -04:00
<param name= "Vis/EstimationType" type= "string" value= "0" /> <!-- 0=3D->3D 1=3D->2D (PnP) -->
2016-03-13 18:05:27 -04:00
<param name= "Vis/MaxDepth" type= "string" value= "10" />
2016-03-14 19:37:37 -04:00
<param name= "Vis/MinInliers" type= "string" value= "10" />
2016-03-13 18:05:27 -04:00
<param name= "Odom/FillInfoData" type= "string" value= "$(arg rtabmapviz)" />
<param name= "GFTT/MinDistance" type= "string" value= "10" />
<param name= "GFTT/QualityLevel" type= "string" value= "0.00001" />
2016-03-13 17:01:48 -04:00
</node>
2014-11-13 22:32:12 +00:00
<!-- Visual SLAM: args: "delete_db_on_start" and "udebug" -->
2014-11-25 17:43:26 -05:00
<node name= "rtabmap" pkg= "rtabmap_ros" type= "rtabmap" output= "screen" args= "--delete_db_on_start" >
2016-03-13 18:05:27 -04:00
<param name= "frame_id" type= "string" value= "base_footprint" />
2014-11-13 22:32:12 +00:00
<param name= "subscribe_stereo" type= "bool" value= "true" />
2016-03-13 18:05:27 -04:00
<param name= "subscribe_depth" type= "bool" value= "false" />
2014-11-13 16:53:56 +00:00
2016-03-13 18:05:27 -04:00
<remap from= "left/image_rect" to= "/stereo_camera/left/image_rect_color" />
<remap from= "right/image_rect" to= "/stereo_camera/right/image_rect" />
<remap from= "left/camera_info" to= "/stereo_camera/left/camera_info_throttle" />
2014-11-13 22:32:12 +00:00
<remap from= "right/camera_info" to= "/stereo_camera/right/camera_info_throttle" />
2014-11-13 16:53:56 +00:00
2015-10-31 16:37:39 -04:00
<remap from= "odom" to= "/stereo_odometry" />
2014-11-13 16:53:56 +00:00
2014-11-13 22:32:12 +00:00
<param name= "queue_size" type= "int" value= "30" />
2014-11-13 16:53:56 +00:00
2014-11-13 22:32:12 +00:00
<!-- RTAB-Map's parameters -->
2016-03-13 18:05:27 -04:00
<param name= "Rtabmap/TimeThr" type= "string" value= "700" />
<param name= "Kp/MaxFeatures" type= "string" value= "200" />
<param name= "Kp/MaxDepth" type= "string" value= "10" />
<param name= "Kp/DetectorStrategy" type= "string" value= "0" /> <!-- use SURF -->
<param name= "SURF/HessianThreshold" type= "string" value= "1000" />
<param name= "Vis/EstimationType" type= "string" value= "0" /> <!-- 0=3D->3D, 1=3D->2D (PnP) -->
2016-02-23 11:47:31 -05:00
<param name= "RGBD/LoopClosureReextractFeatures" type= "string" value= "true" />
2016-03-13 18:05:27 -04:00
<param name= "Vis/MaxDepth" type= "string" value= "10" />
2014-11-13 22:32:12 +00:00
</node>
2015-02-03 11:16:06 -05:00
<!-- Visualisation RTAB-Map -->
<node if= "$(arg rtabmapviz)" pkg= "rtabmap_ros" type= "rtabmapviz" name= "rtabmapviz" args= "-d $(find rtabmap_ros)/launch/config/rgbd_gui.ini" output= "screen" >
2016-03-13 18:05:27 -04:00
<param name= "subscribe_stereo" type= "bool" value= "true" />
2015-02-03 11:16:06 -05:00
<param name= "subscribe_odom_info" type= "bool" value= "true" />
2016-03-13 18:05:27 -04:00
<param name= "queue_size" type= "int" value= "10" />
<param name= "frame_id" type= "string" value= "base_footprint" />
<remap from= "left/image_rect" to= "/stereo_camera/left/image_rect_color" />
<remap from= "right/image_rect" to= "/stereo_camera/right/image_rect" />
<remap from= "left/camera_info" to= "/stereo_camera/left/camera_info_throttle" />
2015-02-03 11:16:06 -05:00
<remap from= "right/camera_info" to= "/stereo_camera/right/camera_info_throttle" />
2016-03-13 18:05:27 -04:00
<remap from= "odom_info" to= "odom_info" />
<remap from= "odom" to= "/stereo_odometry" />
<remap from= "mapData" to= "mapData" />
2015-02-03 11:16:06 -05:00
</node>
2014-11-13 22:32:12 +00:00
</group>
2014-11-13 16:53:56 +00:00
2015-02-03 11:16:06 -05:00
<!-- Visualisation RVIZ -->
<node if= "$(arg rviz)" pkg= "rviz" type= "rviz" name= "rviz" args= "-d $(find rtabmap_ros)/launch/config/demo_stereo_outdoor.rviz" />
2014-11-13 22:32:12 +00:00
2014-11-13 16:53:56 +00:00
</launch>