Development of an Extended Kalman Filter Algorithm for the Localization of Underwater Mining Vehicles

해저 집광차량의 위치 추정을 위한 확장 칼만 필터 알고리즘

  • 원문철 (충남대학교 메카트로닉스공학과) ;
  • 차혁상 (충남대학교 메카트로닉스공학과) ;
  • 홍섭 (한국해양연구원 해양시스템안전연구소 해양시스템연구본부)
  • Published : 2005.04.01

Abstract

This study deals with the development of the extended Kalman filter(EKF) algorithm for the localization of underwater mining vehicles. Both simulation and experimental studies in a test bed are carried out. For the experiments, a scale dawn tracked vehicle is run in a soil bin containing cohesive soil of bentonite-water mixture. To develop the EKF algorithm, we use a kinematic model including the inner/outer track slips and the slip angle for the vehicle. The measurements include the inner and outer wheel speeds from encoders, the heading angle from a compass sensor and a fiber optic rate gyro, and x and y coordinate position values from a vision system. The vision sensor replaces the LBL(Long Base Line) sonar system used in the real underwater positioning situations. Artificial noise signals mimicking the real LBL noise signal are added to the vision sensor information. To know the mean slip values of the tracks in both straight and cornering maneuver, several trial running experiments are executed before applying the EKF algorithm. Experimental results show the effectiveness of the EKF algorithm in rejecting the sensor measurements noise. Also, the simulation and experimental results show close correlations.

Keywords

References

  1. 최종수, 홍섭, 김형우 (2003). '직교행렬 실험계획법에 의한 해저 연약지반 선회성능실험 연구', 한국해양공학회 2003년도 추계학술대회 논문집
  2. Lee, A.T. (1999). Modelling and Control of Tracked Vehicles, Ph.D Thesis Department of Mechanical and Mechatronic Engineering, The University of Sydney
  3. Van Loan, C.F. (1978). 'Computing Integrals Involving the Matrix Exponential', IEEE Transactions on automatic control, vol. AC-23, NO.3
  4. Whitcomb, L.L, Yoerger, D.R. and Singh, H. (1999). 'Combined Doppler / LBL Based Navigation of Underwater Vehicles', 11th International Symposium on Untethered Submersile Technology (UUST99)
  5. Brown, R.G. and Hwang, P.Y.C. (1997). Introduction to Random Signals and Applied Kalman Filtering, 3rd Edition