Analysis Method of Factors Affecting Inertial Navigation Attitude Based on Error Propagation Relationship

By analyzing the error propagation relationship, the attitude errors in the initial alignment and navigation solution stages are calculated. The gyroscope drift is estimated using velocity observation and Kalman filtering, and a gyroscope observation error model is constructed. This solves the problem that existing methods fail to fully consider the error in the initial alignment stage, and achieves higher navigation accuracy.

CN117824710BActive Publication Date: 2026-11-10NAT UNIV OF DEFENSE TECH
View PDF 2 Cites 0 Cited by

Patent Information

Application Number
CN202410020595.0
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-01-04
Publication Date
2026-11-10
Estimated Expiration
2044-01-04

AI Technical Summary

Technical Problem

Existing inertial navigation attitude analysis methods fail to fully consider errors in the initial alignment stage, resulting in low navigation accuracy and an inability to specifically reduce attitude errors.

Method used

By analyzing the error propagation relationship, the attitude error in the initial alignment and navigation solution stages is calculated. The gyroscope drift is estimated using velocity observation and Kalman filtering. A gyroscope observation error model is constructed, attitude influencing factors are analyzed, and targeted error compensation methods are provided.

Benefits of technology

It improves the accuracy of inertial navigation attitude influencing factor analysis, and can specifically reduce attitude error and improve navigation accuracy.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN117824710B_ABST
    Figure CN117824710B_ABST
Patent Text Reader

Abstract

This application relates to a method for analyzing inertial navigation attitude influencing factors based on error propagation relationships. The method includes: expanding and calculating the eastward and northward acceleration errors during the initial alignment phase to obtain the eastward and northward attitudes; calculating observable quantities from the eastward, northward, and celestial attitudes, and then using the obtained eastward, northward, and celestial attitude errors to perform inertial navigation attitude influencing factor analysis, obtaining the attitude influencing factor analysis results for the initial alignment phase; in the navigation solution phase, calculating the attitude error based on the gyroscope observation error model and misalignment angle, expanding the attitude error components, and performing inertial navigation attitude influencing factor analysis based on the obtained eastward, northward, and celestial attitudes for the navigation solution phase, obtaining the attitude influencing factor analysis results for the navigation solution phase; this method can improve the accuracy of inertial navigation attitude influencing factor analysis.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This application relates to the field of navigation attitude analysis technology, and in particular to a method for analyzing inertial navigation attitude influencing factors based on error propagation relationships. Background Technology

[0002] High-precision inertial navigation technology is one of the core technologies for achieving autonomous navigation of ships, vessels, and submersibles during long-endurance ocean missions. With the accumulation of errors over long mission cycles, navigation parameter errors become significant. Compensating for these errors can improve navigation accuracy. The main errors in inertial navigation systems are navigation parameter errors, which primarily include velocity, position, and attitude errors. Attitude error, as a crucial component of navigation parameter errors, requires analysis of its influencing factors. The analysis results can be used to design methods to reduce attitude errors.

[0003] However, current traditional attitude analysis methods only focus on the errors caused by gravity disturbances during the navigation phase, without considering the errors generated during the initial alignment phase. The analysis results are not accurate enough, and methods to reduce inertial navigation attitude errors cannot be designed specifically, resulting in low navigation accuracy. Summary of the Invention

[0004] Therefore, it is necessary to provide a method for analyzing inertial navigation attitude influencing factors based on error propagation relationships, which can improve the accuracy of inertial navigation attitude influencing factor analysis and address the aforementioned technical problems.

[0005] A method for analyzing factors influencing inertial navigation attitude based on error propagation relationships, the method comprising:

[0006] Obtain the initial conditions of the ship during the initial alignment phase; under the condition that the position is accurately known, perform fine alignment using velocity observation, and calculate the eastward acceleration error and northward acceleration error during the initial alignment phase based on the initial conditions while ignoring gravity disturbances;

