Integrated navigation method based on navigation constraint

By calculating the relative heading of inertial navigation and GNSS in real time and performing Kalman filtering correction, the deviation and data synchronization of the dual-antenna heading and inertial navigation direction are solved, and the accuracy and reliability of combined navigation are improved.

CN118915109APending Publication Date: 2024-11-08CHANGSHA HAIGE BEIDOU INFORMATION TECH CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411221559.7
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-02
Publication Date
2024-11-08

AI Technical Summary

Technical Problem

In the existing vehicle-mounted combined navigation system, there is a fixed deviation between the dual-antenna heading and inertial navigation direction, and the inertial navigation data cannot be fully synchronized with the GNSS data, resulting in low accuracy of the combined heading.

Method used

By obtaining the effective heading data of inertial navigation and GNSS in real time, calculating its relative heading, and using it as the input of the Kalman filter, estimating the inertial navigation direction error is corrected to ensure data synchronization and accuracy.

Benefits of technology

It effectively reduces the error impact between inertial navigation and GNSS, improves the accuracy and reliability of combined navigation, and significantly improves heading accuracy.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118915109A_ABST
    Figure CN118915109A_ABST
Patent Text Reader

Abstract

The invention discloses an integrated navigation method based on navigation constraints. The integrated navigation method comprises the following steps: acquiring data information of an integrated navigation system in real time; recording a group of inertial navigation effective heading and GNSS effective heading at the same moment as a reference; when the next group of inertial navigation effective course and GNSS effective course at the same moment are monitored, subtracting the currently detected inertial navigation effective course and GNSS effective course from the reference to obtain the relative course of inertial navigation and the relative course of GNSS; taking the relative course of the inertial navigation and the relative course of the GNSS as measurement input of a Kalman filter, and calculating to obtain a course error of the inertial navigation at the current moment; according to the course error of the inertial navigation at the current moment, completing integrated navigation at the current moment, and taking the effective course of the inertial navigation at the current moment and the effective course of the GNSS as new references; the steps are repeated, and combined navigation based on navigation constraints is completed in real time. The method is higher in reliability and better in accuracy.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the field of navigation technology, and in particular relates to a combined navigation method based on navigation constraints. Background Art

[0002] With the development of economy and technology and the improvement of people's living standards, navigation technology has been widely used in people's production and life, bringing endless convenience to people's production and life. Therefore, ensuring the accuracy and reliability of the navigation process has become one of the most important tasks of the navigation system.

[0003] At present, in the commonly used vehicle-mounted integrated navigation (INS+GNSS) system, the heading of the inertial navigation system (INS system) and the heading of the GNSS system are combined using the instantaneous heading, and the difference between the INS heading and the GNSS dual-antenna heading at the same time is used as the observation quantity of the Kalman filter for constraint, so as to improve the combined heading. In specific implementation, the existing scheme constructs a heading-constrained Kalman filter based on the above discussion, corrects navigation parameters such as attitude, speed, and position, and thus completes the entire process of integrated navigation.

[0004] However, the existing combined navigation scheme still has the following defects: First, when installing dual antennas, there will be a small fixed deviation between the heading axis of the dual antennas and the heading axis of the inertial navigation, and this deviation cannot be accurately calibrated and compensated. Therefore, when using the dual antenna heading for constraint, the error will always exist and continue to affect the accuracy of the combined heading; second, in the existing scheme, during the navigation process, the inertial navigation data and the GNSS data cannot be guaranteed to be completely synchronized, so errors will be introduced during the constraint, resulting in inaccuracy of the combined heading. Summary of the invention

[0005] The object of the present invention is to provide a combined navigation method based on navigation constraints with high reliability and good accuracy.

[0006] The combined navigation method based on navigation constraints provided by the present invention comprises the following steps:

[0007] S1. Real-time acquisition of data information of the integrated navigation system;

[0008] S2. According to the data information obtained in step S1, a set of effective inertial navigation headings and GNSS headings at the same time are recorded as a reference;

