-
Notifications
You must be signed in to change notification settings - Fork 37
Description
What happened?
Hi,
I' ve followed the ros2 Nav tutorial but the navigation doesn't start.
I don't know why, but It seems that ros2 is not able to see the topics related to the locobot.
If I run the command:
ros2 topic list
I see only:
/parameter_events
/rosout
The terminal print out some warnings related to rtabmap and rgbd_synch nodes (written in the log section).
I've already tried every step suggested in the Troubleshooting section but nothing works for me. I don't know how to solve the problem.
Robot Model
locobot_wx250s
Operating System
Ubuntu 20.04
ROS Distro
ROS 2 Galactic
Steps To Reproduce
Launching the command
ros2 launch interbotix_xslocobot_nav xslocobot_rtabmap.launch.py robot_model:=locobot_wx250s use_lidar:=true slam_mode:=mapping rtabmap_args:=-d
Relevant log output
[INFO] [rgbd_sync-8]: process started with pid [59030]
[INFO] [obstacles_detection-9]: process started with pid [59032]
[INFO] [point_cloud_xyzrgb-10]: process started with pid [59034]
[INFO] [rtabmap-11]: process started with pid [59036]
[point_cloud_xyzrgb-10] [INFO] [1700829459.759777557] [locobot.rtabmap.point_cloud_xyzrgb]: Approximate time sync = false
[rgbd_sync-8] [INFO] [1700829460.874041670] [locobot.rtabmap.rgbd_sync]: rgbd_sync: approx_sync = false
[rgbd_sync-8] [INFO] [1700829460.874298790] [locobot.rtabmap.rgbd_sync]: rgbd_sync: queue_size = 10
[rgbd_sync-8] [INFO] [1700829460.874315170] [locobot.rtabmap.rgbd_sync]: rgbd_sync: qos = 0
[rgbd_sync-8] [INFO] [1700829460.874323630] [locobot.rtabmap.rgbd_sync]: rgbd_sync: qos_camera_info = 0
[rgbd_sync-8] [INFO] [1700829460.874333478] [locobot.rtabmap.rgbd_sync]: rgbd_sync: depth_scale = 1.000000
[rgbd_sync-8] [INFO] [1700829460.874353008] [locobot.rtabmap.rgbd_sync]: rgbd_sync: decimation = 1
[rgbd_sync-8] [INFO] [1700829460.874361571] [locobot.rtabmap.rgbd_sync]: rgbd_sync: compressed_rate = 0.000000
[rgbd_sync-8] [INFO] [1700829460.904099289] [locobot.rtabmap.rgbd_sync]:
[rgbd_sync-8] rgbd_sync subscribed to (exact sync):
[rgbd_sync-8] /locobot/camera/color/image_raw,
[rgbd_sync-8] /locobot/camera/aligned_depth_to_color/image_raw,
[rgbd_sync-8] /locobot/camera/color/camera_info
[rtabmap-11] [INFO] [1700829461.131097300] [locobot.rtabmap.rtabmap]: rtabmap(maps): map_filter_radius = 0.000000
[rtabmap-11] [INFO] [1700829461.131397137] [locobot.rtabmap.rtabmap]: rtabmap(maps): map_filter_angle = 30.000000
[rtabmap-11] [INFO] [1700829461.131419391] [locobot.rtabmap.rtabmap]: rtabmap(maps): map_cleanup = true
[rtabmap-11] [INFO] [1700829461.131429119] [locobot.rtabmap.rtabmap]: rtabmap(maps): map_always_update = false
[rtabmap-11] [INFO] [1700829461.131437002] [locobot.rtabmap.rtabmap]: rtabmap(maps): map_empty_ray_tracing = true
[rtabmap-11] [INFO] [1700829461.131444705] [locobot.rtabmap.rtabmap]: rtabmap(maps): cloud_output_voxelized = true
[rtabmap-11] [INFO] [1700829461.131452312] [locobot.rtabmap.rtabmap]: rtabmap(maps): cloud_subtract_filtering = false
[rtabmap-11] [INFO] [1700829461.131460001] [locobot.rtabmap.rtabmap]: rtabmap(maps): cloud_subtract_filtering_min_neighbors = 2
[rtabmap-11] [INFO] [1700829461.131507799] [locobot.rtabmap.rtabmap]: rtabmap(maps): octomap_tree_depth = 16
[rtabmap-11] [INFO] [1700829461.181582675] [locobot.rtabmap.rtabmap]: rtabmap: frame_id = locobot/base_footprint
[rtabmap-11] [INFO] [1700829461.181620676] [locobot.rtabmap.rtabmap]: rtabmap: odom_frame_id = locobot/odom
[rtabmap-11] [INFO] [1700829461.181630144] [locobot.rtabmap.rtabmap]: rtabmap: map_frame_id = map
[rtabmap-11] [INFO] [1700829461.181637592] [locobot.rtabmap.rtabmap]: rtabmap: use_action_for_goal = false
[rtabmap-11] [INFO] [1700829461.181648889] [locobot.rtabmap.rtabmap]: rtabmap: tf_delay = 0.050000
[rtabmap-11] [INFO] [1700829461.181661011] [locobot.rtabmap.rtabmap]: rtabmap: tf_tolerance = 0.100000
[rtabmap-11] [INFO] [1700829461.181669556] [locobot.rtabmap.rtabmap]: rtabmap: odom_sensor_sync = false
[rtabmap-11] [INFO] [1700829461.181677030] [locobot.rtabmap.rtabmap]: rtabmap: gen_scan = false
[rtabmap-11] [INFO] [1700829461.181684500] [locobot.rtabmap.rtabmap]: rtabmap: gen_depth = false
[rtabmap-11] [INFO] [1700829461.221017889] [locobot.rtabmap.rtabmap]: Setting RTAB-Map parameter "Grid/MaxObstacleHeight"="0.7"
[rtabmap-11] [INFO] [1700829461.221564882] [locobot.rtabmap.rtabmap]: Setting RTAB-Map parameter "Grid/RayTracing"="true"
[rtabmap-11] [INFO] [1700829461.226484270] [locobot.rtabmap.rtabmap]: Setting RTAB-Map parameter "Mem/IncrementalMemory"="True"
[rtabmap-11] [INFO] [1700829461.226571613] [locobot.rtabmap.rtabmap]: Setting RTAB-Map parameter "Mem/InitWMWithAllNodes"="False"
[rtabmap-11] [INFO] [1700829461.227416756] [locobot.rtabmap.rtabmap]: Setting RTAB-Map parameter "Mem/STMSize"="30"
[rtabmap-11] [INFO] [1700829461.229002134] [locobot.rtabmap.rtabmap]: Setting RTAB-Map parameter "RGBD/AngularUpdate"="0.01"
[rtabmap-11] [INFO] [1700829461.229415110] [locobot.rtabmap.rtabmap]: Setting RTAB-Map parameter "RGBD/LinearUpdate"="0.01"
[rtabmap-11] [INFO] [1700829461.229609912] [locobot.rtabmap.rtabmap]: Setting RTAB-Map parameter "RGBD/LocalRadius"="5"
[rtabmap-11] [INFO] [1700829461.230071666] [locobot.rtabmap.rtabmap]: Setting RTAB-Map parameter "RGBD/NeighborLinkRefining"="true"
[rtabmap-11] [INFO] [1700829461.241006748] [locobot.rtabmap.rtabmap]: Setting RTAB-Map parameter "Reg/Force3DoF"="true"
[rtabmap-11] [INFO] [1700829461.243625635] [locobot.rtabmap.rtabmap]: Update RTAB-Map parameter "RGBD/ProximityBySpace"="true--RGBD/ProximityPathMaxNeighbors" from arguments
[rtabmap-11] [WARN] [1700829461.243763895] [locobot.rtabmap.rtabmap]: Setting "Grid/Sensor" parameter to 0 (default 1) as "subscribe_scan" or "subscribe_scan_cloud" or "gen_scan" is true. The occupancy grid map will be constructed from laser scans. To get occupancy grid map from cloud projection, set "Grid/Sensor" to true. To suppress this warning, add <param name="Grid/Sensor" type="string" value="0"/>
[rtabmap-11] [INFO] [1700829461.243801293] [locobot.rtabmap.rtabmap]: Setting "Grid/RangeMax" parameter to 0 (default 5.000000) as "subscribe_scan" or "subscribe_scan_cloud" or "gen_scan" is true and Grid/Sensor is 0.
[rtabmap-11] [INFO] [1700829461.243991788] [locobot.rtabmap.rtabmap]: RTAB-Map detection rate = 1.000000 Hz
[rtabmap-11] [INFO] [1700829461.244141032] [locobot.rtabmap.rtabmap]: rtabmap: Deleted database "/home/locobot/.ros/rtabmap.db" (--delete_db_on_start or -d are set).
[rtabmap-11] [INFO] [1700829461.244168880] [locobot.rtabmap.rtabmap]: rtabmap: Using database from "/home/locobot/.ros/rtabmap.db" (0 MB).
[rtabmap-11] [INFO] [1700829461.400490825] [locobot.rtabmap.rtabmap]: rtabmap: Database version = "0.20.21".
[rtabmap-11] [INFO] [1700829461.400572774] [locobot.rtabmap.rtabmap]: rtabmap: SLAM mode (Mem/IncrementalMemory=true)
[rtabmap-11] [INFO] [1700829461.426061684] [locobot.rtabmap.rtabmap]: Setup callbacks
[rtabmap-11] [INFO] [1700829461.426372062] [locobot.rtabmap.rtabmap]: rtabmap: subscribe_depth = false
[rtabmap-11] [INFO] [1700829461.426391808] [locobot.rtabmap.rtabmap]: rtabmap: subscribe_rgb = false
[rtabmap-11] [INFO] [1700829461.426401536] [locobot.rtabmap.rtabmap]: rtabmap: subscribe_stereo = false
[rtabmap-11] [INFO] [1700829461.426410654] [locobot.rtabmap.rtabmap]: rtabmap: subscribe_rgbd = true (rgbd_cameras=1)
[rtabmap-11] [INFO] [1700829461.426420741] [locobot.rtabmap.rtabmap]: rtabmap: subscribe_odom_info = false
[rtabmap-11] [INFO] [1700829461.426527538] [locobot.rtabmap.rtabmap]: rtabmap: subscribe_user_data = false
[rtabmap-11] [INFO] [1700829461.426539768] [locobot.rtabmap.rtabmap]: rtabmap: subscribe_scan = true
[rtabmap-11] [INFO] [1700829461.426548884] [locobot.rtabmap.rtabmap]: rtabmap: subscribe_scan_cloud = false
[rtabmap-11] [INFO] [1700829461.426556955] [locobot.rtabmap.rtabmap]: rtabmap: subscribe_scan_descriptor = false
[rtabmap-11] [INFO] [1700829461.426565694] [locobot.rtabmap.rtabmap]: rtabmap: queue_size = 10
[rtabmap-11] [INFO] [1700829461.426575093] [locobot.rtabmap.rtabmap]: rtabmap: qos_image = 0
[rtabmap-11] [INFO] [1700829461.426583671] [locobot.rtabmap.rtabmap]: rtabmap: qos_camera_info = 0
[rtabmap-11] [INFO] [1700829461.426591779] [locobot.rtabmap.rtabmap]: rtabmap: qos_scan = 1
[rtabmap-11] [INFO] [1700829461.426600331] [locobot.rtabmap.rtabmap]: rtabmap: qos_odom = 0
[rtabmap-11] [INFO] [1700829461.426609323] [locobot.rtabmap.rtabmap]: rtabmap: qos_user_data = 0
[rtabmap-11] [INFO] [1700829461.426617696] [locobot.rtabmap.rtabmap]: rtabmap: approx_sync = true
[rtabmap-11] [INFO] [1700829461.426635796] [locobot.rtabmap.rtabmap]: Setup rgbd callback
[rtabmap-11] [INFO] [1700829461.432083713] [locobot.rtabmap.rtabmap]:
[rtabmap-11] rtabmap subscribed to (approx sync):
[rtabmap-11] /locobot/rtabmap/rgbd_image \
[rtabmap-11] /locobot/scan
[rgbd_sync-8] [WARN] [1700829465.958787414] [locobot.rtabmap.rgbd_sync]: rgbd_sync: Did not receive data since 5 seconds! Make sure the input topics are published ("$ rostopic hz my_topic") and the timestamps in their header are set.
[rgbd_sync-8] rgbd_sync subscribed to (exact sync):
[rgbd_sync-8] /locobot/camera/color/image_raw,
[rgbd_sync-8] /locobot/camera/aligned_depth_to_color/image_raw,
[rgbd_sync-8] /locobot/camera/color/camera_info
[rtabmap-11] [WARN] [1700829466.448977251] [locobot.rtabmap.rtabmap]: rtabmap: Did not receive data since 5 seconds! Make sure the input topics are published ("$ rostopic hz my_topic") and the timestamps in their header are set. If topics are coming from different computers, make sure the clocks of the computers are synchronized ("ntpdate"). If topics are not published at the same rate, you could increase "queue_size" parameter (current=10).
[rtabmap-11] rtabmap subscribed to (approx sync):
[rtabmap-11] /locobot/rtabmap/rgbd_image \
[rtabmap-11] /locobot/scan
[INFO] [controller_server-12]: process started with pid [59096]
[INFO] [planner_server-13]: process started with pid [59098]
[INFO] [recoveries_server-14]: process started with pid [59100]
[INFO] [bt_navigator-15]: process started with pid [59102]
[INFO] [waypoint_follower-16]: process started with pid [59113]
[INFO] [lifecycle_manager-17]: process started with pid [59121]
[controller_server-12] [INFO] [1700829468.263506020] [controller_server]:
[controller_server-12] controller_server lifecycle node launched.
[controller_server-12] Waiting on external lifecycle transitions to activate
[controller_server-12] See https://design.ros2.org/articles/node_lifecycle.html for more information.
[controller_server-12] [INFO] [1700829468.298514748] [controller_server]: Creating controller server
[waypoint_follower-16] [INFO] [1700829468.331497850] [waypoint_follower]:
[waypoint_follower-16] waypoint_follower lifecycle node launched.
[waypoint_follower-16] Waiting on external lifecycle transitions to activate
[waypoint_follower-16] See https://design.ros2.org/articles/node_lifecycle.html for more information.
[waypoint_follower-16] [INFO] [1700829468.336624166] [waypoint_follower]: Creating
[bt_navigator-15] [INFO] [1700829468.341270714] [bt_navigator]:
[bt_navigator-15] bt_navigator lifecycle node launched.
[bt_navigator-15] Waiting on external lifecycle transitions to activate
[bt_navigator-15] See https://design.ros2.org/articles/node_lifecycle.html for more information.
[bt_navigator-15] [INFO] [1700829468.343668201] [bt_navigator]: Creating
[controller_server-12] [INFO] [1700829468.368577520] [local_costmap.local_costmap]:
[controller_server-12] local_costmap lifecycle node launched.
[controller_server-12] Waiting on external lifecycle transitions to activate
[controller_server-12] See https://design.ros2.org/articles/node_lifecycle.html for more information.
[controller_server-12] [INFO] [1700829468.369631440] [local_costmap.local_costmap]: Creating Costmap
[planner_server-13] [INFO] [1700829468.383294634] [planner_server]:
[planner_server-13] planner_server lifecycle node launched.
[planner_server-13] Waiting on external lifecycle transitions to activate
[planner_server-13] See https://design.ros2.org/articles/node_lifecycle.html for more information.
[recoveries_server-14] [INFO] [1700829468.385883612] [recoveries_server]:
[recoveries_server-14] recoveries_server lifecycle node launched.
[recoveries_server-14] Waiting on external lifecycle transitions to activate
[recoveries_server-14] See https://design.ros2.org/articles/node_lifecycle.html for more information.
[planner_server-13] [INFO] [1700829468.386234233] [planner_server]: Creating
[lifecycle_manager-17] [INFO] [1700829468.425484652] [lifecycle_manager_navigation]: Creating
[lifecycle_manager-17] [INFO] [1700829468.434043879] [lifecycle_manager_navigation]: Creating and initializing lifecycle service clients
[planner_server-13] [INFO] [1700829468.454555366] [global_costmap.global_costmap]:
[planner_server-13] global_costmap lifecycle node launched.
[planner_server-13] Waiting on external lifecycle transitions to activate
[planner_server-13] See https://design.ros2.org/articles/node_lifecycle.html for more information.
[planner_server-13] [INFO] [1700829468.455526422] [global_costmap.global_costmap]: Creating Costmap
[rgbd_sync-8] [WARN] [1700829470.958775389] [locobot.rtabmap.rgbd_sync]: rgbd_sync: Did not receive data since 5 seconds! Make sure the input topics are published ("$ rostopic hz my_topic") and the timestamps in their header are set.
[rgbd_sync-8] rgbd_sync subscribed to (exact sync):
[rgbd_sync-8] /locobot/camera/color/image_raw,
[rgbd_sync-8] /locobot/camera/aligned_depth_to_color/image_raw,
[rgbd_sync-8] /locobot/camera/color/camera_info
[rtabmap-11] [WARN] [1700829471.448966110] [locobot.rtabmap.rtabmap]: rtabmap: Did not receive data since 5 seconds! Make sure the input topics are published ("$ rostopic hz my_topic") and the timestamps in their header are set. If topics are coming from different computers, make sure the clocks of the computers are synchronized ("ntpdate"). If topics are not published at the same rate, you could increase "queue_size" parameter (current=10).
[rtabmap-11] rtabmap subscribed to (approx sync):
[rtabmap-11] /locobot/rtabmap/rgbd_image \
[rtabmap-11] /locobot/scan
[rgbd_sync-8] [WARN] [1700829475.958775263] [locobot.rtabmap.rgbd_sync]: rgbd_sync: Did not receive data since 5 seconds! Make sure the input topics are published ("$ rostopic hz my_topic") and the timestamps in their header are set.
[rgbd_sync-8] rgbd_sync subscribed to (exact sync):
[rgbd_sync-8] /locobot/camera/color/image_raw,
[rgbd_sync-8] /locobot/camera/aligned_depth_to_color/image_raw,
[rgbd_sync-8] /locobot/camera/color/camera_info
[rtabmap-11] [WARN] [1700829476.448964780] [locobot.rtabmap.rtabmap]: rtabmap: Did not receive data since 5 seconds! Make sure the input topics are published ("$ rostopic hz my_topic") and the timestamps in their header are set. If topics are coming from different computers, make sure the clocks of the computers are synchronized ("ntpdate"). If topics are not published at the same rate, you could increase "queue_size" parameter (current=10).
[rtabmap-11] rtabmap subscribed to (approx sync):
[rtabmap-11] /locobot/rtabmap/rgbd_image \
[rtabmap-11] /locobot/scanAdditional Info
When I made the ros2 installation on the locobot, the default control.launch.py file considered a wrong type of lidar (a2m12). I've change the default value with the correct one in my locobot (a2m8). Before this modification, even the lidar didn't work. After that, it started working.
I don't know if there can be other possible problems related to the default launch files settings.