← 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.