[0007] The eastward and northward acceleration errors during the initial alignment phase are expanded and calculated to obtain the eastward and northward attitudes; the pre-calculated skyward attitude is obtained; and the eastward attitude error, northward attitude error, and skyward attitude error are calculated based on the observable quantities in the eastward, northward, and skyward attitudes.

[0008] Based on the eastward attitude error, northward attitude error, and celestial attitude error, an analysis of the factors affecting the attitude of inertial navigation was conducted, and the results of the attitude influencing factors analysis in the initial alignment stage were obtained. The results of the attitude influencing factors analysis in the initial alignment stage show that the horizontal attitude error in the initial alignment stage is jointly determined by horizontal gravity disturbance and accelerometer zero bias, while the celestial attitude error in the initial alignment stage is affected by eastward accelerometer zero bias, eastward gravity disturbance, eastward gyroscope drift, and latitude.

[0009] In the navigation solution stage, the random constant drift of the gyroscope is estimated based on Kalman filtering, and the gyroscope observation error model is constructed using the random constant drift of the gyroscope and zero-mean random white noise. The attitude error is calculated based on the gyroscope observation error model and the misalignment angle. The attitude error is expanded by component expansion to obtain the eastward attitude, northward attitude and skyward attitude in the navigation solution stage.

[0010] Based on the eastward, northward, and celestial attitudes during the navigation calculation phase, an analysis of the influencing factors of inertial navigation attitude was conducted, yielding the results of the attitude influencing factor analysis during the navigation calculation phase. The results show that the attitude error is affected by gyroscope drift, accelerometer zero bias, and gravitational disturbance.

[0011] In one embodiment, the initial condition is v E =v N =0, f E =f N =0,f U =γ, where v E Indicates the eastward velocity, v N Indicates northbound speed. Indicates eastward acceleration. f represents northward acceleration. E Indicates the eastward force, f N Indicates the northward force, f U γ represents the force relative to the sky, and γ represents normal gravity.

[0012] In one embodiment, under the condition that the position is accurately known, fine alignment is performed using velocity observations. Ignoring gravity disturbances, the eastward and northward acceleration errors during the initial alignment phase are calculated based on the initial conditions, including:

[0013] Under the condition that the position is accurately known, when performing fine alignment using velocity observations and neglecting gravity disturbances, the eastward acceleration error in the initial alignment stage is calculated based on the initial conditions as follows:

[0014]

[0015] Where, φ N Indicates northward orientation, γ represents normal gravity, ω ie δv represents the Earth's rotational angular rate, L represents geographical latitude, and δv N Indicates the northward velocity error, δg E This represents the horizontal component of the eastward gravitational disturbance. This indicates that the random constant of the accelerometer pointing east is zero bias;

[0016] Under the condition that the position is accurately known, when performing fine alignment using velocity observations and neglecting gravity disturbances, the northward acceleration error in the initial alignment stage is calculated based on the initial conditions as follows:

[0017]

[0018] Where, φ E Indicates an eastward orientation, δv E Indicates the eastward velocity error, δg N This represents the horizontal component of the northward gravity disturbance. This indicates that the random constant of the accelerometer pointing north is zero bias.

[0019] In one embodiment, the eastward acceleration error and northward acceleration error during the initial alignment phase are expanded and calculated to obtain the eastward attitude and northward attitude, including:

[0020] The northward acceleration error during the initial alignment phase is calculated by expansion, yielding the eastward attitude as follows:

[0021]

[0022] Where, φ N Indicates northward orientation, γ represents normal gravity, ω ie L represents the Earth's rotational angular rate, and L represents the geographic latitude. Indicates the northward acceleration error, δg E φ represents the horizontal component of the eastward gravitational disturbance. E Indicates an eastward orientation, δv E Indicates the eastward velocity error, δg N This represents the horizontal component of the northward gravity disturbance. ξ represents the random constant zero bias of the accelerometer pointing north, and ξ represents the meridional component of the vertical deviation.

[0023] The eastward acceleration error during the initial alignment phase is calculated by expansion, yielding the northward attitude as follows:

[0024]

