DOI QR코드

DOI QR Code

확장칼만필터를 이용한 호버링타입 무인잠수정의 위치추정알고리즘 개발

Development of the Localization Algorithm for a Hovering-type Autonomous Underwater Vehicle using Extended Kalman Filter

  • 강현석 (한국해양대학교-한국해양과학기술원 해양과학기술전문대학원 해양과학기술융합학과) ;
  • 홍승민 (한국해양대학교-한국해양과학기술원 해양과학기술전문대학원 해양과학기술융합학과) ;
  • 서주노 (한국해양대학교 산업기술연구소) ;
  • 김동희 (한화시스템 해양연구소) ;
  • 정재훈 (한국해양대학교 기계공학부) ;
  • 정성훈 (한국해양대학교 산업기술연구소) ;
  • 최형식 (한국해양대학교 기계공학부) ;
  • 김준영 (한국해양대학교 기계공학부)
  • Kang, Hyeon-seok (Department of Convergence Study on the Ocean Science and Technology, Ocean Science and Technology School, Korea Maritime and Ocean University-Korea Institute of Ocean Science and Technology) ;
  • Hong, Sung-min (Department of Convergence Study on the Ocean Science and Technology, Ocean Science and Technology School, Korea Maritime and Ocean University-Korea Institute of Ocean Science and Technology) ;
  • Sur, Joo-no (Research Institute of Industrial Technology, Korea Maritime and Ocean University) ;
  • Kim, Dong-hee (Naval R&D Center, Hanwha Systems) ;
  • Jeong, Jae-hun (Department of Mechanical Engineering, Korea Maritime and Ocean University) ;
  • Jeong, Seong-hoon (Research Institute of Industrial Technology, Korea Maritime and Ocean University) ;
  • Choi, Hyeung-sik (Department of Mechanical Engineering, Korea Maritime and Ocean University) ;
  • Kim, Joon-young (Department of Mechanical Engineering, Korea Maritime and Ocean University)
  • 투고 : 2017.03.27
  • 심사 : 2017.04.24
  • 발행 : 2017.04.30

초록

본 논문에서는 위성항법장치 (GPS; global positioning system)를 보조센서로 사용하는 위치추정알고리즘의 성능을 검증하기 위해 호버링타입 무인잠수정에 알고리즘을 적용하여 실제 해역에서 실험을 수행하였다. 적용된 알고리즘은 무인잠수정에 탑재된 도플러 속도계 (DVL; doppler velocity logger), TCM (tilt-compensated compass module)을 이용한 추측항법의 시간에 따라 누적되는 위치오차를 개선하기 위한 알고리즘이다. 수면에서 GPS 위치정보를 수신하여 무인잠수정의 위치와 진북에 대한 TCM의 방향각 바이어스 오차를 추정하고, 이를 통해 진북 (geodetic north) 기준의 좌표계에 대한 추측항법을 수행한다. 실제 해역에서 방향각 제어 실험을 수행한 결과, 위치추정알고리즘을 통해 기존 추측항법의 위치오차가 개선되고 TCM의 방향각 바이어스 오차를 추정함을 확인하였다.

In this paper, in order to verify the performance of a localization algorithm using GPS as an auxiliary sensor, the algorithm was applied to a hovering-type autonomous underwater vehicle (AUV) to perform a field test. The applied algorithm is an algorithm to improve the accumulated positional error of dead reckoning using doppler velocity logger(DVL) and tilt-compensated compass module (TCM) mounted on the AUV. GPS when surfaced helps the algorithm to estimate the position and the heading bias error of TCM for geodetic north, which makes it possible to perform dead reckoning on north-east-down (NED) coordinates. As a result of field test performing heading control, it was judged that the algorithm could improve the positional error, enhance the operational capability of AUV and contribute to the research of underwater navigation depending on a magnetic compass.

키워드

참고문헌

  1. D. Thompson, D. Caress, C. Paull, D. Clague, H. Thomas and D. Conlin, "MBARI mapping AUV operations: In the Gulf of California", in OCEANS'12 MTS/IEEE, Virginia: VA, pp. 1-5, Oct. 2012.
  2. D. Thompson, D. Caress, H. Thomas and D. Conlin, "MBARI mapping AUV operations in the gulf of California 2015", in OCEANS'15 MTS/IEEE, Washington: WA, pp. 1-7, Oct. 2015.
  3. T. Brown, J. Damiano, S. Jhala, R. Moore, B. Morgan, V. Nguyen, T. Opheim, T. Ringwald, W. Roman, and J. Turk, "Next generation mine countermeasures for the very shallow water zone in support of amphibious operations", Naval Postgraduate School, Monterey, California: CA, No. NPS-SE-12-001, pp. 1-401, Mar. 2012.
  4. T. I. Fossen, Handbook of Marine Craft Hydro-dynamics and Motion Control, Chichester, United Kingdom: A John Wiley & Sons, 2011.
  5. C. W. Nam and S. S. Lim, "Position-fix improvement of integrated GPS and DR system using two-level noise model", Journal of Advanced Navigation Technology, Vol. 2, No. 2, pp. 75-83, Dec. 1998.
  6. S. C. Park, S. B. Chun, J. W. Kim and M. B. Heo, "Development of monitoring program based an automotive GPS/DR integrated navigation system for lane departure warning", Journal of Advanced Navigation Technology, Vol. 14, No. 6, pp. 791-799, Dec. 2010.
  7. Y. S. Park, D. H. Lee, W. S. Choi and J. M. Lee, "Sea-surface localization of AUV using extended Kalman filter for INS/GPS", in Conference of Institute of Control, Robotics and Systems, Daejeon: Korea, pp. 97-98, May. 2015.
  8. The society of naval architects and marine engineers (SNAME), Nomenclature for Treating the Motion of a Submerged Body Through a Fluid, New York, Technical and Research Bulletin, No. 1-5, 1950.
  9. H. S. Kang, S. M. Hong, J. N. Sur and J. Y. Kim, "Design of GPS-aided dead reckoning algorithm of AUV using extended kalman filter", Journal of Ocean Engineering and Technology, Vol. 31, No. 1, pp. 28-35, Feb. 2017. https://doi.org/10.5574/KSOE.2017.31.1.028
  10. S. M. Hong, Y. J. Lee, D. H. Choi, H. S. Choi and J. Y. Kim, "Development of hovering type AUV 'Octagon' and test of dynamic motion", in Proceedings of the Korean Society of Mechanical Engineers Spring Annual Meeting, Busan: Korea, pp. 176-178, May. 2014.
  11. D. H. Choi, Y. J. Lee, S. M. Hong and J. Y. Kim, "Development of hovering-type AUV test-bed 'OCTAGON' ", Journal of the Korean Society of Marine Engineering, Vol. 40, No. 6, pp. 516-526, Jul. 2016. https://doi.org/10.5916/jkosme.2016.40.6.516
  12. National Centers for Environmental Information (NCEI) of National Oceanic and Atmospheric Administration (NOAA). Magnetic field calculators [internet]. Available: https://www.ngdc.noaa.gov/geomag-web/#declination