Abstract:In this paper, a federated filtering algorithm of heading angle based on Magnetometer (short for Mag)/GPS/IMU integrated navigation system has been designed. First of all, the advantage of Mag/GPS/IMU integrated navigation system and the main research contents of this paper have been introduced. Then the basic knowledge of federated filter has been introduced. At the third part, the algorithm of magnetic heading angle and the algorithm of combined heading angle of GPS/IMU integrated navigation system have been introduced. At the next part, EKF (Extended Kalman Filter) algorithm of Mag/GPS/IMU integrated navigation system has been presented to the reader in the forth part. Then federated filtering algorithm of Mag/GPS/IMU integrated navigation system has been introduced in the fifth part. The final part is to sum up the entire article. The paper focused on the subsystems of magnetometer navigation system and the subsystem of GPS, with IMU as the reference system. The federated filter consists of two sub-filters and the main filter. One sub-filter is the filter for magnetometer/IMU. In this sub-filter, the observed value is the heading angle difference between Mag and IMU. We can get the first state estimation matrix and its covariance matrix from the first sub-filter by EKF. The other sub-filter is the GPS/IMU filter. In this filter, the observed value is the heading angle difference between GPS and IMU. We can also get the second state estimation matrix and its covariance matrix from the second sub-filter by EKF. Then the time is updated and the output of sub-filters is integrated by the main filter. The globally optimal estimation of the heading angle of Mag/GPS/IMU integrated navigation system can be got by the main filter, and then feed back to the sub-filters according to the principle of information allocation. In this research, a vehicle experiment has been done. The experimental equipment is TPIM-10 got from Trusted Positioning Inc., Canada. This equipment is a kind of medium accuracy integrated navigation system. The calculating result of vehicle experiment data and the comparison of several algorithms show that the federated filtering algorithm is better than others. The accuracy of heading angle increased from 0.5932 deg of only Mag/GPS system to 0.1682 deg, while the algorithm can inhibit IMU error accumulation effectively. The fault tolerance and stability of federated filtering algorithm have been showed in this paper. Mag/GPS/IMU integrated navigation system is not only suitable for high and low dynamic, but also for static state. Moreover, the data processing by federated filtering algorithm can significantly improve the performance of the navigation system.

Federated Filtering Algorithm of Heading Angle Based on Magnetometer/GPS/IMU Integrated Navigation System

Research on Dynamic Heading Calculation of Complex Magnetic Disturbance

A Dual-Linear Kalman Filter for Real-Time Orientation Determination System Using Low-Cost MEMS Sensors

Federated unscented particle filtering algorithm for SINS/CNS/GPS system

Attitude and heading measurement based on adaptive complementary Kalman filter for PS/MIMU integrated system.

Improving Vehicle Heading Angle Accuracy Based on Dual-Antenna GNSS/INS/Barometer Integration Using Adaptive Kalman Filter

An information fusion algorithm for integrated autonomous orbit determination of navigation satellites

Enhanced Vehicle Heading Estimation for Magnetometer/Gyroscope Integration With Random Magnetic Interference Detection Based on Pearson Correlation Coefficient

A novel algorithm for SINS/CNS/GPS integrated navigation system

An Adaptive Federated Filter Based on Variational Bayes with Application to Multisource Navigation

Polarized Skylight/mimu/geomagnetic Orientation Algorithm Based on Adaptive Kalman Filter

Integrated navigation accuracy improvement algorithm based on multi-sensor fusion

A Filter Algorithm for GPS/INS Integrated Navigation System Based on IMM-AF.

Design of NGMIMU/GPS integrated navigation system based on self-adaptive Kalman-filtering

An adaptive cascaded Kalman filter for two-antenna GPS/MEMS-IMU integration

Adaptive weighted federated Kalman filtering based on Mahalanobis distance and its application in navigation

Federated Filter With Strengthened Fdir Capability For Multiple Sensor Navigation System

Mutual-Aided INS/Vision Navigation System Analysis and Optimization Using Sequential Filtering with State Recalculation

An Integrated Navigation System of NGIMU/ GPS Using a Fuzzy Logic Adaptive Kalman Filter.

Nonlinear Fault Tolerant Filtering Application Based on Magnetometer in Autonomous Navigation

Multi-rate strong tracking square-root cubature Kalman filter for MEMS-INS/GPS/polarization compass integrated navigation system