[0025] Where, δv N Indicates the northbound velocity error. Indicates the eastward acceleration error. η represents the random constant zero bias of the accelerometer pointing eastward, and η represents the ramusoidal component of the vertical deviation.

[0026] In one embodiment, the upward orientation is...

[0027]

[0028] Among them, R NLet be the radius of the meridian circle, and h be the geographic altitude.

[0029] In one embodiment, the east attitude error, north attitude error, and sky attitude error are calculated based on observable quantities among the east attitude, north attitude, and sky attitude, including:

[0030] Due to the eastward orientation All components are considerable, therefore the calculated eastward attitude error is:

[0031]

[0032] in, δg represents the random constant zero bias error of the accelerometer pointing north. N This represents the horizontal component of the northward gravity disturbance;

[0033] Due to the northward orientation All components are considerable, therefore the calculated northward attitude error is:

[0034]

[0035] in, δg represents the random constant zero bias error of the accelerometer pointing eastward. E This represents the horizontal component of the eastward gravitational disturbance.

[0036] Due to the celestial posture All components are observable, therefore the calculated celestial attitude error is:

[0037]

[0038] Where, ε E This indicates that the gyroscope is drifting eastward.

[0039] In one embodiment, the zero-mean random white noise includes zero-mean random white noise of velocity; a gyroscope observation error model is constructed using the gyroscope's random constant drift and the zero-mean random white noise, including:

[0040] An error model for the accelerometer is constructed using the random constant drift of the gyroscope and the zero-mean random white noise of the velocity.

[0041]

[0042] in, Zero-mean random white noise representing velocity. The accelerometer has a random constant zero bias.

[0043] In one embodiment, the attitude error is calculated based on the gyroscope observation error model and the misalignment angle, including:

[0044] The attitude error was calculated using the gyroscope observation error model and the misalignment angle.

[0045]

[0046]

[0047] Where, φ n For misalignment angle, This represents the projection of the gyroscope output error onto the n-frame. This represents the gyroscope observation error model. Zero-mean random white noise representing the angle, ε b For random constant drift of the gyroscope, Let n be the rotation of the navigation frame n relative to the inertial frame i. This represents the rotation calculation error of the navigation frame n relative to the inertial frame i. This represents the attitude transition matrix from the b-system to the n-system.

[0048] In one embodiment, the attitude error is component-expanded to obtain the eastward attitude, northward attitude, and skyward attitude during the navigation solution stage, including:

[0049] By performing component expansion on the attitude error, the eastward attitude in the navigation solution stage is obtained as follows:

[0050]

[0051] Where, ω ie The value represents the Earth's rotational angular rate, where L represents latitude, and v represents the Earth's rotational angular rate. E R represents the eastward velocity. E Let φ be the radius of the curved surface of the yoke-mayo-yoke circle, h be the geographical altitude, and φ be the radius of the curved surface of the yoke-mayo-yoke circle. N φ represents the northward attitude during the initial alignment phase. U R represents the azimuth attitude during the initial alignment phase. N Let δv be the radius of the surface of the meridian circle. N Indicates the northbound velocity error, ε E This indicates that the top is drifting eastward;

[0052] By performing component expansion on the attitude error, the northward attitude in the navigation solution stage is obtained as follows:

[0053]

[0054] Where, φ E Indicates the eastward attitude during the initial alignment phase, v N Indicates the eastward velocity, δv E Indicates the eastward velocity error, ε N This indicates that the top is drifting eastward;

[0055] By performing component expansion on the attitude error, the azimuth attitude in the navigation solution stage is obtained as follows:

[0056]

[0057] Where, ε U This indicates that the gyroscope is drifting.

[0058] The aforementioned method for analyzing inertial navigation attitude influencing factors based on error propagation relationships analyzes the error propagation relationship from the perspectives of error propagation and the prerequisites for inertial navigation calculation. While analyzing the error propagation relationship, it calculates not only the errors generated during the navigation calculation stage but also the errors generated during the initial alignment stage. By calculating the attitude errors in both stages, a more intuitive and comprehensive understanding of how errors work can be achieved, improving the accuracy of inertial navigation attitude influencing factor analysis. Based on the results of the attitude influencing factor analysis, targeted methods to reduce inertial navigation parameter errors can be designed, thereby improving navigation accuracy. Attached Figure Description

