are you doing scan-matching?

[Sollimann]

First of all, great project you have here :) I'm assuming you have based your implementation on the paper Improved Techniques for Grid Mapping With Rao-Blackwellized Particle Filters, is that correct? When reading through your code I couldn't identify which part of the code that was doing scan-matching. Is it included in the implementation, if so, which part of the code is this? The only possible candidate I found was this.

It seems to me that this part of the corresponds to step 3 and 4 in the algorithm in the paper, meaning that you first do a sampling step, then you compute an improved proposal distribution and then you update importance weights. It also looks like you're skipping the scan-matching, is that correct? Also, you have commented out the resampling, why is that?

Sorry for all the questions, I'm just curious on your implementation :) I tried to run your code, and it works great, so kudos for that!

[jerrywiston]

I appreciate that you like my project. My work is basically based on the paper "Improved Techniques for Grid Mapping With Rao-Blackwellized Particle Filters", while I only implement the original version of RBPF that adopt the motion model as the proposal distribution:
.
The term "p(z|x,m)" corresponds to the likelihood field computation in my code.

The algorithm with scan matching is based on the later equation of the paper:
.
You have to apply the scan matching algorithm such as ICP or HectorSLAM to compute the related pose between two timesteps as the mean of the Gaussian assumption (p(z|x)), and then use it to sample the particle in the meaningful regions.

Besides, I commented the resampling process because I have moved it outside (you can see it in "test.py").

[Sollimann]

Thank you for the thorough answer :) When you say, "while I only implement the original version of RBPF that adopt the motion model as the proposal distribution"?. Does this original implementation lack scan-matching? 🤔 I still don't understand if you have implemented the scan matching or not, at least I'm unable to identify anything resembles an ICP or HectorSLAM algorithm in your code.

[jerrywiston]

I only utilize motion model as the proposal distribution and do not apply the scan matching.
And if you want to implement scan matching, you have to refer to that equation.