$H_{\infty}$ Filter Based Robust Simultaneous Localization and Mapping for Mobile Robots

이동로봇을 위한 $H_{\infty}$ 필터 기반의 강인한 동시 위치인식 및 지도작성 구현 기술

  • 전서현 (한국전자통신연구원) ;
  • 이건용 (고려대학교 전기전자전파공학과) ;
  • 도낙주 (고려대학교 전기전자전파공학과)
  • Received : 2010.07.30
  • Accepted : 2011.01.14
  • Published : 2011.01.25

Abstract

The most basic algorithm in SLAM(Simultaneous Localization And Mapping) technique of mobile robots is EKF(Extended Kalman Filter) SLAM. However, it requires prior information of characteristics of the system and the noise model which cannot be estimated in accurate. By this limit, Kalman Filter shows the following behaviors in a highly uncertain environment: becomes too sensitive to internal parameters, mathematical consistency is not kept, or yields a wrong estimation result. In contrast, $H_{\infty}$ filter does not requires a prior information in detail. Thus, based on a idea that $H_{\infty}$ filter based SLAM will be more robust than the EKF-SLAM, we propose a framework of $H_{\infty}$ filter based SLAM and show that suggested algorithm shows slightly better result man me EKF-SLAM in a highly uncertain environment.

이동로봇의 동시 위치인식 및 지도작성 (Simultaneous Localization And Mapping, SLAM) 에서 가장 기본이 되는 알고리즘은 확장 칼만 필터 SLAM(Extended Kalman Filter SLAM, EKF-SLAM)이다. 하지만 칼만 필터를 사용할 때, 시스템 설계자는 외부 입력에 대한 시스템적 특성과 외부 노이즈의 확률적 모델을 알고 있어야 하나, 실제 환경에서는 이를 정확히 파악할 수 없는 한계가 있다. 이에, 칼만 필터를 불확실성이 심한 실제 환경에 적용할 경우 내부 변수의 변화에 민감하게 반응하거나, 필터의 수학적 일관성이 지켜지지 않거나 또는 부정확한 상태 변수값을 추정하기도 한다. 이에 비해 $H_{\infty}$ 필터는 외부 모델에 대한 상세한 정보가 없을지라도 강인하게 상태를 예측할 수 있다는 장점을 가지고 있다. 본 논문에서는 이러한 $H_{\infty}$ 필터의 특성이 이용로봇의 SLAM 알고리즘의 성능 향상에 도움이 될 것이라는 아이디어에 착안하여 $H_{\infty}$ 필터에 가번한 SLAM 알고리즘을 제안하고 이를 모의 실험에 적용해 보았다. 이를 통해 불확실성이 큰 환경에서는 제안된 알고리즘이 기존의 EKF-SLAM에 비해 다소 우수한 예측 성능을 보임을 확인할 수 있었다.

Keywords

References

  1. H. Durrant-Whyte and T. Bailey, "Simultaneous Localization and Mapping: Part I," IEEE Robotics and Automation Magazine, vol. 13, no. 2, pp. 99–110, 2006.
  2. T. Bailey and H. Durrant-Whyte, "Simultaneous Localization and Mapping(SLAM): Part II," IEEE Robotics and Automation Magazine, vol. 13, no. 3, pp. 108-117, 2006.
  3. Guoquan P. Huang, Anastasios I. Mourikis and Stergios I. Roumeliotis, "Observability-based Rules for Designing Consistent EKF SLAM Estimators," The International Journal of Robotics Research, Vol. 29, no. 5, pp. 502-528, 2010. https://doi.org/10.1177/0278364909353640
  4. S. Julier, J. Uhlmann, and H. F. Durrant-Whyte, "A new method for the nonlinear transformation of means and covariances in filters and estimators," IEEE Transactions on Automatic Control, vol. 45, no. 3, pp. 477-482, 2000. https://doi.org/10.1109/9.847726
  5. Guoquan P. Huang, Anastasios I. Mourikis and Stergios I. Roumeliotis, "On the Complexity and Consistency of UKF-based SLAM," IEEE International Conference on Robotics and Automation, pp. 4401-4408, 2009.
  6. M. Montemerlo, S. Thrun, D. Koller, and B. Wegbreit, "Fast-SLAM: A factored solution to the simultaneous localization and mapping problem," AAAI National Conference on Artificial Intelligence, pp. 593-598, 2002.
  7. M. Montemerlo, S. Thrun, D. Koller, and B. Wegbreit, "Fast-SLAM 2.0: An improved particle ¯ltering algorithm for simul-taneous localization and mapping that provably converges," International Joint Conference on Artificial Intelligence, pp. 1151-1156, 2003.
  8. 전서현, 도낙주, "Robust Data Estimation for Simultaneous Localization and Mapping : a hybrid approach of $H_{\infty}$ and Extended Kalman Filter," 고려대학교 대학원 학위논문, 2009년 02월.
  9. Hamzah Ahmad and Toru Namerikawa, "$H{\infty}$ filtering convergence and it's application to SLAM," ICROS-SICE International Joint Conference, pp. 2875-2880, 2009.
  10. T. Basar and P. Bernhard, $H_{\infty}-Optimal $ Control and Related Minimax Design Problems: a dynamic game approach 2nd ed., Birkhauser, 1995.
  11. Dan Simon, Optimal State Estimation, WILEY, pp. 333-391, 2006.
  12. X. Shen and L. Deng, "Game Theory Approach to discrete $H_{\infty}$ Filter Design," IEEE Transactions on Signal Processing, vol. 45, no. 4, pp. 1092-1095, 1997. https://doi.org/10.1109/78.564201
  13. Y. S. Hung and F. Yang, "Robust $H_{\infty}$ filtering with error variance constraints for discrete time-varying systems with uncertainty," Automatica, vol 39, no. 7, pp. 1185-1194, 2003. https://doi.org/10.1016/S0005-1098(03)00117-1