Strap-down inertial navigation system large azimuth misalignment angle initial alignment method based on MRUPF (Multi-resolution Unscented Particle Filter)

Abstract

The invention relates to a strap-down inertial navigation system large azimuth misalignment angle initial alignment method based on MRUPF (Multi-resolution Unscented Particle Filter), comprising the following steps of: firstly, establishing a state space model for the initial alignment of a strap-down inertial navigation system static substrate under the large azimuth misalignment angle condition to carry out filtering initialization; then carrying out the state estimation of the initial alignment by utilizing a UPF filtering algorithm; selecting particles and particle weights by utilizing a multi-resolution method at a moment to reduce the number of the particles; and continuing to carry out the state estimation of the initial alignment by utilizing the UPF filtering method by taking the selected particle set and the particle weights as initial particle sets and the weights to obtain a misalignment angle estimated value. In the invention, the UPF particle number is reduced through the multi-resolution method, thereby reducing the calculated amount, and the real-time performance of the initial alignment of the strap-down inertial navigation system under a large azimuth misalignment angle is improved while the initial alignment accuracy is ensured. The invention is suitable for the initial alignment of the strap-down inertial navigation system.

Description

technical field [0001] The present invention relates to an initial alignment method for large azimuth misalignment angles of a strapdown inertial navigation system based on MRUPF (Multiresolution Unscented Particle Filter, multiresolution Unscented particle filter), which is applicable to the case of large azimuth misalignment angles where the error model is nonlinear, Initial alignment of strapdown inertial navigation on stationary base under non-Gaussian noise conditions. Background technique [0002] The Strap-down Inertial Navigation System (SINS) uses inertial devices and initial parameters to determine all motion parameters such as the position, velocity, and attitude of the carrier. It does not rely on any external information and does not radiate outward when it works. Energy, is a fully autonomous navigation system. For the strapdown inertial navigation system, since the attitude matrix acts as a "digital platform", it is necessary to obtain the initial value of th...

AI Technical Summary

Problems solved by technology

[0005] The problem solved by the technology of the present invention is: for the large azimuth misalignment angle, the initial alignment of the static base of the strapdown inertial navigation system under the condition of non-Gaussian noise uses the existing filtering method to calculate a large amount of calculation, resulting in long initial alignment time and poor real-time performance. , the MRUPF nonlinear filtering method is used to carry out the initial alignment of the strapdown inertial navigation under a large azimuth misalignment angle, which improves the real-time performance of the initial alignment while ensuring the accuracy of the initial alignment

Images