rtabmap_ros remote mapping bad tf tree
Hi, I'm following the remote mapping tutorial, and I can't make it working.
If i run the command "rosrun tf view_frames" to print the frames, it looks like it's really split in two. Output of the command is available here:
Shall I merge the two branches? If yes, how? Any other suggestion?
Thanks
This is the launch file I'm currently using:
<launch>
<!-- Kinect cloud to laser scan -->
<node pkg="depthimage_to_laserscan" type="depthimage_to_laserscan" name="depthimage_to_laserscan">
<remap from="image" to="/camera/depth_registered/image_raw"/>
<remap from="camera_info" to="/camera/depth_registered/camera_info"/>
<remap from="scan" to="/kinect_scan"/>
<param name="range_max" type="double" value="4"/>
</node>
<!-- SLAM -->
<group ns="rtabmap">
<node name="rtabmap" pkg="rtabmap_ros" type="rtabmap" output="screen" args="--delete_db_on_start">
<param name="frame_id" type="string" value="base_footprint"/>
<param name="subscribe_depth" type="bool" value="true"/>
<param name="subscribe_scan" type="bool" value="true"/>
<!-- <remap from="odom" to="/base_controller/odom"/> -->
<remap from="odom" to="/odom"/>
<remap from="scan" to="/kinect_scan"/>
<remap from="rgb/image" to="/camera/rgb/image_rect_color"/>
<remap from="depth/image" to="/camera/depth_registered/image_raw"/>
<remap from="rgb/camera_info" to="/camera/rgb/camera_info"/>
<param name="queue_size" type="int" value="10"/>
<!-- RTAB-Map's parameters -->
<param name="RGBD/ProximityBySpace" type="string" value="false"/>
<param name="RGBD/AngularUpdate" type="string" value="0.01"/>
<param name="RGBD/LinearUpdate" type="string" value="0.01"/>
<param name="RGBD/OptimizeFromGraphEnd" type="string" value="false"/>
<param name="Reg/Force3DoF" type="string" value="true"/>
<param name="Vis/MinInliers" type="string" value="12"/>
</node>
</group>
</launch>
And this is the output:
SUMMARY
========
PARAMETERS
* /depthimage_to_laserscan/range_max: 4.0
* /rosdistro: melodic
* /rosversion: 1.14.9
* /rtabmap/rtabmap/RGBD/AngularUpdate: 0.01
* /rtabmap/rtabmap/RGBD/LinearUpdate: 0.01
* /rtabmap/rtabmap/RGBD/OptimizeFromGraphEnd: false
* /rtabmap/rtabmap/RGBD/ProximityBySpace: false
* /rtabmap/rtabmap/Reg/Force3DoF: true
* /rtabmap/rtabmap/Vis/MinInliers: 12
* /rtabmap/rtabmap/frame_id: base_footprint
* /rtabmap/rtabmap/queue_size: 10
* /rtabmap/rtabmap/subscribe_depth: True
* /rtabmap/rtabmap/subscribe_scan: True
NODES
/
depthimage_to_laserscan (depthimage_to_laserscan/depthimage_to_laserscan)
/rtabmap/
rtabmap (rtabmap_ros/rtabmap)
ROS_MASTER_URI=http://192.168.1.15:11311
process[depthimage_to_laserscan-1]: started with pid [2229]
process[rtabmap/rtabmap-2]: started with pid [2230]
[ INFO] [1607975437.577841910]: Starting node...
[ INFO] [1607975437.685391299]: Initializing nodelet with 4 worker threads.
[ INFO] [1607975438.258272367]: /rtabmap/rtabmap(maps): map_filter_radius = 0.000000
[ INFO] [1607975438.258419870]: /rtabmap/rtabmap(maps): map_filter_angle = 30.000000
[ INFO] [1607975438.258495028]: /rtabmap/rtabmap(maps): map_cleanup = true
[ INFO] [1607975438.258563675]: /rtabmap/rtabmap(maps): map_always_update = false
[ INFO] [1607975438.260204382]: /rtabmap/rtabmap(maps): map_empty_ray_tracing = true
[ INFO] [1607975438.260274175]: /rtabmap/rtabmap(maps): cloud_output_voxelized = true
[ INFO] [1607975438.260320947]: /rtabmap/rtabmap(maps): cloud_subtract_filtering = false
[ INFO] [1607975438.260367875]: /rtabmap/rtabmap(maps): cloud_subtract_filtering_min_neighbors = 2
[ INFO] [1607975438.267989161]: /rtabmap/rtabmap(maps): octomap_tree_depth = 16
[ INFO] [1607975438.425760930]: rtabmap: frame_id = base_footprint
[ INFO] [1607975438.425872755]: rtabmap: map_frame_id = map
[ INFO] [1607975438.425942392]: rtabmap: use_action_for_goal = false
[ INFO] [1607975438.426003695]: rtabmap: tf_delay = 0.050000
[ INFO] [1607975438.426055154]: rtabmap: tf_tolerance = 0.100000
[ INFO] [1607975438.426111770]: rtabmap: odom_sensor_sync = false
[ INFO] [1607975439 ...