A simplified Kalman filter for integrated navigation system with low-dynamic movement (Q1793002)

Summary: In the integrated navigation system with inertial base, the update frequency of Strapdown Inertial Navigation System (SINS) is always higher than those of aided navigation systems; thus updating inconsistency among subsystems becomes an issue. The analysis indicates that the state transition matrix in Kalman filter is essentially a function of carrier motion. Based on this understanding, a simplified Kalman filter algorithm for integrated navigation is designed for those carriers with low-dynamic motions. With this simplified algorithm, when the filter is without aided information updating, only calculation and accumulation on state transition matrix are executed, and when the filter is with updating, normal time and measurement update are done based on the averaged state transition matrix. Thus the calculation load in the simplified algorithm will be significantly lessened. Furthermore, due to cumulative sum and average operation, more accurate state transition matrix and higher fusion accuracy will arrive for the smoothing effect on random noise of carrier motion parameters. Simulation and test results indicate that when the carrier is with a low-dynamic motion, the simplified algorithm can complete the data fusion of integrated system effectively with reduced computation load and suppressed oscillation amplitude of state vector error.