The Kalman filter implementation for SDINS alignment using the E.M.Log

E.M.Log를 이용한 스트랩다운 관성항법장치의 초기정렬을 위한 칼만필터 구현

In an underwater vehicle, the navigation error is mostly caused by the initial misalignment, the bias of a gyro and an accelerometer, and the sea current. Therefore, it is important that these error sources are estimated and compensated in order to reduce the navigation error. In this paper, the E.M.Log aided SDINS is designed by using the E.M.Log which measures the forward velocity of a vehicle. And the system error state equation and the measurement equation are derived and the suboptimal Kalman Filter is established for this aided SDINS. The simulation result showed that this had an important role in estimating and compensating these error sources, thus reducing the navigation error of an underwater vehicle.