[0059] Figure 1 This is a flowchart illustrating an inertial navigation attitude influencing factor analysis method based on error propagation relationship in one embodiment. Detailed Implementation

[0060] To make the objectives, technical solutions, and advantages of this application clearer, the following detailed description is provided in conjunction with the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are merely illustrative and not intended to limit the scope of this application.

[0061] In one embodiment, such as Figure 1 As shown, a method for analyzing inertial navigation attitude influencing factors based on error propagation relationships is provided, including the following steps:

[0062] Step 102: Obtain the initial conditions of the ship during the initial alignment phase; under the condition that the position is accurately known, perform fine alignment using velocity observation, and calculate the eastward acceleration error and northward acceleration error during the initial alignment phase based on the initial conditions while ignoring gravity disturbance.

[0063] During the initial alignment phase, the ship is moored at the dock, similar to alignment on a static base, and the initial condition v can be obtained. E =v N =0, f E =f N =0,f U =γ. Since the position is accurately known, precise alignment is performed using velocity observations, combined with the velocity error differential equation.

[0064] and the expansion of the velocity error differential equation, as well as It can be seen that when gravity disturbance is ignored during the calculation and gravity disturbance measurement error is not considered, the eastward velocity error and northward velocity error in the initial alignment stage can be obtained. From the eastward velocity error and northward velocity error, the relevant expressions of the eastward attitude and northward attitude can be calculated, providing a reference for subsequent attitude influencing factor analysis.

[0065] Step 104: Expand and calculate the eastward acceleration error and northward acceleration error in the initial alignment stage to obtain the eastward attitude and northward attitude; obtain the pre-calculated sky attitude; calculate the eastward attitude error, northward attitude error and sky attitude error based on the observable quantities in the eastward attitude, northward attitude and sky attitude.

[0066] Step 106: Analyze the influencing factors of inertial navigation attitude based on the eastward attitude error, northward attitude error, and celestial attitude error to obtain the analysis results of attitude influencing factors in the initial alignment stage. The analysis results of attitude influencing factors in the initial alignment stage show that the horizontal attitude error in the initial alignment stage is jointly determined by horizontal gravity disturbance and accelerometer zero bias. The celestial attitude error in the initial alignment stage is affected by eastward accelerometer zero bias, eastward gravity disturbance, eastward gyroscope drift, and latitude.

[0067] From the expressions for eastward attitude error, northward attitude error, and celestial attitude error, it can be seen that horizontal gravity disturbance (vertical deviation) and accelerometer zero bias jointly determine the horizontal attitude error in the initial alignment stage. The celestial attitude error in the initial alignment stage is affected by eastward accelerometer zero bias, eastward gravity disturbance (vertical deviation), eastward gyroscope drift, and latitude. Therefore, in the initial alignment stage, the attitude error can be reduced by calibrating the accelerometer and gyroscope.

[0068] Step 108: In the navigation solution stage, the random constant drift of the gyroscope is estimated based on the Kalman filter, and the gyroscope observation error model is constructed using the random constant drift of the gyroscope and zero-mean random white noise. The attitude error is calculated based on the gyroscope observation error model and the misalignment angle. The attitude error is expanded by component expansion to obtain the eastward attitude, northward attitude and skyward attitude in the navigation solution stage.

[0069] Step 106: Based on the eastward, northward, and celestial attitudes obtained during the navigation calculation phase, an inertial navigation attitude influencing factor analysis is performed to obtain the attitude influencing factor analysis results during the navigation calculation phase. The attitude influencing factor analysis results during the navigation calculation phase show that the attitude error is affected by gyroscope drift, accelerometer zero bias, and gravity disturbance.

