Get a Quality Score from AMCL
I'm trying to figure out a way of creating a quality score for the amcl_pose.
The most naive solution I could think of is to see "how small/big" the particle cloud gets, and normalize both sizes as 0 and 1. Then map the current cloud size to that scale.
Has anyone done something similar before? Or does anyone know where I can get the particle cloud size from the AMCL package or the code directly?
The point is that when the robot gets really lost (the quality score drops below an acceptable area), I'll ignore it.
Also open to other ideas.
Not sure if I fully understood your question, but what about using the covariance of the pose topic?
@Humpelstilzchen from what I understand about covariance, it's just a degree of correlation between different states. Not sure how to extract an accuracy score out of that. Unless you know otherwise? The only way I can see accuracy is the size of the point cloud. Thanks for the input.
I'm a bit on unstable terrain here, but in the diagonal of the cov matrix you have the variance of each pose variable, right? And the less confident amcl is about its position the higher its values should be.
@Humpelstilzchen I took some sample covariance data. You can see it here: https://docs.google.com/spreadsheets/...
Are you saying the less confident the higher the sum will be in the cells going from top left to bottom right?
Yes -- enter at least 7 more characters
Thanks for the help. Could you clarify what you mean by enter at least 7 more characters.
lol, that was just the error I got when I tried to reply "yes"