[0009] S3. Real-time monitoring of the acquired data information. When the next set of simultaneous effective headings of the INS and GNSS are monitored, the current monitored effective headings of the INS and GNSS are subtracted from the reference to obtain the relative headings of the INS and GNSS;

[0010] S4. The relative heading of the inertial navigation system and the relative heading of the GNSS system obtained in step S3 are used as the measurement input of the Kalman filter to calculate the heading error of the inertial navigation system at the current moment;

[0011] S5. Correct the inertial navigation heading error according to the inertial navigation heading error obtained in step S4 at the current moment, complete the combined navigation at the current moment, and use the inertial navigation effective heading and GNSS effective heading at the current moment as the new reference;

[0012] S6. Repeat steps S3 to S5 to complete combined navigation based on navigation constraints in real time.

[0013] The inertial navigation effective heading is specifically the heading calculated by the inertial navigation solution algorithm using the sensor data that has passed the validity test (gyro output and adder output are within the measuring range); the GNSS effective heading is specifically the heading when the number of dual-antenna satellites is greater than 8, the positioning solution dop value is less than 3.0 and the heading solution state is a fixed solution.

[0014] The step S4 specifically comprises the following steps:

[0015] The state variable X of the Kalman filter is:

[0016]

[0017] in is the attitude error, and is the attitude error in the x-axis direction, is the attitude error in the y-axis direction, is the posture error in the z-axis direction; δV 1×3 is the velocity error, and δV 1×3 =[δV x δV y δV z ], δV x is the velocity error in the x-axis direction, δV y is the velocity error in the y-axis direction, δV z is the velocity error in the z-axis direction; δP 1×3 is the position error, and δP 1×3 =[δP x δP y δP z ], δP x is the position error in the x-axis direction, δP y is the position error in the y-axis direction, δP z is the position error in the z-axis direction; ε 1×3 is the gyro drift, and ε 1×3 =[ε x εy ε z ],ε x is the gyro drift in the x-axis direction, ε y is the gyro drift in the y-axis direction, ε z is the gyro drift in the z-axis direction; 1×3 is the accelerometer bias, and is the accelerometer zero bias in the x-axis direction, ▽ y is the accelerometer zero bias in the y-axis direction, is the accelerometer zero bias in the z-axis direction;

[0018] The state equation of the Kalman filter is:

[0019]

[0020] In the formula for The state observation of δV 1×3 The state observation of δP 1×3 The state observation of is 1×3 The state observation of for The state observation of is δθ b The state observation of is δφ b The state observation of is the relevant part of the attitude error in the attitude error equation, and is the rotation speed of the geographic coordinate system relative to the inertial coordinate system, × is the cross multiplication operator, and its mathematical meaning is to convert the 3D vector in front of the symbol × into a 3*3 antisymmetric matrix; is the velocity error-related part of the attitude error equation, and R Mh is the radius of the Earth’s semi-major axis, R Nh is the radius of the Earth's semi-minor axis, and L is the latitude; is the relevant part of the position error in the attitude error equation, and M1 is the first intermediate variable, and ω ie is the projection of the Earth's rotational angular velocity in the geographic system, M2 is the second intermediate variable, and v E It is the E-axis velocity in the northeast celestial velocity in the navigation coordinate system; is the attitude conversion matrix from the carrier system to the navigation system; is the relevant part of the attitude error in the velocity error equation, and f n For comparison; M vv is the velocity error-related part of the velocity error equation, and v n is the northeast celestial velocity in the navigation coordinate system and v n =[v E v N v U ] T , v N is the N-axis velocity in the northeast celestial velocity in the navigation coordinate system, v U is the U-axis velocity in the northeast celestial velocity in the navigation coordinate system, is the velocity error-related part of the attitude error equation and is the Earth's rotation angular velocity, M is the angular velocity of the navigation coordinate system; vp is the relevant part of the position error in the velocity error equation, and M vp =(v n ×)(2M1+M2);M pv is the velocity error-related part of the position error equation, and M pp is the relevant part of the position error in the position error equation, and is gyro white noise; is the accelerometer white noise;

[0021] The measurement observation Z of the Kalman filter is:

[0022] Z=ΔΨ INS -ΔΨ GNSS

