Pseudo long base line navigation algorithm for underwater vehicles with inertial sensors and two acoustic range measurements

摘要

This paper presents an integrated navigational algorithm for unmanned underwater vehicles (UUV) using two acoustic range transducers and strap-down inertial measurement unit (SD-IMU). A range measurement model is derived for a UUV having one acoustic transducer and cruising around two reference transponders at sea floor or surface. The proposed algorithm, called pseudo long base line (PLBL), estimates the position of the vehicle integrating the SD-IMU signals corrected with the two range measurements. Extended Kalman filter was applied to propagate error covariance, to update measurement errors and to correct state equation whenever the external measurements are available. Simulations were conducted to illustrate the effectiveness of the PLBL using the 6-d.o.f. nonlinear numerical model of a UUV at current flow, excluding bottom-fixed DVL. This paper also shows the error convergence of the vehicle's initial position by the additional range measurements without velocity information.