Particle Filter Revisit
There are many filters to localize a robot. Most common filters are
Filter | Prop 1 | Prop 2 | Prop 3 |
---|---|---|---|
Histogram Filter | Discrete | Multi Modal | Exponential |
Kalman Filter | Continuous | Uni Modal | Quadratic |
Particle Filter | Continuous | Multi Modal | Usually good |
How a Particle Filter work
So how does it work? it works as its name (particle).
- Guess multiple position for a robot (like 1,000 random guesses of (x, y, direction))
- When a robot moves/rotates, update every particle with the same motion and rotation
- For every particle, measure its actual distance to landmarks in the map and compare it to the sensor values (which the actual robot receives)
- Using the Gaussian, compute the probability how likely that particle measures correctly the robot's position
- Normalized the weight (by dividing each probability by the sum of every probability)
- Resample with a replacement
More explanation about the resampling
Suppose there are five particles. and each particle has its own probability called weight .
Then . I just divide each element of W by the sum of W.
Since we have the probability, and then we can apply the Resampling Wheel algorithm here.
The point is keep drawing and particles that measures the correct location will survive.