Effects of iteration in kalman filters family for improvement of estimation accuracy in simultaneous localization and mapping

In this paper we investigate the role of iteration in kalman filters family for improvement of the estimation accuracy of states in Simultaneous Localization and Mapping (SLAM). The linearized error propagation existing in kalman filters family can result in large errors and inconsistency in the SLAM problem. One approach to alleviate this situation is the use of iteration in Extended Kalman Filter (EKF) and Sigma Point Kalman Filter (SPKF). We will describe that the iterated versions of kalman filters can increase the estimation accuracy and robustness of these filters against linear error propagation. Simulation results are presented to validate this improvement of state estimate convergence through repetitive linearization of the nonlinear model in EKFSLAM and SPKFSLAM algorithms.

[1]  Rudolph van der Merwe,et al.  Sigma-point kalman filters for probabilistic inference in dynamic state-space models , 2004 .

[2]  Gaurav S. Sukhatme,et al.  The Iterated Sigma Point Kalman Filter with Applications to Long Range Stereo , 2006, Robotics: Science and Systems.

[3]  Jeffrey K. Uhlmann,et al.  New extension of the Kalman filter to nonlinear systems , 1997, Defense, Security, and Sensing.

[4]  Stefan B. Williams.  Efficient Solutions to Autonomous Mapping and Navigation Problems , 2009 .

[5]  Randall Smith,et al.  Estimating Uncertain Spatial Relationships in Robotics , 1987, Autonomous Robot Vehicles.

[6]  Jeffrey K. Uhlmann,et al.  A counter example to the theory of simultaneous localization and map building , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[7]  Thiagalingam Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation , 2001 .

[8]  Rudolph van der Merwe,et al.  The unscented Kalman filter for nonlinear estimation , 2000, Proceedings of the IEEE 2000 Adaptive Systems for Signal Processing, Communications, and Control Symposium (Cat. No.00EX373).

[9]  Peter C. Cheeseman,et al.  Estimating uncertain spatial relationships in robotics , 1986, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[10]  Hugh F. Durrant-Whyte,et al.  A solution to the simultaneous localization and map building (SLAM) problem , 2001, IEEE Trans. Robotics Autom..

[11]  Timothy S. Bailey,et al.  Mobile Robot Localisation and Mapping in Extensive Outdoor Environments , 2002 .

[12]  Teresa A. Vidal-Calleja,et al.  Unscented Transformation of Vehicle States in SLAM , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[13]  José A. Castellanos,et al.  Unscented SLAM for large-scale outdoor environments , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[14]  Henrik I. Christensen,et al.  Triangulation-based fusion of sonar data with application in robot pose tracking , 2000, IEEE Trans. Robotics Autom..

[15]  Udo Frese.  An O(log n) algorithm for simultaneous localization and mapping of mobile robots in indoor environments , 2004 .