[0070] Based on the expressions for the eastward, northward, and azimuth attitudes during the navigation calculation phase, it can be seen that the gravity disturbance, as a gravity disturbance error term, is equivalent to zero bias and acts sequentially on the velocity and position calculation processes, resulting in velocity and position errors. and The updates are applied to the attitude calculation process, resulting in attitude errors. Therefore, the attitude accuracy of inertial navigation during the navigation calculation stage is affected by gyroscope drift, accelerometer bias, and gravity disturbances. Horizontal accelerometer bias and gravity disturbances have a greater impact on attitude. Therefore, improving navigation accuracy can start by reducing the measurement error of gravity disturbances to reduce attitude errors.

[0071] In the aforementioned method for analyzing inertial navigation attitude influencing factors based on error propagation, this application analyzes the error propagation relationship from the perspectives of error propagation and the prerequisites for inertial navigation calculation. While analyzing the error propagation relationship, it calculates not only the errors generated in the navigation calculation stage but also the errors generated in the initial alignment stage. By calculating the attitude errors in both stages, it is possible to gain a more intuitive and comprehensive understanding of how the errors work, thereby improving the accuracy of inertial navigation attitude influencing factor analysis. Based on the results of the attitude influencing factor analysis, targeted methods can be designed to reduce inertial navigation parameter errors, thereby improving navigation accuracy.

[0072] In one embodiment, the initial condition is v E =v N =0, f E =f N =0,f U =γ, where v E Indicates the eastward velocity, v N Indicates northbound speed. Indicates eastward acceleration. f represents northward acceleration. E Indicates the eastward force, f N Indicates the northward force, f U γ represents the force relative to the sky, and γ represents normal gravity.

[0073] In one embodiment, under the condition that the position is accurately known, fine alignment is performed using velocity observations. Ignoring gravity disturbances, the eastward and northward acceleration errors during the initial alignment phase are calculated based on the initial conditions, including:

[0074] Under the condition that the position is accurately known, when performing fine alignment using velocity observations and neglecting gravity disturbances, the eastward acceleration error in the initial alignment stage is calculated based on the initial conditions as follows:

[0075]

[0076] Where, φ N Indicates northward orientation, γ represents normal gravity, ω ie δv represents the Earth's rotational angular rate, L represents geographical latitude, and δv N Indicates the northward velocity error, δg E This represents the horizontal component of the eastward gravitational disturbance. This indicates that the random constant of the accelerometer pointing east is zero bias;

[0077] Under the condition that the position is accurately known, when performing fine alignment using velocity observations and neglecting gravity disturbances, the northward acceleration error in the initial alignment stage is calculated based on the initial conditions as follows:

[0078]

[0079] Where, φ E Indicates an eastward orientation, δv E Indicates the eastward velocity error, δg N This represents the horizontal component of the northward gravity disturbance. This indicates that the random constant of the accelerometer pointing north is zero bias.

[0080] In one embodiment, the eastward acceleration error and northward acceleration error during the initial alignment phase are expanded and calculated to obtain the eastward attitude and northward attitude, including:

[0081] The northward acceleration error during the initial alignment phase is calculated by expansion, yielding the eastward attitude as follows:

[0082]

[0083] Where, φ N Indicates northward orientation, γ represents normal gravity, ω ie L represents the Earth's rotational angular rate, and L represents the geographic latitude. Indicates the northward acceleration error, δg E φ represents the horizontal component of the eastward gravitational disturbance. E Indicates an eastward orientation, δv E Indicates the eastward velocity error, δg N This represents the horizontal component of the northward gravity disturbance. ξ represents the random constant zero bias of the accelerometer pointing north, and ξ represents the meridional component of the vertical deviation.

[0084] The eastward acceleration error during the initial alignment phase is calculated by expansion, yielding the northward attitude as follows:

[0085]

[0086] Where, δv NIndicates the northbound velocity error. Indicates the eastward acceleration error. η represents the random constant zero bias of the accelerometer pointing eastward, and η represents the ramusoidal component of the vertical deviation.

