摘要
The initial alignment error equation of an INS (Inertial Navigation System) with large initial azimuth error has been derived and nonlinear characteristics are included. When azimuth error is fairly small, the nonlinear equation can be reduced to a linear one. Extended Kalman filter, iterated filter and second order filter formulas are derived for the nonlinear state equation with linear measurement equation. Simulations results show that the accuracy of azimuth error estimation using extended Kalman filter is better than that of using standard Kalman filter while the iterated filter and second order filter can give even better estimation accuracy.
The initial alignment error equation of an INS (Inertial Navigation System) with large initial azimuth error has been derived and nonlinear characteristics are included. When azimuth error is fairly small, the nonlinear equation can be reduced to a linear one. Extended Kalman filter, iterated filter and second order filter formulas are derived for the nonlinear state equation with linear measurement equation. Simulations results show that the accuracy of azimuth error estimation using extended Kalman filter is better than that of using standard Kalman filter while the iterated filter and second order filter can give even better estimation accuracy.