rtabmap_ros
rtabmap_ros copied to clipboard
Nav2 failing to work with the Turtlebot4 demo
I'm trying to get the turtlebot4 demo working with nav2 and explore_lite. However when setting the nav2 goal in rviz, there seems to be no movement in the robot? It spins and backs up once in a while (now that I think about it it's a similar behavior to stuck/collision recovery?).
I am using ROS2 Jazzy with Ubuntu 24.04
[controller_server-1] [INFO] [1747823022.053474413] [controller_server]: Passing new path to controller.
[controller_server-1] [ERROR] [1747823022.053620689] [controller_server]: Failed to make progress
[controller_server-1] [INFO] [1747823022.054695011] [controller_server]: Optimizer reset
[controller_server-1] [WARN] [1747823022.054742495] [controller_server]: [follow_path] [ActionServer] Aborting handle.
On rtabmap's terminal:
[bt_navigator-5] [ERROR] [1747817924.866371733] [bt_navigator_navigate_to_pose_rclcpp_node.rclcpp_action]: unknown result response, ignoring...
[bt_navigator-5] [ERROR] [1747817924.866555201] [bt_navigator_navigate_to_pose_rclcpp_node.rclcpp_action]: unknown goal response, ignoring...
[bt_navigator-5] [ERROR] [1747817924.866371733] [bt_navigator_navigate_to_pose_rclcpp_node.rclcpp_action]: unknown result response, ignoring...
[bt_navigator-5] [ERROR] [1747817924.866555201] [bt_navigator_navigate_to_pose_rclcpp_node.rclcpp_action]: unknown goal response, ignoring...
Snippet of spin logs:
[controller_server-1] [ERROR] [1747822999.472475087] [controller_server]: Failed to make progress
[controller_server-1] [INFO] [1747822999.473131895] [controller_server]: Optimizer reset
[controller_server-1] [WARN] [1747822999.473146819] [controller_server]: [follow_path] [ActionServer] Aborting handle.
[behavior_server-4] [INFO] [1747822999.484175071] [behavior_server]: Running spin
[behavior_server-4] [INFO] [1747822999.484231022] [behavior_server]: Turning 1.57 for spin behavior.
[behavior_server-4] [INFO] [1747823001.384434693] [behavior_server]: spin completed successfully
[controller_server-1] [INFO] [1747823001.426531268] [controller_server]: Received a goal, begin computing control effort.
There are also constant warnings about polling rate, I assume it is irrelevant but in case it is:
[controller_server-1] [WARN] [1747823022.053425176] [controller_server]: Control loop missed its desired rate of 20.0000 Hz. Current loop rate is 16.6667 Hz.
Could be related to the local costmap, can you visualize the local costmap in rviz? If there is nothing, the controller may reject navigating because it cannot see anything.