두개의 초음파 거리계를 이용한 관성센서 기반의 의사 장기선(Pseudo-LBL) 복합항법 알고리듬

Abstract

This paper presents an integrated underwater navigational algorithm for unmanned underwater vehicles, using additional two-range transducers. This paper proposes a measurement model, using two range measurements, to improve the performance of an IMU-DVL (inertial measurement unit - Doppler velocity log) navigation system for long-time operation of underwater vehicles, excluding DVL measurement. Extended Kalman filter was adopted to propagate the error covariance, to update the measurement errors, and to correct the state equation when the external measurements are available. Simulation was conducted with the 6-d.o.f. nonlinear numerical model of an AUV in lawn-mowing survey mode,at current flow, where the velocity information is unavailable. Simulations illustrate the effectiveness of the integrated navigation system,assisted by the additional range measurements without DVL sensing.