USBL, DVL과 선수각 측정신호를 융합한 심해 무인잠수정의 항법시스템

Abstract

This paper presents an integrated navigation system that combines ultra-short baseline (USBL), Doppler velocity log (DVL), and heading measurements for a deep-sea remotely operated vehicle, Hemire. A navigation model is introduced based on the kinematic relation of the position and velocity. The system states are predicted using the navigation model and corrected with the USBL, DVL, and heading measurements using the Kalman filter. The performance of the navigation system was confirmed through re-navigation simulations with the measured data at the Southern Mariana Arc submarine volcanoes. Based on the characteristics of the measurements, the design process for the parameters of the system modeling error covariance, measurement error covariance, and initial error covariance are presented. This paper reviews the influence of the outliers and blackout of the USBL and DVL measurements, and proposes an outlier rejection algorithm that is robust to USBL blackout. The effectiveness of the method is demonstrated with re-navigation for the data that includes USBL blackouts.