SINS/CNS/GPS integrated navigation algorithm based on UKF

A new nonlinear algorithm is proposed for strapdown inertial navigation system (SINS)/celestial navigation system (CNS)/global positioning system (GPS) integrated navigation systems. The algorithm employs a nonlinear system error model which can be modified by unscented Kalman filter (UKF) to give predictions of local filters. And these predictions can be fused by the federated Kalman filter. In the system error model, the rotation vector is introduced to denote vehicle’s attitude and has less variables than the quaternion. Also, the UKF method is simplified to estimate the system error model, which can both lead to less calculation and reduce algorithm implement time. In the information fusion section, a modified federated Kalman filter is proposed to solve the singular covariance problem. Specifically, the new algorithm is applied to maneuvering vehicles, and simulation results show that this algorithm is more accurate than the linear integrated navigation algorithm.

[1]  Simon J. Julier,et al.  The scaled unscented transformation , 2002, Proceedings of the 2002 American Control Conference (IEEE Cat. No.CH37301).

[2]  Simon J. Julier,et al.  The spherical simplex unscented transformation , 2003, Proceedings of the 2003 American Control Conference, 2003..

[3]  K. P. Schwarz,et al.  Testing a decentralized filter for GPS/INS integration , 1990, IEEE Symposium on Position Location and Navigation. A Decade of Excellence in the Navigation Sciences.

[4]  S. Julier,et al.  A General Method for Approximating Nonlinear Transformations of Probability Distributions , 1996 .

[5]  Jeffrey K. Uhlmann,et al.  Reduced sigma point filters for the propagation of means and covariances through nonlinear transformations , 2002, Proceedings of the 2002 American Control Conference (IEEE Cat. No.CH37301).

[6]  N. A. Carlson,et al.  Federated filter for fault-tolerant integrated navigation systems , 1988, IEEE PLANS '88.,Position Location and Navigation Symposium, Record. 'Navigation into the 21st Century'..

[7]  Myeong-Jong Yu,et al.  Equivalent nonlinear error models of strapdown inertial navigation system , 1997 .

[8]  R. E. Kalman,et al.  New Results in Linear Filtering and Prediction Theory , 1961 .

[9]  N. A. Carlson.  Federated square root filter for decentralized parallel processors , 1990 .

[10]  Fang Jiancheng,et al.  Hybrid simulation system study of SINS/CNS integrated navigation , 2008, IEEE Aerospace and Electronic Systems Magazine.

[11]  T. Başar,et al.  A New Approach to Linear Filtering and Prediction Problems , 2001 .

[12]  Jeffrey K. Uhlmann,et al.  A consistent, debiased method for converting between polar and Cartesian coordinate systems , 1997 .