[0087] In one embodiment, the upward orientation is...

[0088]

[0089] Among them, R N Let be the radius of the meridian circle, and h be the geographic altitude.

[0090] In one embodiment, the east attitude error, north attitude error, and sky attitude error are calculated based on observable quantities among the east attitude, north attitude, and sky attitude, including:

[0091] Due to the eastward orientation All components are considerable, therefore the calculated eastward attitude error is:

[0092]

[0093] in, δg represents the random constant zero bias error of the accelerometer pointing north. N This represents the horizontal component of the northward gravity disturbance;

[0094] Due to the northward orientation All components are considerable, therefore the calculated northward attitude error is:

[0095]

[0096] in, δg represents the random constant zero bias error of the accelerometer pointing eastward. E This represents the horizontal component of the eastward gravitational disturbance.

[0097] Due to the celestial posture All components are observable, therefore the calculated celestial attitude error is:

[0098]

[0099] Where, ε E This indicates that the gyroscope is drifting eastward.

[0100] In one embodiment, the zero-mean random white noise includes zero-mean random white noise of velocity; a gyroscope observation error model is constructed using the gyroscope's random constant drift and the zero-mean random white noise, including:

[0101] An error model for the accelerometer is constructed using the random constant drift of the gyroscope and the zero-mean random white noise of the velocity.

[0102]

[0103] in, Zero-mean random white noise representing velocity. The accelerometer has a random constant zero bias.

[0104] In one embodiment, the attitude error is calculated based on the gyroscope observation error model and the misalignment angle, including:

[0105] The attitude error was calculated using the gyroscope observation error model and the misalignment angle.

[0106]

[0107]

[0108] Where, φ n For misalignment angle, This represents the projection of the gyroscope output error onto the n-frame. This represents the gyroscope observation error model. Zero-mean random white noise representing the angle, ε b For random constant drift of the gyroscope, Let n be the rotation of the navigation frame n relative to the inertial frame i. This represents the rotation calculation error of the navigation frame n relative to the inertial frame i. This represents the attitude transition matrix from the b-system to the n-system.

[0109] In one embodiment, the attitude error is component-expanded to obtain the eastward attitude, northward attitude, and skyward attitude during the navigation solution stage, including:

[0110] By performing component expansion on the attitude error, the eastward attitude in the navigation solution stage is obtained as follows:

[0111]

[0112] Where, ω ie The value represents the Earth's rotational angular rate, where L represents latitude, and v represents the Earth's rotational angular rate. E R represents the eastward velocity. E Let φ be the radius of the curved surface of the yoke-mayo-yoke circle, h be the geographical altitude, and φ be the radius of the curved surface of the yoke-mayo-yoke circle. N φ represents the northward attitude during the initial alignment phase. U R represents the azimuth attitude during the initial alignment phase. N Let δv be the radius of the surface of the meridian circle. N Indicates the northbound velocity error, ε E This indicates that the top is drifting eastward;

[0113] By performing component expansion on the attitude error, the northward attitude in the navigation solution stage is obtained as follows:

[0114]

[0115] Where, φ E Indicates the eastward attitude during the initial alignment phase, v N Indicates the eastward velocity, δv E Indicates the eastward velocity error, ε N This indicates that the top is drifting eastward;

[0116] By performing component expansion on the attitude error, the azimuth attitude in the navigation solution stage is obtained as follows:

[0117]

[0118] Where, ε U This indicates that the gyroscope is drifting.

[0119] It should be understood that, although Figure 1 The steps in the flowchart are shown sequentially as indicated by the arrows, but these steps are not necessarily executed in the order indicated by the arrows. Unless otherwise specified herein, there is no strict order in which these steps are executed, and they can be performed in other orders. Figure 1 At least some of the steps in the process may include multiple sub-steps or multiple stages. These sub-steps or stages are not necessarily executed at the same time, but can be executed at different times. The execution order of these sub-steps or stages is not necessarily sequential, but can be executed in turn or alternately with other steps or at least some of the sub-steps or stages of other steps.

