Skip to main content
SpringerLink
Log in

The Study of Improving Kalman Filters Family for Nonlinear SLAM

  • Published:
Journal of Intelligent and Robotic Systems Aims and scope Submit manuscript

Abstract

When Extended Kalman Filter is used to solve the SLAM problem of a nonlinear system, the linearization error will lead to severe estimation error or even make the method to be divergent. After analyzing the linearization principle of Kalman filters family, two improved methods are suggested to decrease the linearization error. These two methods improve posterior estimation accuracy by revising the observation-update step. Simulation results indicate that the two methods are feasible. The method named ‘Mean Extended Kalman Filter’ performs much better than EKF and UKF for nonlinear SLAM. And the iterated version of EKF and UKF even falls behind MEKF in estimation accuracy. In addition, MEKF is computationally efficient. With a view to both estimation accuracy and computational complexity, MEKF seems to be the best filter of the Kalman filters family for nonlinear SLAM. Experiments are carried out with ‘Car Park Dataset’ and ‘Victoria Park Dataset’ to evaluate the performance of MEKF based SLAM solutions. And the experimental results validate the effectiveness of MEKF in real SLAM applications.

This is a preview of subscription content, log in via an institution to check access.

Access this article

Log in via an institution

Price excludes VAT (USA)
Tax calculation will be finalised during checkout.

Instant access to the full article PDF.

Institutional subscriptions

Similar content being viewed by others

References

  1. Smith, R., Cheesman, P.: On the representation of spatial uncertainty. Int. J. Rob. Res. 5(4), 56–68 (1987). doi:10.1177/027836498600500404

    Article  Google Scholar 

  2. Durrant-Whyte, H.F.: Uncertain geometry in robotics. IEEE Trans. Robot. Autom. 4(1), 23–31 (1988). doi:10.1109/56.768

    Article  Google Scholar 

  3. Smith, R., Self, M., Cheeseman, P.: Estimating uncertain spatial relationships in robotics. Uncertain. Artif. Intell. 2, 435–461 (1988)

    Google Scholar 

  4. Thrun, S., Fox, D., Burgard, W.: A probabilistic approach to concurrent mapping and localization for mobile robots. Mach. Learn. 31(1_3), 29–53 (1998)

    Article  MATH  Google Scholar 

  5. Williams, S.B., Dissanayake, G., Durrant-Whyte, H.F.: Field deployment of the simultaneous localization and mapping algorithm. In: Proceedings of the 2002 IFAC World Congress on Automatic Control. Barcelona, Spain, (2002)

  6. Doucet, A., de Freitas, N., Murphy, K., Russel, S.: Rao-Blackwellized particle filtering for dynamic Bayesian networks. In: Proc. of the Conf. on Uncertainty in Artificial Intelligence, pp. 176–183. UAI, Stanford, CA, USA (2000)

    Google Scholar 

  7. Martinez-Cantin, R., de Freitas, N., Castellanos, J.A.: Analysis of particle methods for simultaneous robot localization and mapping and a new algorithm: marginal-SLAM. In: IEEE International Conference on Robotics and Automation Roma, Italy, pp. 2415–2420 (2007)

  8. Shojaie, K., Ahmadi, K., Shahri, A.M.: Effects of iteration in Kalman filters family for improvement of estimation accuracy in simultaneous localization and mapping. IEEE/ASME International Conference on Advanced Intelligent Mechatronics, ETH Zurich, Switzerland (2007)

  9. Julier, S.J., Uhlmann, J.K.: A new extension of the Kalman filter to nonlinear systems. In: The Proceeding of Aerosense: The 11th International Symposium on Aerospace/Defense Sensing, Simulation and Control, Orlando FL, USA (1997)

  10. Houshangi, N., Azizi, F.: Accurate mobile robot position determination using unscented Kalman filter. 2005 IEEE CCECE/CCGEI, Saskatoon (2005)

  11. SLAM summer school. http://www.cas.kth.se/SLAM/ (2002)

  12. Guivant, J., Nebot, E.: Optimization of the simultaneous localization and map-building algorithm for real-time implementation. IEEE Trans. Robot. Autom. 17(3), 242–257 (2001). doi:10.1109/70.938382

    Article  Google Scholar 

  13. Montemerlo, M., Koller, S.T.D., Wegbreit, B.: FastSLAM 2.0: an improved particle filtering algorithm for simultaneous localization and mapping that provably converges. In: Proc. of the Int. Conf. on Artificial Intelligence, pp. 1151–1156. IJCAI, Acapulco, Mexico (2003)

  14. Bailey, T.: Mobile robot localisation and mapping in extensive outdoor environments. Doctoral thesis, Sydney University, pp. 31–36. (2002)

  15. Neira, J., Tardos, J.D.: Data association in stochastic mapping using the joint compatibility test. IEEE Trans. Robot. Autom. 17(6), 890–897 (2001) doi:10.1109/70.976019

    Article  Google Scholar 

  16. Wijesoma, W.S., Perera, L.D.L., Adams, M.D.: Toward multidimensional assignment data association in robot localization and mapping. IEEE Trans. Robot. 22(2), 350–365 (2006). doi:10.1109/TRO.2006.870634

    Article  Google Scholar 

Download references

Author information

Authors and Affiliations

  1. College of Computer Science and Technology, Nanjing University of Science and Technology, Nanjing, China

    Wu Zhou, Chunxia Zhao & Jianhui Guo

Authors
  1. Wu Zhou
    View author publications

    You can also search for this author in PubMed Google Scholar

  2. Chunxia Zhao
    View author publications

    You can also search for this author in PubMed Google Scholar

  3. Jianhui Guo
    View author publications

    You can also search for this author in PubMed Google Scholar

Corresponding author

Correspondence to Wu Zhou.

Rights and permissions

Reprints and permissions

About this article

Cite this article

Zhou, W., Zhao, C. & Guo, J. The Study of Improving Kalman Filters Family for Nonlinear SLAM. J Intell Robot Syst 56, 543 (2009). https://doi.org/10.1007/s10846-009-9327-9

Download citation

  • Received:

  • Accepted:

  • Published:

  • DOI: https://doi.org/10.1007/s10846-009-9327-9

Keywords

Search

Navigation