rtabmap_ros remote mapping bad tf tree

asked 2020-12-14 14:31:28 -0600

Batstru gravatar image

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 ...
(more)
edit retag flag offensive close merge delete