Discrete Filters
Discrete Filters
Discrete filters
SA-1
Piecewise
Constant
2
Discrete Bayes Filter Algorithm
1. Algorithm Discrete_Bayes_filter( Bel(x),d ):
2. 0
3. If d is a perceptual data item z then
4. For all x do
5. Bel ' ( x) P ( z | x) Bel ( x)
6. Bel ' ( x)
7. For all x do
8. Bel ' ( x) 1 Bel ' ( x)
9. Else if d is an action data item u then
10. For all x do
11. Bel ' ( x) P( x | u , x' ) Bel ( x' )
x'
12. Return Bel’(x)
3
Piecewise Constant
Representation
Bel ( xt x, y, )
4
Implementation (1)
5
Implementation (2)
• To efficiently update the belief upon robot motions, one typically
assumes a bounded Gaussian model for the motion uncertainty.
• This reduces the update cost from O(n2) to O(n), where n is the
number of states.
• The update can also be realized by shifting the data in the grid
according to the measured motion.
• In a second step, the grid is then convolved using a separable
Gaussian Kernel.
• Two-dimensional example:
7
Sonars and
Occupancy Grid Map
8
Tree-based Representation
9
Tree-based Representations
10
Xavier:
Localization in a Topological Map