Experiments of Unmanned Underwater Vehicle's 3 Degrees of Freedom Motion Applied the SLAM based on the Unscented Kalman Filter

무인 잠수정 3자유도 운동 실험에 대한 무향 칼만 필터 기반 SLAM기법 적용

  • 황아롬 (LIG 넥스원) ;
  • 성우제 (서울대학교 조선해양공학과) ;
  • 전봉환 (한국해양연구원 해양시스템안전연구소) ;
  • 이판묵 (한국해양연구원 해양시스템안전연구소)
  • Published : 2009.04.30

Abstract

The increased use of unmanned underwater vehicles (UUV) has led to the development of alternative navigational methods that do not employ acoustic beacons and dead reckoning sensors. This paper describes a simultaneous localization and mapping (SLAM) scheme that uses range sonars mounted on a small UUV. A SLAM scheme is an alternative navigation method for measuring the environment through which the vehicle is passing and providing the relative position of the UUV. A technique for a SLAM algorithm that uses several ranging sonars is presented. This technique utilizes an unscented Kalman filter to estimate the locations of the UUV and surrounding objects. In order to work efficiently, the nearest neighbor standard filter is introduced as the data association algorithm in the SLAM for associating the stored targets returned by the sonar at each time step. The proposed SLAM algorithm was tested by experiments under various three degrees of freedom motion conditions. The results of these experiments showed that the proposed SLAM algorithm was capable of estimating the position of the UUV and the surrounding objects and demonstrated that the algorithm will perform well in various environments.

Keywords

References

  1. 전봉환, 박진영, 이판묵, 이필엽, 오준호 (2007). “자율무인잠수정 테스트베드 이심이의 개발과 수조시험”, 한국해양공학회지, 제21권, 제2호, pp 67-74
  2. Andrade-Cetto, J. Vidal-Calleja, T. and Sanfeliu, A. (2005). "Unscented Transformation of Vehicle State in SLAM", Proc. IEEE ICRA pp 323-328
  3. Carpenter, R.N. (1998). "Concurrent Mapping and Localization with FLS", Proc. AUV98, pp 133-148
  4. De Geeter, J., Van Brussel, H. and De Schutter, J. (1997). "A Smoothly Constrained Kalman Filter", IEEE Transactions on Pattern Analysis and Machine Intelligence 19, pp 1171-1177 https://doi.org/10.1109/34.625129
  5. Hwang, A. and Seong, W. (2005). Concurrent Mapping and Localization Simulation and Experiment Using Range Sonar Data", UUST05
  6. Julier, S.J. and Uhlmann, J.K. (1997). "A New Extension of the Kalman Filter to Nonlinear Systems", Proc. of AeroSense:The 11th Int. Sym. on Aerospace/Defense Sensing, Simulation and Controls, SPIE
  7. Julier, S.J. and Uhlmann, J.K. (2004). "Unscented Filtering and Nonlinear Estimation", Proc IEEE, Vol 92, No 3, pp 401-422 https://doi.org/10.1109/JPROC.2003.823141
  8. Kim, S.J. (2004). Efficient Simultaneous Localization and Mapping Algorithm Using Submap Networks, PhD Thesis, MIT
  9. Langelaan, J. and Rock, S. (2005). "Passive GPS-Free Navigation for Small UAVs", IEEE Aerospace Conference, pp 1- 9
  10. Leonard, J. and Feder, H. (2001). "Decoupled Stochastic Mapping", IEEE J. Oceanic. Eng., Vol 26, No 4, pp 561-571 https://doi.org/10.1109/48.972094
  11. Liu, T. and Schmidt, H. (2003). "Concurrent Navigation and Sea-bottom Targets Detection Using Acoustic Sensors on AUV", Proc. MTS/IEEE Int. Conf. Oceans'03, pp 2405-2409
  12. Martinez-Cantin, R. and Castellanos, J.A. (2005). "Unscented SLAM for Large-scale Outdoor Environments", IEEE/RSJ Int. Conf. on Intelligent Robots and Systems, pp 328-333
  13. Newman, P.M. (1999). On the Structure and Solution for Simultaneous Localisation and Mapping Problem, PhD Thesis, The University of Sydney
  14. Ruiz, I. Raucourt, S. Petillot, Y. and Lane, D. (2004). "Concurrent Mapping and Localization Using Side Scan Sonar", IEEE J. Oceanic Eng., Vol 29, No 2, pp 442-456 https://doi.org/10.1109/JOE.2004.829790
  15. Simon, D. and Chia, T.L. (2002). "Kalman Filtering with State Equality Contraints", IEEE Transactions on Aerospace and Electronic Systems, Vol 38, pp 128-136
  16. Smith, R., Self, M. and Cheeseman, P. (1990). Estimating Uncertain Spatial Relationship, in I. Cox and G. Wilfong, Editors, Autonomous Robot Vehicles, Spring-Verlag
  17. Wehlch, G. and Bishop, G. (2006). An Introduction to the Kalman Filter, TR 95-041, Dept. of Computer Science, University of North Carolina
  18. Wen, W. and Durrant-Whyte, H. (1991). “Model Based Active Objects Localisation Using Multiple Sensors“, Intelligent Systems and Robotics, Vol 3, pp 1448-1452
  19. Williams, S.B. Dissanayake, G. and Durrant-Whyte, H. (2002). "An Efficient Approach to the Simultaneous Localization and Mapping Problem", Proc. IEEE Int. Conf. Robotics and Automation, pp 406-411