mirror of
https://github.com/introlab/rtabmap_ros.git
synced 2026-10-04 00:37:46 +08:00
54 lines
2.3 KiB
XML
54 lines
2.3 KiB
XML
|
|
<launch>
|
|
|
|
<!-- We test here ICP odometry using a guess from visual odometry -->
|
|
|
|
<arg name="rgbd" default="false"/>
|
|
|
|
<include file="$(find freenect_launch)/launch/freenect.launch" >
|
|
<arg name="depth_registration" value="true"/>
|
|
<arg name="data_skip" value="3"/>
|
|
</include>
|
|
|
|
<group ns="camera">
|
|
<node pkg="nodelet" type="nodelet" name="points_xyz" args="load rtabmap_ros/point_cloud_xyz camera_nodelet_manager">
|
|
<remap from="depth/image" to="depth_registered/image_raw"/>
|
|
<remap from="depth/camera_info" to="depth_registered/camera_info"/>
|
|
<remap from="cloud" to="/voxel_cloud" />
|
|
|
|
<param name="voxel_size" type="double" value="0.05"/>
|
|
<param name="decimation" type="int" value="8"/>
|
|
|
|
<param name="Odom/AlignWithGround" type="string" value="true"/>
|
|
</node>
|
|
|
|
<node if="$(arg rgbd)" pkg="nodelet" type="nodelet" name="rgbdicp_odometry" args="load rtabmap_ros/rgbdicp_odometry camera_nodelet_manager">
|
|
<remap from="scan_cloud" to="/voxel_cloud"/>
|
|
<remap from="depth/image" to="depth_registered/image_raw"/>
|
|
<remap from="rgb/camera_info" to="rgb/camera_info"/>
|
|
<remap from="rgb/image" to="rgb/image_rect_mono"/>
|
|
|
|
<param name="frame_id" type="string" value="camera_link"/>
|
|
<param name="scan_cloud_normal_k" type="int" value="10"/>
|
|
<param name="subscribe_scan_cloud" type="bool" value="true"/>
|
|
|
|
<param name="Icp/PointToPlane" type="string" value="true"/>
|
|
<param name="Icp/VoxelSize" type="string" value="0"/>
|
|
</node>
|
|
<node unless="$(arg rgbd)" pkg="nodelet" type="nodelet" name="icp_odometry" args="load rtabmap_ros/icp_odometry camera_nodelet_manager">
|
|
<remap from="scan_cloud" to="/voxel_cloud"/>
|
|
|
|
<param name="frame_id" type="string" value="camera_link"/>
|
|
<param name="scan_cloud_normal_k" type="int" value="10"/>
|
|
|
|
<param name="Icp/PointToPlane" type="string" value="true"/>
|
|
<param name="Icp/VoxelSize" type="string" value="0"/>
|
|
<param name="Odom/GuessMotion" type="string" value="true"/>
|
|
</node>
|
|
|
|
</group>
|
|
|
|
<!-- Visualization RVIZ -->
|
|
<node pkg="rviz" type="rviz" name="rviz" args="-d $(find rtabmap_ros)/launch/config/rgbd.rviz"/>
|
|
</launch>
|