[0023] Where ΔΨ INS is the relative heading of the inertial navigation; ΔΨ GNSS is the relative heading of GNSS;

[0024] The measurement equation of the Kalman filter is:

[0025]

[0026] Where Ω is the angular velocity of the earth's rotation; θ is the pitch angle; Ψ is the heading angle; ts is the sampling interval; γ is the roll angle;

[0027] According to the constructed Kalman filter, the heading error of the inertial navigation at the current moment is calculated.

[0028] The combined navigation method based on navigation constraints provided by the present invention provides a difference between a relative heading based on an inertial navigation and a relative heading of GNSS as a measurement quantity, and then uses Kalman filtering to estimate the inertial navigation heading error at that moment to correct the inertial navigation heading. This can effectively solve the problem of a fixed deviation between the GNSS dual-antenna heading and the inertial navigation heading axis, and can also avoid the influence of the inertial navigation and GNSS data being out of synchronization under low dynamic conditions to a certain extent, thereby ensuring that the present invention has higher reliability and better accuracy. BRIEF DESCRIPTION OF THE DRAWINGS

[0029] Figure 1 The figure is a schematic diagram of the method flow of the present invention.

[0030] Figure 2 Schematic diagram of heading comparison according to an embodiment of the method of the present invention.

[0031] Figure 3 It is a partially enlarged schematic diagram of heading comparison in an embodiment of the method of the present invention.

[0032] Figure 4 Schematic diagram of heading error comparison in an embodiment of the method of the present invention. DETAILED DESCRIPTION

[0033] like Figure 1 The method flow chart of the method of the present invention is shown as follows: the combined navigation method based on navigation constraints provided by the present invention comprises the following steps:

[0034] S1. Real-time acquisition of data information of the integrated navigation system;

[0035] S2. According to the data information obtained in step S1, a set of effective inertial navigation headings and GNSS headings at the same time are recorded as a reference;

[0036] S3. Real-time monitoring of the acquired data information. When the next set of simultaneous effective headings of the INS and GNSS are monitored, the current monitored effective headings of the INS and GNSS are subtracted from the reference to obtain the relative headings of the INS and GNSS;

[0037] Among them, the so-called effective inertial navigation heading is specifically the heading calculated by the inertial navigation solution algorithm using the sensor data that has passed the validity test (gyro output and adder output are within the measuring range); the effective GNSS heading is specifically the heading when the number of dual-antenna satellites is greater than 8, the positioning solution dop value is less than 3.0, and the heading solution status is a fixed solution.

[0038] S4. The relative heading of the inertial navigation system and the relative heading of the GNSS system obtained in step S3 are used as the measurement input of the Kalman filter to calculate the heading error of the inertial navigation system at the current moment; specifically, the steps include:

[0039] The state variable X of the Kalman filter is:

[0040]

[0041] in is the attitude error, and is the attitude error in the x-axis direction, is the attitude error in the y-axis direction, is the posture error in the z-axis direction; δV 1×3 is the velocity error, and δV 1×3 =[δV x δV y δV z ], δV x is the velocity error in the x-axis direction, δV y is the velocity error in the y-axis direction, δV z is the velocity error in the z-axis direction; δP 1×3 is the position error, and δP 1×3 =[δP x δP y δP z ], δP x is the position error in the x-axis direction, δP y is the position error in the y-axis direction, δP z is the position error in the z-axis direction; ε 1×3 is the gyro drift, and ε 1×3 =[ε x ε y ε z ],ε x is the gyro drift in the x-axis direction, ε y is the gyro drift in the y-axis direction, ε z is the gyro drift in the z-axis direction; is the accelerometer bias, and is the accelerometer zero bias in the x-axis direction, is the accelerometer zero bias in the y-axis direction, is the accelerometer zero bias in the z-axis direction;

[0042] The state equation of the Kalman filter is:

[0043]

