2023-01-15 06:53:09 -08:00
|
|
|
<?xml version="1.0"?>
|
2020-08-21 15:28:41 -04:00
|
|
|
<launch>
|
2023-01-15 07:00:31 -08:00
|
|
|
|
2023-03-04 15:40:17 -08:00
|
|
|
<arg name="rtabmap_viz" default="true"/>
|
2023-01-15 07:00:31 -08:00
|
|
|
|
2020-08-21 15:28:41 -04:00
|
|
|
<include file="$(find azure_kinect_ros_driver)/launch/driver.launch">
|
|
|
|
|
<arg name="point_cloud" value="false"/>
|
|
|
|
|
<arg name="rgb_point_cloud" value="false"/>
|
|
|
|
|
<arg name="fps" value="15"/>
|
|
|
|
|
</include>
|
2023-01-15 07:00:31 -08:00
|
|
|
|
2020-08-21 15:28:41 -04:00
|
|
|
<group ns="rtabmap">
|
2023-01-15 07:00:31 -08:00
|
|
|
|
2023-03-04 15:40:17 -08:00
|
|
|
<node pkg="nodelet" type="nodelet" name="points_xyz" args="standalone rtabmap_util/point_cloud_xyz" output="screen">
|
2020-08-21 15:28:41 -04:00
|
|
|
<remap from="depth/image" to="/depth_to_rgb/image_raw"/>
|
|
|
|
|
<remap from="depth/camera_info" to="/depth_to_rgb/camera_info"/>
|
|
|
|
|
<remap from="cloud" to="voxel_cloud" />
|
|
|
|
|
|
|
|
|
|
<param name="decimation" type="double" value="4"/>
|
|
|
|
|
<param name="voxel_size" type="double" value="0.05"/>
|
|
|
|
|
<param name="max_depth" type="double" value="5"/>
|
|
|
|
|
<param name="normal_k" type="int" value="10"/>
|
|
|
|
|
<param name="approx_sync" type="bool" value="false"/>
|
|
|
|
|
</node>
|
2023-01-15 07:00:31 -08:00
|
|
|
|
2023-03-04 15:40:17 -08:00
|
|
|
<node pkg="rtabmap_odom" type="icp_odometry" name="icp_odometry" output="screen">
|
2020-08-21 15:28:41 -04:00
|
|
|
<remap from="scan_cloud" to="voxel_cloud"/>
|
2023-01-15 07:00:31 -08:00
|
|
|
<param name="frame_id" type="string" value="camera_base"/>
|
2020-08-21 15:28:41 -04:00
|
|
|
|
|
|
|
|
<!-- ICP parameters -->
|
|
|
|
|
<param name="Icp/PointToPlane" type="string" value="true"/>
|
2023-01-15 07:00:31 -08:00
|
|
|
<param name="Icp/PM" type="string" value="true"/>
|
|
|
|
|
<param name="Icp/PMOutlierRatio" type="string" value="0.7"/>
|
2020-08-21 15:28:41 -04:00
|
|
|
|
2023-01-15 07:00:31 -08:00
|
|
|
<!-- Odom parameters -->
|
2020-08-21 15:28:41 -04:00
|
|
|
<param name="OdomF2M/ScanSubtractRadius" type="string" value="0.05"/>
|
2023-01-15 07:00:31 -08:00
|
|
|
<param name="OdomF2M/ScanMaxSize" type="string" value="5000"/>
|
2023-04-09 17:37:45 -07:00
|
|
|
<param name="Odom/ScanKeyFrameThr" type="string" value="0.5"/>
|
2020-08-21 15:28:41 -04:00
|
|
|
</node>
|
|
|
|
|
|
2023-03-04 15:40:17 -08:00
|
|
|
<node pkg="rtabmap_slam" type="rtabmap" name="rtabmap" output="screen" args="-d">
|
2023-01-15 07:00:31 -08:00
|
|
|
<param name="frame_id" type="string" value="camera_base"/>
|
2020-08-21 15:28:41 -04:00
|
|
|
<param name="subscribe_depth" type="bool" value="false"/>
|
|
|
|
|
<param name="subscribe_rgb" type="bool" value="false"/>
|
|
|
|
|
<param name="subscribe_scan_cloud" type="bool" value="true"/>
|
|
|
|
|
<param name="approx_sync" type="bool" value="false"/>
|
2023-01-15 07:00:31 -08:00
|
|
|
|
2020-08-21 15:28:41 -04:00
|
|
|
<remap from="scan_cloud" to="voxel_cloud"/>
|
2023-01-15 07:00:31 -08:00
|
|
|
|
|
|
|
|
<param name="RGBD/ProximityPathMaxNeighbors" type="string" value="0"/>
|
|
|
|
|
<param name="RGBD/ProximityOdomGuess" type="string" value="true"/>
|
|
|
|
|
|
2020-08-21 15:28:41 -04:00
|
|
|
<!-- ICP parameters -->
|
|
|
|
|
<param name="Icp/PointToPlane" type="string" value="true"/>
|
2023-01-15 07:00:31 -08:00
|
|
|
<param name="Icp/PM" type="string" value="true"/>
|
2020-08-21 15:28:41 -04:00
|
|
|
<param name="Icp/PMOutlierRatio" type="string" value="0.7"/>
|
2023-01-15 07:00:31 -08:00
|
|
|
<param name="Icp/MaxTranslation" type="string" value="0.5"/>
|
2020-08-21 15:28:41 -04:00
|
|
|
</node>
|
|
|
|
|
|
2023-03-04 15:40:17 -08:00
|
|
|
<node if="$(arg rtabmap_viz)" name="rtabmap_viz" pkg="rtabmap_viz" type="rtabmap_viz" output="screen">
|
2020-08-21 15:28:41 -04:00
|
|
|
<param name="frame_id" type="string" value="camera_base"/>
|
|
|
|
|
<param name="subscribe_rgb" type="bool" value="false"/>
|
|
|
|
|
<param name="subscribe_depth" type="bool" value="false"/>
|
|
|
|
|
<param name="subscribe_odom_info" type="bool" value="true"/>
|
|
|
|
|
<param name="subscribe_scan_cloud" type="bool" value="true"/>
|
|
|
|
|
<param name="approx_sync" type="bool" value="false"/>
|
|
|
|
|
<remap from="scan_cloud" to="voxel_cloud"/>
|
|
|
|
|
</node>
|
|
|
|
|
|
|
|
|
|
</group>
|
|
|
|
|
|
|
|
|
|
</launch>
|