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.

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

A MIMU/Polarized Camera/GNSS Integrated Navigation Algorithm for UAV Application

A Novel Polarized Skylight Navigation Model for Bionic Navigation with Marginalized Unscented Kalman Filter

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

A Bioinspired Navigation System for Multirotor UAV by Integrating Polarization Compass/Magnetometer/INS/GNSS.

A Bio-Inspired Navigation Strategy Fused Polarized Skylight And Starlight For Unmanned Aerial Vehicles

Auxiliary strategy of vehicle autonomous navigation model based on polarization of skylight

Bio-inspired Attitude Determination Method Based on Polarized Skylight and Ground Horizon

IMU-Based Automated Vehicle Body Sideslip Angle and Attitude Estimation Aided by GNSS Using Parallel Adaptive Kalman Filters

Integrated Polarized Skylight Sensor and MIMU with a Metric Map for Urban Ground Navigation

How to Get the Solar Direction from Skylight Polarization for Satellite Autonomous Navigation

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

Calibration and Image Processing Method for Polarized Skylight Sensor

A Novel Angle Computation and Calibration Algorithm of Bio-Inspired Sky-Light Polarization Navigation Sensor

Microsatellite Attitude Determination Based on Skylight Polarization and Geomagnetic Measurement

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

Polarized-Light/Geomagnetism/GPS/SINS Integrated Navigation

Filter algorithm applications in integrated navigation with nonholonomic constraints

A Bionic Polarization Navigation Sensor and Its Calibration Method

A Bioinspired Polarization Sensor/Sun Tracker/IMU Integrated System for Attitude Determination in GNSS-Challenged Environments

A Novel Tightly Coupled Attitude and Heading Measurement Method Based on Full-Sky Polarization Mode for Bionic Navigation System