Vehicle-mounted navigation calculating method based on cascade adaptive robust federal filtering

Abstract

The invention provides a vehicle-mounted navigation calculating method based on cascade adaptive robust federal filtering, and belongs to the technical field of vehicle-mounted navigation. The vehicle-mounted navigation calculating method comprises the steps: a navigation calculating equation and an error model are built; a three-stage weight reduction function is constructed by adopting the residual error as the statistical magnitude, and measuring noise containing a measuring abnormal value is reduced through the weight reduction factor; through a cascade mode, when the measuring noise R isstable, a system noise estimator is constructed through an improved adaptive filter, prior information Q is estimated in real time, and the optimal estimated values of the initial states of subsystemsare obtained; and the optimal estimated values of the two navigation subsystems are subjected to global convergence according to an information distribution principle, the final optimal estimated value is obtained, then the feedback process is conducted, and the steps from one to four are repeated. The problems that in a vehicle-mounted navigation system combined with a plurality of sensors, prior information of the system is uncertain, and the measuring value is abnormal, so that filtering is divergent and even loses efficacy are solved, the global optimal value is obtained, and thus the more accurate navigation parametric solution with better robustness is obtained.

Description

technical field [0001] The invention belongs to the technical field of vehicle navigation, and in particular relates to a calculation method for vehicle navigation based on cascade adaptive robust federated filtering. Background technique [0002] The combination of strapdown inertial navigation system (SINS), global positioning system (GPS) and vehicle odometer (Odometer) not only makes up for each other's disadvantages, but also makes full use of its own advantages, which can provide relatively accurate and comprehensive navigation parameters: Attitude, speed, and position information are therefore widely used in vehicle carriers in various fields, and have become a commonly used vehicle navigation method at present. However, as the environment becomes more and more complex, the traditional vehicle navigation method based on the combination of SINS / GPS / OD federation is susceptible to the influence of abnormal measurement values ​​and uncertain system prior information, and...

AI Technical Summary

Problems solved by technology

[0004] The purpose of the present invention is to provide a cascaded adaptive robust federated filter-based vehicle navigation calculation method, which overcomes the filtering divergence and even the In order to solve the failure problem, obtain the global optimal value, so as to obtain a more accurate and robust navigation parameter solution

Images