Abstract:Considering the characteristic and computation superiority of quaternion representing body attitude movement information, and aiming at the initial alignment procedure of strap-down inertial navigation system (SINS) with large initial misalignment angles, this paper develops its multiplicative quaternion error model. With the faults analysis of traditional quaternion mean calculation methods, it developed its new calculation method in which the attitude matrix cost function was constructed to calculate its maximum eigenvalues, and it selected the eigenvector which correspond to the maximum eigenvalue as the predicted quaternion mean to guarantee its unit normalization and the sign invariability when the sign of calculating quaternion changed. The multiplicative quaternion error representing the distance between quaternion Sigma-points and the predicted mean quaternion calculated the quaternion prediction error variance matrix, and which can effectively overcome the application limits for SPKF algorithms in quaternion filtering implementation. Combined with the central divided difference filtering (CDKF) algorithm which belongs to SPKF algorithms, it proposed a new quaternion CDKF algorithm (QCDKF) for quaternion filtering problems. With large initial misalignment angles and based on QCDKF algorithm the SINS simulation experiments was being performed. The simulations results show that, compared with EKF algorithm, the proposed algorithm can significantly improve the filtering precision of both attitude misalignment angles estimation errors and velocity estimation errors and the numerical calculation stabilization of the filtering algorithm.

Quaternion-based Kalman Filter and Its Performance Analysis in Integrated Navigation

Quaternion-based Kalman Filtering on INS/GPS

Stirling's Interpolation Filtering and Extended Kalman Filtering for Orientation Estimation

Research on Attitude Estimation Algorithm Based on Kalman Filer

Study of Relative Navigation for Spacecraft Based on Central Difference Kalman Filter

Cubature Kalman Filter with Closed-Loop Covariance Feedback Control for Integrated INS/GNSS Navigation

Quaternion Central Divided Difference Kalman Filtering Algorithm and Its Applications to Initial Alignment of SINS

Clifford Algebra-Based Iterated Extended Kalman Filter with Application to Low-Cost INS/GNSS Navigation

An Adaptive Kalman Filtering Algorithm Based on Maximum-Likelihood Criterion

Novel Quaternion Kalman Filter for Gyro-less Attitude Determination

A Quaternion Unscented Kalman Filter for Road Grade Estimation.

A New Quaternion-Based Kalman Filter for Real-Time Attitude Estimation Using the Two-Step Geometrically-Intuitive Correction Algorithm

Kpca-Kalman Filtering For The Mems-Sins/Gps Integrated Navigation System

Attitude Estimation Fusing Quasi-Newton and Cubature Kalman Filtering for Inertial Navigation System Aided with Magnetic Sensors

Quaternion unscented Kalman filter and its application to initial alignment of SINS

CDKF Algorithm Applied to Quadrotor Integrated Navigation System

Kalman-filter-based Attitude and Parameters Estimation for Noncooperative Spacecraft

Quaternion-based Kalman filter for micro-machined strapdown attitude heading reference system

Quadratic Extended Kalman Filter Approach for Gps/Ins Integration

Quaternion Invariant Extended Kalman Filtering for Spacecraft Attitude Estimation

A novel Gaussian sum quaternion constrained cubature Kalman filter algorithm for GNSS/SINS integrated attitude determination and positioning system