Integrated error calibrating method of SINS/DVL (strapdown inertial navigation system/doppler velocity sonar) combined navigation system

Abstract

The invention relates to an integrated error calibrating method of an SINS/DVL (strapdown inertial navigation system/doppler velocity sonar) combined navigation system. The integrated error calibrating method comprises the following steps: obtaining a first navigation distance component of a carrier relative to a DVL instrument coordinate system and a second navigation distance component of GPS (global position system) position information relative to a carrier system in real time; carrying out least square fit based on SVD (singular value decomposition) on the first navigation distance component and the second navigation distance component, so as to obtain an SINS/DVL integrated conversion matrix; judging whether the conversion matrix estimated in the step 2 meets the accuracy requirement, and if not, repeating the steps 1 and 2 until the fitting precision achieves the requirement of navigation. By adopting the on-line estimation method of the least-square installation deviation angle based on the SVD, provided by the invention, the installation deviation angle of the DVL/IMU (doppler velocity sonar/inertial measurement unit) is estimated by adopting a GPS track measurement and DVL sliding track fitting method; not only is the problem of poor conventional least square stability solved; meanwhile, the integrated error calibrating method is low in demand on the measurement accuracy of z GPS, easy in scheme implementation and strong in engineering practicability.

Description

technical field [0001] The invention relates to the field of navigation, in particular to an integrated error calibration method for a SINS / DVL combined navigation system. Background technique [0002] The positioning error of the inertial navigation system (INS) has the characteristics of accumulating over time. For ships and other vehicles that require long-term navigation, it is often supplemented with other navigation equipment for integrated navigation to improve the positioning accuracy of the navigation system. Doppler Log (DVL) has become an important auxiliary navigation device for INS because of its high speed measurement accuracy and no error accumulation over time. It has been widely used in the field of marine navigation, especially for radio signals that cannot be effectively transmitted. In the underwater environment, the INS / DVL integrated navigation system plays a pivotal role. According to the speed measurement principle of the Doppler log, the output spee...

AI Technical Summary

Problems solved by technology

[0003] At present, the method of least squares fitting or filtering estimation of the carrier speed information provided by high-precision GPS and the speed information output by DVL is commonly used to estimate the installation deviation angle. The scheme requires high speed measurement accuracy of GPS, and the implementation conditions are relatively harsh. , and the scheme is less stable due to the influence of measurement noise

Images