Underwater Hybrid Navigation Algorithm Based on an Inertial Sensor and a Doppler Velocity Log Using an Indirect Feedback Kalman Filter

간접 되먹임 필터를 이용한 관성센서 및 초음파 속도센서 기반의 수중 복합항법 알고리듬

  • 이종무 (한국해양연구원 해양시스템안전연구소) ;
  • 이판묵 (한국해양연구원 해양시스템안전연구소) ;
  • 성우제 (서울대학교 조선해양공학과)
  • Published : 2003.12.01

Abstract

This paper presents an underwater hybrid navigation system for a semi-autonomous underwater vehicle (SAUV). The navigation system consists of an inertial measurement unit (IMU), and a Doppler velocity log (DVL), accompanied by a magnetic compass. The errors of inertial measurement units increase with time, due to the bias errors of gyros and accelerometers. A navigational system model is derived, to include the scale effect and bias errors of the DVL, of which the state equation composed of the navigation states and sensor parameters is 20. The conventional extended Kalman filter was used to propagate the error covariance, update the measurement errors, and correct the state equation when the measurements are available. Simulation was performed with the 6-d.o,f equations of motion of SAUV, using a lawn-mowing survey mode. The hybrid underwater navigation system shows good tracking performance, by updating the error covariance and correcting the system's states with the measurement errors from a DVL, a magnetic compass, and a depth sensor. The error of the estimated position still slowly drifts in the horizontal plane, about 3.5m for 500 seconds, which could be eliminated with the help of additional USBL information.

Keywords

References

  1. 한국해양공학회지 v.17 no.4 반자율 무인잠수정의 수중 복합 항법 시스템 성능평가를 위한 회전팔 시험 이종무;이판묵;김서군;홍석원;서재원;성우제
  2. 한국해양연구원 연구보고서 반자율무인잠수정의 운헝제어 및 매니퓰레이터 기술 개발 홍석원;이판묵;이종무(외)
  3. 제어자동화시스템공학회논문집 v.8 no.6 초기 기수각 정보가 필요?는 SDINS의 운항중 정렬 홍현수;이장규;박찬국
  4. Proc. of Ocean 97 Conference v.1 Asynchronous Data Fusion for AUV Navigation via Heuristic Fuzzy Filtering Techniques An,P.E.;Healey,A.J.;Park,J.;Smith,S.M.
  5. proceedings of AUV '96 New Experimental Results on GPS/INS Navigation for Ocean Voyager Ⅱ AUV An,P.E.;Healey,A.J.;Smith,S.M.;Dunn,S.E.
  6. Position Location and Navigation Symposium Precision Hybrid Navigation System for Varied Marine Applications Beiter,S.;Poquette,R.;Filipo,B.S.;Goetz,W.
  7. Applied optimal estimation Gelb,A.
  8. 1st IFAC Workshop on Guidance and Control of Underwater Vehicle Preliminary Field Experience with the DVLNAV Integrated Navigation System for Manned and Unmanned, Submersibles Kinesy,J.C.;Whitcomb,L.L.
  9. Proc of Oceans 2000 Conference(2000a) v.3 Synthetic Long Baseline Navigation of Underwater Vehicles Larsen,M.B.
  10. Oceans 2000 Conference(2000b) v.2 High Performance Dopple Inertial Navigation - Experimental Results Larsen,M.B.
  11. IEEE J of Oceanic Engineering v.26 no.4 Command, Control, and Navigation Experimental Results with the NPS ARIES AUV Marco,D.B.;Healey,A.J.
  12. Underwate Acoustic Positioning Systems Milne,P.H.
  13. Strapdown Inertial Navigation Technology Titterton,D.H.;Weston,J.L.
  14. Proceedings of AUV '98 The Doppler Inertial Acoustic System for Littoral Navigation (DIAS) Trimble,G.M.
  15. Oceans '97 Conference v.1 The Navigation System of an Autonomous Underwater Vehicle for Antarctic Exploration Uliana,M.;Andreucci,F.;Papalia,B.
  16. IEEE J of Oceanic Engineering v.24 no.3 Testing and Evaluation of an Integrated GPS/INS System for Small AUV Navigation Yun,X.;Bachmann,E.R.;McGhee,R.B.;Whalen,R.H.;roberts,R.L.;knapp,R.G.;Healey,a.J.;Zyda,M.J.