2013-12-11 00:12:44 +00:00
<launch>
2015-01-23 17:22:39 -05:00
<!-- ROBOT MAPPING VERSION: use this with ROS bag demo_mapping.bag -->
<!-- WARNING : Database is automatically deleted on each startup -->
<!-- See "delete_db_on_start" option below... -->
2013-12-11 00:12:44 +00:00
2015-01-23 17:22:39 -05:00
<!-- Choose visualization -->
2015-01-23 17:48:14 -05:00
<arg name= "rviz" default= "false" />
<arg name= "rtabmapviz" default= "true" />
2015-01-23 17:22:39 -05:00
2013-12-11 00:12:44 +00:00
<param name= "use_sim_time" type= "bool" value= "True" />
2015-01-23 17:22:39 -05:00
<group ns= "rtabmap" >
<!-- SLAM (robot side) -->
<!-- args: "delete_db_on_start" and "udebug" -->
<node name= "rtabmap" pkg= "rtabmap_ros" type= "rtabmap" output= "screen" args= "--delete_db_on_start" >
<param name= "frame_id" type= "string" value= "base_footprint" />
2015-01-30 15:52:40 -05:00
<param name= "wait_for_transform" type= "bool" value= "true" />
2013-12-11 00:12:44 +00:00
2015-01-23 17:22:39 -05:00
<param name= "subscribe_depth" type= "bool" value= "true" />
<param name= "subscribe_laserScan" type= "bool" value= "true" />
2013-12-11 00:12:44 +00:00
2015-01-23 17:22:39 -05:00
<remap from= "odom" to= "/az3/base_controller/odom" />
<remap from= "scan" to= "/jn0/base_scan" />
2013-12-11 00:12:44 +00:00
2015-01-23 17:22:39 -05:00
<remap from= "rgb/image" to= "/data_throttled_image" />
<remap from= "depth/image" to= "/data_throttled_image_depth" />
<remap from= "rgb/camera_info" to= "/data_throttled_camera_info" />
2013-12-11 00:12:44 +00:00
2015-01-23 17:22:39 -05:00
<param name= "rgb/image_transport" type= "string" value= "compressed" />
<param name= "depth/image_transport" type= "string" value= "compressedDepth" />
2013-12-11 00:12:44 +00:00
2015-01-23 17:22:39 -05:00
<!-- RTAB-Map's parameters: do "rosrun rtabmap rtabmap (double-dash)params" to see the list of available parameters. -->
<param name= "RGBD/PoseScanMatching" type= "string" value= "true" /> <!-- Do odometry correction with consecutive laser scans -->
<param name= "RGBD/LocalLoopDetectionSpace" type= "string" value= "true" /> <!-- Local loop closure detection (using estimated position) with locations in WM -->
<param name= "RGBD/LocalLoopDetectionTime" type= "string" value= "false" /> <!-- Local loop closure detection with locations in STM -->
<param name= "RGBD/OptimizeFromGraphEnd" type= "string" value= "true" />
<param name= "LccIcp/Type" type= "string" value= "2" /> <!-- 0=No ICP, 1=ICP 3D, 2=ICP 2D -->
<param name= "LccBow/MaxDepth" type= "string" value= "0.0" /> <!-- 3D visual words maximum depth 0=infinity -->
<param name= "LccBow/InlierDistance" type= "string" value= "0.1" /> <!-- 3D visual words correspondence distance -->
<param name= "RGBD/OptimizeFromGraphEnd" type= "string" value= "false" /> <!-- Optimize graph from initial node so /map -> /odom transform will be generated -->
</node>
2014-11-14 15:49:36 +00:00
2015-01-23 17:22:39 -05:00
<!-- Grid map assembler for rviz -->
<node if= "$(arg rviz)" pkg= "rtabmap_ros" type= "grid_map_assembler" name= "grid_map_assembler" >
<param name= "unknown_space_filled" type= "bool" value= "false" />
</node>
<!-- 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" >
2013-12-11 00:12:44 +00:00
<param name= "subscribe_depth" type= "bool" value= "true" />
<param name= "subscribe_laserScan" type= "bool" value= "true" />
<param name= "frame_id" type= "string" value= "base_footprint" />
2015-01-30 15:52:40 -05:00
<param name= "wait_for_transform" type= "bool" value= "true" />
2013-12-11 00:12:44 +00:00
2015-01-23 17:22:39 -05:00
<remap from= "rgb/image" to= "/data_throttled_image" />
<remap from= "depth/image" to= "/data_throttled_image_depth" />
<remap from= "rgb/camera_info" to= "/data_throttled_camera_info" />
2013-12-11 00:12:44 +00:00
<remap from= "scan" to= "/jn0/base_scan" />
<remap from= "odom" to= "/az3/base_controller/odom" />
<param name= "rgb/image_transport" type= "string" value= "compressed" />
<param name= "depth/image_transport" type= "string" value= "compressedDepth" />
2015-01-23 17:22:39 -05:00
</node>
</group>
<!-- Visualisation RVIZ -->
<node if= "$(arg rviz)" pkg= "rviz" type= "rviz" name= "rviz" args= "-d $(find rtabmap_ros)/launch/config/demo_robot_mapping.rviz" output= "screen" />
<node pkg= "nodelet" type= "nodelet" name= "points_xyzrgb" args= "standalone rtabmap_ros/point_cloud_xyzrgb" >
<remap from= "rgb/image" to= "/data_throttled_image" />
<remap from= "depth/image" to= "/data_throttled_image_depth" />
<remap from= "rgb/camera_info" to= "/data_throttled_camera_info" />
<remap from= "cloud" to= "voxel_cloud" />
<param name= "rgb/image_transport" type= "string" value= "compressed" />
<param name= "depth/image_transport" type= "string" value= "compressedDepth" />
<param name= "queue_size" type= "int" value= "10" />
<param name= "voxel_size" type= "double" value= "0.01" />
2013-12-11 00:12:44 +00:00
</node>
</launch>