[0120] The technical features of the above embodiments can be combined in any way. For the sake of brevity, not all possible combinations of the technical features in the above embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification.

[0121] The embodiments described above are merely illustrative of several implementation methods of this application, and while the descriptions are relatively specific and detailed, they should not be construed as limiting the scope of the invention patent. It should be noted that those skilled in the art can make various modifications and improvements without departing from the concept of this application, and these all fall within the protection scope of this application. Therefore, the protection scope of this patent application should be determined by the appended claims.

Claims

1. A method for analyzing factors influencing inertial navigation attitude based on error propagation relationships, characterized in that, The method includes: Obtain the initial conditions of the ship during the initial alignment phase; under the condition that the position is accurately known, perform fine alignment using velocity observation, and calculate the eastward acceleration error and northward acceleration error during the initial alignment phase based on the initial conditions while ignoring gravity disturbances; The eastward acceleration error and northward acceleration error in the initial alignment stage are expanded and calculated to obtain the eastward attitude and northward attitude; the pre-calculated skyward attitude is obtained; the eastward attitude error, northward attitude error and skyward attitude error are calculated based on the observable quantities in the eastward attitude, northward attitude and skyward attitude. Based on the eastward attitude error, northward attitude error, and celestial attitude error, an inertial navigation attitude influencing factor analysis was conducted to obtain the attitude influencing factor analysis results for the initial alignment stage. The attitude influencing factor analysis results for the initial alignment stage show that horizontal gravity disturbance and accelerometer zero bias jointly determine the horizontal attitude error in the initial alignment stage, while the celestial attitude error in the initial alignment stage is affected by eastward accelerometer zero bias, eastward gravity disturbance, eastward gyroscope drift, and latitude. During the navigation calculation phase, the random constant drift of the gyroscope is estimated based on Kalman filtering, and a gyroscope observation error model is constructed using the random constant drift of the gyroscope and zero-mean random white noise. The attitude error is calculated based on the gyroscope observation error model and the misalignment angle, and the attitude error is expanded by component to obtain the eastward attitude, northward attitude and skyward attitude during the navigation calculation phase. Based on the eastward, northward, and celestial attitudes during the navigation calculation phase, an inertial navigation attitude influencing factor analysis is performed to obtain the attitude influencing factor analysis results during the navigation calculation phase. The attitude influencing factor analysis results during the navigation calculation phase show that the attitude error is affected by gyroscope drift, accelerometer zero bias, and gravity disturbance. The attitude error is expanded into components to obtain the eastward, northward, and celestial attitudes for the navigation solution stage, including: The attitude error is expanded by components to obtain the eastward attitude during the navigation solution stage. in, Represents the Earth's rotational angular rate. Indicates geographical latitude, Indicates eastward speed. Let be the radius of the curved surface of the y-y circle. For geographical altitude, This indicates the northward attitude during the initial alignment phase. This indicates the azimuth attitude during the initial alignment phase. Let be the radius of the surface of the meridian circle. Indicates the northbound velocity error. This indicates that the top is drifting eastward; The attitude error is expanded by components to obtain the northward attitude in the navigation solution stage. in, This indicates the eastward orientation during the initial alignment phase. Indicates northbound speed. Indicates the eastward velocity error; The attitude error is expanded into components to obtain the azimuth attitude during the navigation solution stage. in, This indicates that the gyroscope is drifting.

2. The method according to claim 1, characterized in that, The initial condition is: , , , ,in, Indicates eastward speed. Indicates northbound speed. Indicates eastward acceleration. Indicates northward acceleration. Indicates the force to the east. Indicates northward comparison, Indicates the heavens are in opposition to the heavens. This indicates normal gravity.

