DOI QR코드

DOI QR Code

Velocity Aided Navigation Algorithm to Estimate Current Velocity Error

해조류 속도 오차 추정을 통한 속도보정항법 알고리즘

  • Choi, Yun-Hyuk (The 3rd Research and Development Institute, Agency for Defense Development)
  • 최윤혁 (국방과학연구소 제3기술연구본부)
  • Received : 2019.06.04
  • Accepted : 2019.06.25
  • Published : 2019.06.30

Abstract

Inertial navigation system has navigation errors because of the error of inertial measurement unit (IMU) and misalignment over time. In order to solve this problem, aided navigation system is performed using global navigation satellite system (GNSS), speedometer, etc. The inertial navigation system equipped with underwater vehicle mainly uses speedometer and performed aided navigation because satellite signals do not pass through underwater. There are DVL, EM-Log, and RPM in the speedometer, and the sensors are applied according to the system environment. This paper describes velocity aided navigation using RPM of inertial navigation system operating in high speed and deep water environment. In addition, we proposes an algorithm to compensate the limit of RPM with straight direction and the current velocity error. There are results of monte-calo simulation to prove performance of the proposed algorithm.

관성항법장치는 시간 경과에 따라 관성센서 및 초기정렬 오차로 인해 항법 오차가 발생한다. 이를 보상하기 위한 방법으로 위성항법시스템 및 속도계 등을 이용하여 보정항법을 수행한다. 수중 환경에서는 GNSS 신호가 통하지 않기 때문에, 수중운동체에 탑재한 관성항법장치는 주로 속도계 보조센서를 이용하여 보정항법을 수행한다. 속도계 보조센서는 DVL, EM-Log, RPM이 있으며, 시스템 환경에 따라서 센서 종류가 적용된다. 본 논문은 고속 및 심해 환경에서 운용되는 관성항법장치의 RPM 속도보정항법을 설계하였다. 또한 직진 방향의 성분을 갖는 RPM 속도계의 한계를 보완하며, 해조류 속도 오차를 보상하는 알고리즘을 제안하였다. 제안한 알고리즘은 몬테카를로 시뮬레이션 결과를 통해 성능을 입증하였다.

Keywords

References

  1. D. H. Titterton and J. L. Weston, Strapdown Inertial Navigation Technology, London, UK: Peter Peregrinus Ltd, 1997.
  2. O. S. Salychev, Applied Inertial Navigation: Problems and Solutions, Moscow, Russia: BMSTU Press, 2004.
  3. C. B. Jeon and J. Lyou, “Measurement of error estimation for velocity-aided SDINS using separate-bias kalman filter,” Jounal of Control, Automation and System Engineering, Vol. 4, No. 1, pp. 56-61, Feb. 1998.
  4. T. S. Yoo and S. I. Yoon, “DVL-RPM base velocity filter design for a performance improvement underwater integrated navigation system,” Jounal of Institute of Control, Robotics and Systems, Vol. 19, No. 9, pp. 774-781, June 2013. https://doi.org/10.5302/J.ICROS.2013.13.9022
  5. Y. H. Lee, W. S. Ra, K. H. Kim, M. H. Ahn and B. J. Lee, " Gertler-Hagen hydrodynamic model based velocity estimation filter for long-term underwater navigation without external position fix", The Transactions of The Korean Institute of Electrical Engineers. Vol. 65, No. 11, pp. 1868-1878, Nov. 2016. https://doi.org/10.5370/KIEE.2016.65.11.1868
  6. A. Gelb, Applied Optimal Estimation, Cambridge, US: M.I.T. Press, 1974.