Analysis of positioning uncertainty in simultaneous localization and mapping (SLAM)
stochastic models , estimation and control .