3. The method according to claim 1, characterized in that, Under the condition that the position is accurately known, fine alignment is performed using velocity observations. Ignoring gravity disturbances, the eastward and northward acceleration errors during the initial alignment stage are calculated based on the initial conditions, including: Under the condition that the position is accurately known, when performing fine alignment using velocity observations and neglecting gravity disturbances, the eastward acceleration error in the initial alignment stage is calculated based on the initial conditions as follows: in, Indicating a northward orientation, Indicates normal gravity. Represents the Earth's rotational angular rate. Indicates geographical latitude, Indicates the northbound velocity error. This represents the horizontal component of the eastward gravitational disturbance. This indicates that the random constant of the accelerometer pointing east is zero bias; Under the condition that the position is accurately known, when performing fine alignment using velocity observations and neglecting gravity disturbances, the northward acceleration error in the initial alignment stage is calculated based on the initial conditions as follows: in, Indicating an eastward orientation, Indicates the eastward velocity error. This represents the horizontal component of the northward gravity disturbance. This indicates that the random constant of the accelerometer pointing north is zero bias.

4. The method according to any one of claims 1 to 3, characterized in that, The eastward and northward acceleration errors during the initial alignment phase are expanded and calculated to obtain the eastward and northward attitudes, including: The northward acceleration error during the initial alignment phase is calculated by expansion, yielding the eastward attitude as follows: in, Indicating a northward orientation, Indicates normal gravity. Represents the Earth's rotational angular rate. Indicates geographical latitude, Indicates northward acceleration error. This represents the horizontal component of the eastward gravitational disturbance. Indicating an eastward orientation, Indicates the eastward velocity error. This represents the horizontal component of the northward gravity disturbance. This indicates that the random constant of the accelerometer pointing north has zero bias. Meridian components representing vertical deviation; The eastward acceleration error during the initial alignment phase is calculated by expansion, yielding the northward attitude as follows: in, Indicates the northbound velocity error. Indicates the eastward acceleration error. This indicates that the random constant of the accelerometer pointing east has zero bias. The ramus-rostral component represents the deviation of the perpendicular line.

5. The method according to claim 4, characterized in that, The celestial attitude is in, Let be the radius of the surface of the meridian circle. For geographical altitude, This indicates that the gyroscope is drifting eastward.

6. The method according to claim 5, characterized in that, The east attitude error, north attitude error, and sky attitude error are calculated based on observable quantities in the east attitude, north attitude, and sky attitude, including: Due to the eastward posture All components are considerable, therefore the calculated eastward attitude error is: in, This indicates the zero bias error of the random constant of the accelerometer pointing north. This represents the horizontal component of the northward gravity disturbance; Due to the northward attitude All components are considerable, therefore the calculated northward attitude error is: in, This indicates the zero bias error of the random constant of the accelerometer pointing eastward. This represents the horizontal component of the eastward gravitational disturbance. Due to the celestial posture All components are observable, therefore the calculated celestial attitude error is: in, This indicates that the gyroscope is drifting eastward.

7. The method according to claim 1, characterized in that, The zero-mean random white noise includes zero-mean random white noise of velocity; a gyroscope observation error model is constructed using the gyroscope's random constant drift and zero-mean random white noise, including: The error model of the accelerometer is constructed by using the random constant drift of the gyroscope and the zero-mean random white noise of the velocity. in, Zero-mean random white noise representing velocity. The accelerometer has a random constant zero bias.

8. The method according to claim 7, characterized in that, The attitude error is calculated based on the gyroscope observation error model and the misalignment angle, including: The attitude error was calculated using the gyroscope observation error model and the misalignment angle. in, For misalignment angle, For the gyroscope output error in The projection under the system, This represents the gyroscope observation error model. Zero-mean random white noise representing the angle. For random constant drift of the gyroscope, For navigation system Frame of reference relative to inertial frame The rotation of the system Navigation system Frame of reference relative to inertial frame The rotation calculation error of the system, express Tie The attitude transition matrix of the system.

Citation Information

Patent Citations

  • Markov chain error transfer model of airborne platform collaborative integrated sensor system

    CN113341385A

  • Spacecraft inertia / fixed star starlight vector / solar Doppler velocity combined navigation method

    CN113551667A