[0044] In the formula for The state observation of δV 1×3 The state observation of δP 1×3The state observation of is 1×3 The state observation of for The state observation of is δθ b The state observation of is δφ b The state observation of is the relevant part of the attitude error in the attitude error equation, and is the rotation speed of the geographic coordinate system relative to the inertial coordinate system, × is the cross multiplication operator, and its mathematical meaning is to convert the 3D vector in front of the symbol × into a 3*3 antisymmetric matrix; is the velocity error-related part of the attitude error equation, and R Mh is the radius of the Earth’s semi-major axis, R Nh is the radius of the Earth's semi-minor axis, and L is the latitude; is the relevant part of the position error in the attitude error equation, and M1 is the first intermediate variable, and ω ie is the projection of the Earth's rotational angular velocity in the geographic system, M2 is the second intermediate variable, and v E It is the E-axis velocity in the northeast celestial velocity in the navigation coordinate system; is the attitude conversion matrix from the carrier system to the navigation system; is the relevant part of the attitude error in the velocity error equation, and f n For comparison; M vv is the velocity error-related part of the velocity error equation, and v n is the northeast celestial velocity in the navigation coordinate system and v n =[v E v N v U ] T , v N is the N-axis velocity in the northeast celestial velocity in the navigation coordinate system, v U is the U-axis velocity in the northeast celestial velocity in the navigation coordinate system, is the velocity error-related part of the attitude error equation and is the Earth's rotation angular velocity, M is the angular velocity of the navigation coordinate system; vp is the relevant part of the position error in the velocity error equation, and M vp =(v n ×)(2M1+M2);M pvis the velocity error-related part of the position error equation, and M pp is the relevant part of the position error in the position error equation, and is gyro white noise; is the accelerometer white noise;

[0045] The measurement observation Z of the Kalman filter is:

[0046] Z=ΔΨ INS -ΔΨ GNSS

[0047] Where ΔΨ INS is the relative heading of the inertial navigation; ΔΨ GNSS is the relative heading of GNSS;

[0048] The measurement equation of the Kalman filter is:

[0049]

[0050] Where Ω is the angular velocity of the earth's rotation; θ is the pitch angle; Ψ is the heading angle; ts is the sampling interval; γ is the roll angle;

[0051] According to the constructed Kalman filter, the heading error of the inertial navigation at the current moment is calculated;

[0052] S5. Correct the inertial navigation heading error according to the inertial navigation heading error obtained in step S4 at the current moment, complete the combined navigation at the current moment, and use the inertial navigation effective heading and GNSS effective heading at the current moment as the new reference;

[0053] S6. Repeat steps S3 to S5 to complete combined navigation based on navigation constraints in real time.

[0054] The effect of the method of the present invention is further described below in conjunction with an embodiment:

[0055] The reference inertial navigation system (fiber optic inertial navigation system) and the equipment equipped with different solutions were used for sports car tests (installed on the same reference surface with an installation error of less than 0.1°). The heading comparison results are as follows: Figure 2 As shown; select a small part to enlarge it locally as shown Figure 3 As shown; the heading error comparison chart is obtained by subtracting the two sets of data from the reference inertial navigation as shown Figure 4 As shown; the heading error is statistically analyzed, and the results are shown in Table 1 below:

[0056] Table 1 Statistical data of heading comparison error

[0057] Heading Error Existing methods This method 1sigma error 1.69° 0.49° 3sigma error 1.86° 0.61°

[0058] from Figure 2 to Figure 4 As can be seen from Table 1, the heading error of the method of the present invention is significantly better than that of the original solution.

Claims

1. A combined navigation method based on navigation constraints, comprising the following steps: S1. Real-time acquisition of data information of the integrated navigation system; S2. According to the data information obtained in step S1, a set of effective inertial navigation headings and GNSS headings at the same time are recorded as a reference; S3. Real-time monitoring of the acquired data information. When the next set of simultaneous effective headings of the INS and GNSS are monitored, the current monitored effective headings of the INS and GNSS are subtracted from the reference to obtain the relative headings of the INS and GNSS; S4. The relative heading of the inertial navigation system and the relative heading of the GNSS system obtained in step S3 are used as the measurement input of the Kalman filter to calculate the heading error of the inertial navigation system at the current moment; S5. Correct the inertial navigation heading error according to the inertial navigation heading error obtained in step S4 at the current moment, complete the combined navigation at the current moment, and use the inertial navigation effective heading and GNSS effective heading at the current moment as the new reference; S6. Repeat steps S3 to S5 to complete combined navigation based on navigation constraints in real time.

