Underwater Hybrid Navigation System Based on an Inertial Sensor and a Doppler Velocity Log Using Indirect Feedback Kalman Filter

간접 되먹임 필터를 이용한 관성센서 및 초음파 속도센서 기반의 수중 복합항법 시스템

This paper presents an underwater hybrid navigation system for a semi-autonomous underwater vehicle (SAUV). The navigation system consists of an inertial measurement unit (IMU), an ultra-short baseline (USBL) acoustic navigation sensor and a doppler velocity log (DVL) accompanying a magnetic compass. The errors of inertial measurement units increase with time due to the bias errors of gyros and accelerometers. A navigational system model is derived to include the error model of the USBL acoustic navigation sensor and the scale effect and bias errors of the DVL, of which the state equation composed of the navigation states and sensor parameters is 25 in the order. The conventional extended Kalman filter was used to propagate the error covariance, update the measurement errors and correct the state equation when the measurements are available. Simulation was performed with the 6-d.o.f. equations of motion of SAUV in a lawn-mowing survey mode. The hybrid underwater navigation system shows good tracking performance by updating the error covariance and correcting the system's states with the measurement errors from a DVL, a magnetic compass and a depth senor. The error of the estimated position still slowly drifts in horizontal plane about 3.5m for 500 seconds, which could be eliminated with the help of additional USBL information.