Implementation of an Algorithm for the Estimation of Range and Direction of an Underwater Vehicle Using MFSK Signals

MFSK를 이용한 잠수정의 거리 및 방향 예측알고리즘 구현

KRISO/KORDI is currently developing a deep-sea unmanned underwater vehicle (UUV) system which is composed of a launcher, an ROV, and an AUV. Two USBL acoustic positioning systems will be used for UUV's navigation. One is for the deep sea positioning of all three vehicles and the other is for AUV's guidance to the docking device on the launcher. In order to increase the position accuracy MFSK(Multiple Frequency Shift Keying) broadband signal will be used. As the first step to the implementation of a USBL system, this paper studies USBL positioning algorithm using MFSK signals. Firstly, the characteristics of MFSK signal is described with various MFSK parameters: number of frequencies, frequency step, center frequency, and pulse length. Time and phase delays between two received signals are estimated by using cross-correlation and cross-spectrum methods. Finally an USBL positioning algorithm is derived by converting the delays to difference of distances and applying trigonometry. The simulation results show that the position accuracy is improved highly when both cross-correlation and cross-spectrum of MFSK signals are used simultaneously.