Ask Your Question
0

How to eliminate AMCL particles using compass heading data?

asked 2018-07-10 19:58:35 -0500

achmad_fathoni gravatar image

After global_localization service called the initial particle is scattered everywhere with random heading. I have very good IMU compass say with 5 degrees error. My robot need to localize quickly so how to optimize particle filter by eliminating particles that differ more than 5 degrees from compass heading?

edit retag flag offensive close merge delete

1 Answer

Sort by ยป oldest newest most voted
0

answered 2018-07-10 20:08:40 -0500

ahendrix gravatar image

You may be able to achieve this by setting the initial_pose_a and initial_cov_aa parameters described on the AMCL wiki page before starting the AMCL node. Obviously you'll need to choose a covariance (in radians) that corresponds to your compass's heading accuracy in order to generate the correct distribution of headings in the particle cloud.

edit flag offensive delete link more

Comments

Thank you for your answer. After few step from global_localization the particles start sticking together and make some groups. Often this group has different orientation to from another and only view match the compass heading. Can you give me a hint about how to filter the wrong particles groups?

achmad_fathoni gravatar imageachmad_fathoni ( 2018-07-11 01:35:50 -0500 )edit

I am ask this following question because initial_pose_a and initial_cov_a seems only cover initial particles.

achmad_fathoni gravatar imageachmad_fathoni ( 2018-07-11 01:37:09 -0500 )edit

I am not sure AMCL supports the general case of getting absolute heading from a sensor when doing online localization. I suggest you read the AMCL source code. You may need to modify the source code for AMCL if you want to filter particles by orientation during every update.

ahendrix gravatar imageahendrix ( 2018-07-11 03:27:23 -0500 )edit

Your Answer

Please start posting anonymously - your entry will be published after you log in or create a new account.

Add Answer

Question Tools

2 followers

Stats

Asked: 2018-07-10 19:58:35 -0500

Seen: 149 times

Last updated: Jul 10 '18