← Back to the chapter · Next detail →

Technical detail · Particle Filters for Localization

Calculate a sensor-weighted location

For this update, the five predicted particles have equal prior weights. A range observation of 10.0 m and sensor standard deviation of 1.0 m determine their relative likelihoods.

Worked example: one-dimensional location update
measurement z: 10.0 m
sensor sigma: 1.0 m
predicted particles x_i: 8.8, 9.5, 10.2, 11.0, 12.0 m
relative likelihood: exp(-0.5 * error^2 / sigma^2)

particle  error  likelihood  normalized weight
8.8 m     -1.2   0.487       0.158
9.5 m     -0.5   0.882       0.285
10.2 m     0.2   0.980       0.317
11.0 m     1.0   0.607       0.196
12.0 m     2.0   0.135       0.044

sum of likelihoods = 3.091
weighted estimate =
8.8*0.158 + 9.5*0.285 + 10.2*0.317 + 11.0*0.196 + 12.0*0.044
= about 10.02 m

Interpretation:
The particles near the 10.0 m measurement dominate the estimate.
The 12.0 m particle is not impossible, but it contributes little evidence.

← Back to the chapter · Next detail →