초록
This paper presents a hybrid underwater navigation system for unmanned underwater vehicles, using an additional range sonar, where the navigation system is based on inertial and Doppler velocity sensors. Conventional underwater navigation systems are generally based on an inertial measurement unit (IMU) and a Doppler velocity log (DVL), accompanying a magnetic compass and a depth sensor. Although the conventional navigation systems update the bias errors of inertial sensors and the scale effects of DVL, the estimated position slowly drifts as time passes. This paper proposes a measurement model that uses the range sonar to improve the performance of the IMU-DVL navigation system, for extended operation of underwater vehicles. The proposed navigation model includes the bias errors of IMU, the scale effects of VL, and the bias error of the range sonar. An 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. To illustrate the effectiveness of the hybrid navigation system, simulations were conducted with the 6-d.o.f. equations of motion of an AUV in lawn-mowing survey mode.