ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange
Ask Your Question
0

AMCL Small particles don't allow Planning on NAV2

asked 2023-05-18 21:50:38 -0500

Vini71 gravatar image

updated 2023-05-19 21:49:04 -0500

Hi I was able to solve "partially" the related issue AMCL Fails to localize.

I've been working on improving localization for my custom Ackermann robot in an environment scaled 7-12 times the size of the standard turtlebot world. However, I've encountered a couple of issues.

  1. Localization Anomalies: Despite the environment scale, the AMCL particles appear much smaller and less dispersed than when applied to the turtlebot3. I've adjusted several parameters in my nav2_params.yamll file, but the issue persists. How can I increase the size and spread of these particles?

Here's a video: AMCL Particles too Small illustrating the issue, and a screenshot of my RQT Graph for reference.

2.Trajectory Planning: Despite nodes and topics from the planner server and recover_server appearing correctly, the trajectory is not being calculated or drawn in RVIZ. The topics /goal_pose and /plan do not receive any data from the trajectory planner. Could the small AMCL particles be causing this issue?

I've verified that my RVIZ configurations (Costmaps, TF, footprint, maps) and Gazebo plugins (publishing odom TF, Lidar, camera) seem to be functioning correctly, as illustrated in the following image:

image description

I appreciate an assistance in this issue.

edit retag flag offensive close merge delete

1 Answer

Sort by ยป oldest newest most voted
0

answered 2023-05-19 23:39:26 -0500

Vini71 gravatar image

updated 2023-05-21 01:41:18 -0500

I've been experiencing a rather vexing issue with the localization and planning for my Ackermann type vehicle using Nav2. Initially, the problem seemed to be related to the particle size; however, upon changing the image resolution, I managed to get the size of particles similar to the turtlebot tutorial. Now, I'm beginning to suspect that the planning issue might be connected to the costmap and Lidar, as suggested by the repeated warnings I've received:

[rviz2-4] [INFO] [1684557117.532457854] [rviz]: Message Filter dropping message: frame 'odom' at time 18.718 for reason 'the timestamp on the message is earlier than all the data in the transform cache'
[controller_server-8] [WARN] [1684557117.542791989] [local_costmap.local_costmap]: Sensor origin at (4.15, -0.01 2.18) is out of map bounds (34.12, 29.97, 2.95) to (-14.95, -14.95, 0.00). The costmap cannot raytrace for it
9.98, 2.95) to (-14.95, -14.95, 0.00). The costmap cannot raytrace for it.
[controller_server-8] [WARN] [1684557296.342507914] [local_costmap.local_costmap]: Sensor origin at (4.19, 0.00 2.18) is out of map bounds (34.17, 29.98, 2.95) to (-14.95, -14.95, 0.00). The costmap cannot raytrace for it.
[controller_server-8] [WARN] [1684557296.542695295] [local_costmap.local_costmap]: Sensor origin at (4.19, 0.00 2.18) is out of map bounds (34.17, 29.98, 2.95) to (-14.95, -14.95, 0.00). The costmap cannot raytrace for it.
[controller_server-8] [WARN] [1684557296.742759887] [local_costmap.local_costmap]: Sensor origin at (4.19, 0.00 2.18) is out of map bounds (34.17, 29.98, 2.95) to (-14.95, -14.95, 0.00). The costmap cannot raytrace for it.
[controller_server-8] [WARN] [1684557296.942633179] [local_costmap.local_costmap]: Sensor origin at (4.19, 0.00 2.18) is out of map bounds (34.17, 29.98, 2.95) to (-14.95, -14.95, 0.00). The costmap cannot raytrace for it.
[controller_server-8] [WARN] [1684557297.142774081] [local_costmap.local_costmap]: Sensor origin at (4.19, 0.00 2.18) is out of map bounds (34.17, 29.98, 2.95) to (-14.95, -14.95, 0.00). The costmap cannot raytrace for it.
[controller_server-8] [WARN] [1684557297.342435994] [local_costmap.local_costmap]: Sensor origin at (4.19, 0.00 2.18) is out of map bounds (34.17, 29.98, 2.95) to (-14.95, -14.95, 0.00). The costmap cannot raytrace for it.
[controller_server-8] [WARN] [1684557297.542871713] [local_costmap.local_costmap]: Sensor origin at (4.19, 0.00 2.18) is out of map bounds (34.17, 29.98, 2.95) to (-14.95, -14.95, 0.00). The costmap cannot raytrace for it.
^C[WARNING] [launch]: user interrupted with ctrl-c (SIGINT)

I I believe that there might be a misconfiguration issue with costmap parameters (size, height, width) as the Lidar is mapping correctly and localization appears functional. I am yet to find a solution for this


Update:

I've made some progress and managed to resolve the costmap issue. The solution involved using a static ... (more)

edit flag offensive delete link more

Question Tools

1 follower

Stats

Asked: 2023-05-18 21:50:38 -0500

Seen: 114 times

Last updated: May 21 '23