Observability Analysis of a Matrix Kalman Filter-Based Navigation System Using Visual/Inertial/Magnetic Sensors

A matrix Kalman filter (MKF) has been implemented for an integrated navigation system using visual/inertial/magnetic sensors. The MKF rearranges the original nonlinear process model in a pseudo-linear process model. We employ the observability rank criterion based on Lie derivatives to verify the conditions under which the nonlinear system is observable. It has been proved that such observability conditions are: (a) at least one degree of rotational freedom is excited, and (b) at least two linearly independent horizontal lines and one vertical line are observed. Experimental results have validated the correctness of these observability conditions.

[1]  S. Sastry.  Nonlinear Systems: Analysis, Stability, and Control , 1999 .

[2]  P. Veltink,et al.  Compensation of magnetic disturbances improves inertial and magnetic sensing of human body segment orientation , 2005, IEEE Transactions on Neural Systems and Rehabilitation Engineering.

[3]  D. Titterton,et al.  Strapdown inertial navigation technology - 2nd edition - [Book review] , 2005, IEEE Aerospace and Electronic Systems Magazine.

[4]  Itzhack Y. Bar-Itzhack,et al.  Recursive Attitude Determination from Vector Observations: Direction Cosine Matrix Identification , 1984 .

[5]  John Weston,et al.  Strapdown Inertial Navigation Technology, Second Edition , 2005 .

[6]  Angelo M. Sabatini,et al.  Kalman-Filter-Based Orientation Determination Using Inertial/Magnetic Sensors: Observability Analysis and Performance Evaluation , 2011, Sensors.

[7]  Richard Bellman,et al.  Introduction to Matrix Analysis , 1972 .

[8]  Marco Parvis,et al.  Procedure for effortless in-field calibration of three-axial rate gyro and accelerometers , 1995 .

[9]  Peter Corke,et al.  An Introduction to Inertial and Visual Sensing , 2007, Int. J. Robotics Res..

[10]  Itzhack Bar-itzhack,et al.  On the Convergence of Iterative Orthogonalization Processes , 1976, IEEE Transactions on Aerospace and Electronic Systems.

[11]  H. Weiss,et al.  Kalman filtering for matrix estimation , 2006, IEEE Transactions on Aerospace and Electronic Systems.

[12]  Peter I. Corke,et al.  Editorial: Special Issue: 2nd Workshop on Integration of Vision and Inertial Sensors , 2007, Int. J. Robotics Res..

[13]  Mongi A. Abidi,et al.  Pose and motion estimation using dual quaternion-based extended Kalman filtering , 1998, Electronic Imaging.

[14]  Agus Budiyono,et al.  Principles of GNSS, Inertial, and Multi-sensor Integrated Navigation Systems , 2012 .

[15]  Angelo M. Sabatini,et al.  Estimating Three-Dimensional Orientation of Human Body Parts by Inertial/Magnetic Sensing , 2011, Sensors.

[16]  A. Krener,et al.  Nonlinear controllability and observability , 1977 .

[17]  John Oliensis.  A new structure-from-motion ambiguity , 1999, Proceedings. 1999 IEEE Computer Society Conference on Computer Vision and Pattern Recognition (Cat. No PR00149).

[18]  Mongi A. Abidi,et al.  Pose and motion estimation from vision using dual quaternion-based extended kalman filtering , 1997 .

[19]  H. Weiss,et al.  Direction Cosine Matrix Estimation from Vector Observations using a Matrix Kalman Filter , 2010, IEEE Transactions on Aerospace and Electronic Systems.

[20]  Zdzislaw Bubnicki,et al.  Modern Control Theory , 2005 .

[21]  John Weston,et al.  Strapdown Inertial Navigation Technology , 1997 .