2. The combined navigation method based on navigation constraints according to claim 1, Features The inertial navigation effective heading and GNSS effective heading, the inertial navigation effective heading is specifically the heading calculated by the inertial navigation solution algorithm using the sensor data that has passed the validity detection; the GNSS effective heading is specifically the heading when the number of dual-antenna satellites is greater than 8, the positioning solution dop value is less than 3.0 and the heading solution state is a fixed solution.

3. The combined navigation method based on navigation constraints according to claim 2, Features The step S4 specifically comprises the following steps: The state variable X of the Kalman filter is: in is the attitude error, and is the attitude error in the x-axis direction, is the attitude error in the y-axis direction, is the posture error in the z-axis direction; δV 1×3 is the velocity error, and δV 1×3 =[δV x δV y δV z ], δV x is the velocity error in the x-axis direction, δV y is the velocity error in the y-axis direction, δV z is the velocity error in the z-axis direction; δP 1×3 is the position error, and δP 1×3 =[δP x δP y δP z ], δP x is the position error in the x-axis direction, δP y is the position error in the y-axis direction, δP z is the position error in the z-axis direction; ε 1×3 is the gyro drift, and ε 1×3 =[ε x ε y ε z ],ε x is the gyro drift in the x-axis direction, ε y is the gyro drift in the y-axis direction, ε z is the gyro drift in the z-axis direction; is the accelerometer bias, and is the accelerometer zero bias in the x-axis direction, is the accelerometer zero bias in the y-axis direction, is the accelerometer zero bias in the z-axis direction; The state equation of the Kalman filter is: In the formula for The state observation of δV 1×3 The state observation of δP 1×3 The state observation of is 1×3 The state observation of for The state observation of is δθ b The state observation of is δφ b The state observation of is the relevant part of the attitude error in the attitude error equation, and is the rotation speed of the geographic coordinate system relative to the inertial coordinate system, × is the cross multiplication operator, and its mathematical meaning is to convert the 3D vector in front of the symbol × into a 3*3 antisymmetric matrix; is the velocity error-related part of the attitude error equation, and R Mh is the radius of the Earth’s semi-major axis, R Nh is the radius of the Earth's semi-minor axis, and L is the latitude; is the relevant part of the position error in the attitude error equation, and M 1 is the first intermediate variable, and ω ie is the projection of the Earth's rotational angular velocity in the geographic system, M 2 is the second intermediate variable, and v E It is the E-axis velocity in the northeast celestial velocity in the navigation coordinate system; is the attitude conversion matrix from the carrier system to the navigation system; is the relevant part of the attitude error in the velocity error equation, and f n For comparison; M vv is the velocity error-related part of the velocity error equation, and v n is the northeast celestial velocity in the navigation coordinate system and v n =[v E v N v U ] T , v N is the N-axis velocity in the northeast celestial velocity in the navigation coordinate system, v U is the U-axis velocity in the northeast celestial velocity in the navigation coordinate system, is the velocity error-related part of the attitude error equation and is the Earth's rotation angular velocity, is the angular rate of rotation of the navigation coordinate system; M vp is the relevant part of the position error in the velocity error equation, and M vp =(v n ×)(2M 1 +M 2 );M pv is the velocity error-related part of the position error equation, and M pp is the relevant part of the position error in the position error equation, and is gyro white noise; is the accelerometer white noise; The measurement observation Z of the Kalman filter is: Z=ΔΨ INS -DW GNSS Where ΔΨ INS is the relative heading of the inertial navigation; ΔΨ GNSS is the relative heading of GNSS; The measurement equation of the Kalman filter is: Where Ω is the angular velocity of the earth's rotation; θ is the pitch angle; Ψ is the heading angle; ts is the sampling interval; γ is the roll angle; According to the constructed Kalman filter, the heading error of the inertial navigation at the current moment is calculated.