Inertial navigation high-precision attitude angle rapid resolving method based on Kralov angle

By directly calculating the angular velocity equation and partial differential matrix of the Krelov angle, the error problem of the inertial navigation system in the discretization process is solved, high-precision inertial navigation is realized, and iterative calculation time is reduced, and it covers any posture angle. The navigation accuracy has been improved.

CN119022920APending Publication Date: 2024-11-26BEIJING INST OF AEROSPACE CONTROL DEVICES
View PDF 4 Cites 0 Cited by

Patent Information

Application Number
CN202410983850.1
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-22
Publication Date
2024-11-26

AI Technical Summary

Technical Problem

The existing inertial navigation system based on Krelov angle has large errors in the discretization process, and the iterative solution method requires multiple iterations to converge to the steady-state value, occupying more time resources.

Method used

By directly calculating the angular velocity equation of Krelov angle and its partial differential matrix, the precise discretization of the attitude angle of the inertial system is achieved, it avoids iterative calculations, and directly solves the values ​​of the yaw angle, pitch angle and roll angle, and updates the coordinate transformation. Matrix to improve navigation accuracy.

Benefits of technology

A significant improvement in inertial navigation accuracy has been achieved, and the single-step integrated solution calculation accuracy has been improved by 2 orders of magnitude, reducing calculation time, covering any posture angle situation, reducing quantization error, and directly giving the attitude angle of the body relative to the navigation coordinate system .

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119022920A_ABST
    Figure CN119022920A_ABST
Patent Text Reader

Abstract

The invention discloses an inertial navigation high-precision attitude angle rapid resolving method based on a Kralov angle. The method comprises the following steps: determining the Kralov angle and an angular velocity equation corresponding to the Kralov angle; calculating to obtain the value of the Kralov angle at the tk moment; when the angular velocity # imgabs0 # of the body coordinate system relative to the navigation coordinate system at the tk moment is determined, iterative calculation is not needed, three attitude angles can be directly solved, a coordinate transformation matrix can be updated, and speed updating and position updating are supported. According to the method, the output angular rates of the three gyroscopes orthogonally mounted on the strapdown inertial system body are used as input information based on the Kralov kinematics equation to realize real-time updating of the inertial navigation attitude angle, and the calculation precision can be improved under the condition of no iteration in the attitude angle updating process; and the reproduction precision of the body coordinate system relative to the navigation coordinate system is ensured. The strapdown inertial system discretization all-attitude resolving method based on the Kralov angle is given for the first time, and the method has the advantage of being high in precision.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to a high-precision attitude angle fast solution method for inertial navigation based on Krylov angle, in particular to a full attitude solution method for a strapdown inertial system based on Krylov angle, which is mainly used to realize full-attitude high-precision navigation in the fields of aviation and aerospace. Background Art

[0002] Inertial navigation is widely used in spacecraft, aircraft, ships and other fields. Its main function is to determine the position, velocity and attitude information of the carrier relative to the navigation system in real time. The strapdown inertial system is directly connected to the carrier, and measures the angular velocity through the gyroscope and gives the values ​​of the three attitude angles after mathematical solution.

[0003] At present, the methods for determining attitude information include direction cosine kinematic equations, Euler-Krylov angle kinematic equations, and quaternion kinematic equations. The disadvantage of the direction cosine kinematic equation is that the transformation matrix has 9 parameters and 6 connection equations, which is computationally intensive and is rarely used in engineering. The coordinate transformation matrix solved by quaternions is unique, but there is no unique solution when solving the attitude angle from the coordinate transformation matrix.

[0004] Relatively speaking, there are only three Euler-Krylov angle kinematic equations, but in the technical field of "Inertial Devices (Part 1)" (China Aerospace Press) on page 46, it is believed that the kinematic equations described by Euler-Krylov angles have singularities and the equations will degenerate. However, in the patent (ZL 202010333184.9), a posture solution method based on Krylov angles is proposed, which can realize the full posture motion description of the carrier. Assume that the angular velocity of the body of the strapdown inertial system relative to the navigation coordinate system is ψ and γ are Krylov angles, and the kinematic equation based on the Krylov angle is:

[0005]

[0006] But the problem is that formula (1) is a continuous equation, but it must be discretized in the engineering implementation process. The conventional discrete equation is

[0007]

[0008] However, the error caused by using the discretized equation of formula (2) to solve the navigation attitude angle is large. In order to reduce the error, a method for solving the attitude angle based on an iterative method is proposed in the patent (ZL 202110721264.6). This method improves the accuracy of the solution, but the disadvantage is that it requires multiple iterations to converge to the steady-state value, which takes up more time resources. In addition, in order to avoid endless iterative calculations, the difference in attitude angles between the previous and next iterations is set as the condition for stopping the iteration, and the difference will be directly used as the error of the attitude solution.

[0009] Therefore, it is necessary to study a new high-precision attitude angle solution method based on Krylov angle to improve the accuracy of inertial navigation. Summary of the invention

[0010] The technical problem to be solved by the present invention is: to overcome the deficiencies of the prior art, to realize the accurate discretization of the attitude angle differential equation of the strapdown inertial system without iterative solution, to ensure the accurate description of the body of the strapdown inertial system relative to the navigation coordinate system, and to improve the navigation accuracy of the strapdown inertial system based on the Krylov angle description.

[0011] The purpose of the present invention is achieved through the following technical solutions:

[0012] A method for quickly calculating high-precision attitude angle of inertial navigation based on Krylov angle, comprising:

[0013] Determine the Krylov angle (φ, ψ, γ). The Krylov angle (φ, ψ, γ) is used to describe the relationship between the navigation coordinate system and the body coordinate system. The navigation coordinate system reaches the body coordinate system after three rotations. The rotation angles corresponding to the three rotations are recorded as the yaw angle φ, the pitch angle ψ and the roll angle γ respectively;

[0014] The yaw angle φ, pitch angle ψ and roll angle γ are calculated at t k The values ​​at the time are recorded as: k , k and γ k ;

[0015] Determine the rotation process, t k The angular velocity of the body coordinate system relative to the navigation coordinate system at time According to the rotation process, the angular velocity equation corresponding to the Krylov angle (γ, ψ, φ) is obtained to determine the partial differential matrix of the angular velocity function vector, where the angular velocity equation is:

[0016]

[0017] In the formula, is the angular velocity function vector, for The corresponding angular velocity function is, for The corresponding angular velocity function is, for The corresponding angular velocity function.

[0018] Partial differential matrix of angular velocity function vector

[0019]

[0020] Determine t k Moment of γk , k ,φ k and And the angular velocity vector function Let ΔT represent the sampling time, t k+ 1 = t k +ΔT, the interval [t k ,t k+1 ] is divided into n subintervals: [t k ,t k +ΔT / n], [t k +ΔT / n,t k +2ΔT / n],…,[t k -ΔT / n,t k+1 ], calculate the updated value

[0021]

[0022] Get the solution result γ k+1 , k+1 and φ k+1 ;

[0023] According to the solution results, the coordinate transformation matrix is ​​updated, and the velocity update and position update are supported to improve the accuracy of inertial navigation.

[0024] In one embodiment of the present invention, the body coordinate system corresponding to the strapdown inertial system is recorded as Ox′y′z′, which is a moving system; wherein the Ox′ axis represents the longitudinal axis of the carrier, the Oz′ axis represents the transverse axis of the carrier, and the Oy′ axis, the Ox′ axis and the Oz′ axis form a right-handed coordinate system;

[0025] The navigation coordinate system corresponding to the carrier motion attitude angle is recorded as O-xyz, which is a fixed system; wherein, at the initial moment, the Ox axis points to the east, the Oy axis points to the north, and the Oz axis points to the sky;

[0026] The origins of the body coordinate system Ox′y′z′ and the navigation coordinate system O-xyz coincide, and both take the geometric center of the body of the strapdown inertial system as the origin.

[0027] In one embodiment of the present invention, during the rotation process, t k The angular velocity of the body coordinate system relative to the navigation coordinate system at time include:

[0028] During the rotation process, obtain t k The angular velocity output by the gyroscope at this moment: Among them, the gyroscope is installed on the strapdown inertial system body; and t kThe three-axis angular velocity components of the body coordinate system at time t k The angular velocity of the body coordinate system relative to the navigation coordinate system at time for:

[0029]

[0030] In one embodiment of the present invention, the rotation process from the navigation coordinate system to the body coordinate system is selected from one of the following six situations:

[0031] (1) z→y→x rotation

[0032] The navigation coordinate system O-xyz rotates around the Oz axis by an angle of φ1 to reach O-LNz; O-LNz then rotates around the ON axis by an angle of ψ1 to reach Ox′NM; finally, Ox′NM rotates around the Ox′ axis by an angle of γ1 to reach Ox′y′z′.

[0033] The angular velocity equation is

[0034]

[0035] The angular velocity vector and its partial differential matrix are

[0036]

[0037] The coordinate transformation matrix is

[0038]

[0039] (2) z→x→y rotation

[0040] The navigation coordinate system Oxyz rotates around the Oz axis by an angle of φ2 to reach O-LNz; O-LNz then rotates around the OL axis by an angle of γ2 to reach O-Ly′M; finally, O-Ly′M rotates around the Oy′ axis by an angle of ψ2 to reach Ox′y′z′.

[0041] The angular velocity equation is

[0042]

[0043] The angular velocity vector and its partial differential matrix are

[0044]

[0045] The coordinate transformation matrix is

[0046]

[0047] (3) x→z→y rotation

[0048] The navigation coordinate system O-xyz rotates around the Ox axis by an angle of γ3 to reach O-xNM; O-xNM then rotates around the OM axis by an angle of φ3 to reach OLy′M; finally, OLy′M rotates around the Oy′ axis by an angle of ψ3 to reach Ox′y′z′.

[0049] The angular velocity equation is

[0050]

[0051] The angular velocity vector and its partial differential matrix are

[0052]

[0053] The coordinate transformation matrix is

[0054]

[0055] (4) y→z→x rotation

[0056] The navigation coordinate system O-xyz rotates around the Oy axis by an angle of ψ4 to reach O-LyM; O-LyM then rotates around the OM axis by an angle of φ4 to reach Ox′NM; finally, Ox′NM rotates around the Ox′ axis by an angle of γ4 to reach Ox′y′z′.

[0057] The angular velocity equation is

[0058]

[0059] The angular velocity vector and its partial differential matrix are

[0060]

[0061] The coordinate transformation matrix is

[0062]

[0063] (5) x→y→z rotation

[0064] The navigation coordinate system Oxyz rotates around the Ox axis by an angle of γ5 to reach OxNM; OxNM then rotates around the ON axis by an angle of ψ5 to reach OLNz′; finally, OLNz′ rotates around the Oz′ axis by an angle of φ5 to reach Ox′y′z′.

[0065] The angular velocity equation is

[0066]

[0067] The angular velocity vector and its partial differential matrix are

[0068]

[0069] The coordinate transformation matrix is

[0070]

[0071] (6) y→x→z rotation

[0072] The navigation coordinate system Oxyz rotates around the Oy axis by an angle of ψ6 to reach OLyM; OLyM then rotates around the OL axis by an angle of γ6 to reach OLNz′; finally, OLNz′ rotates around the Oz′ axis by an angle of γ6 to reach Ox′y′z′.

[0073] The angular velocity equation is

[0074]

[0075] The angular velocity vector and its partial differential matrix are

[0076]

[0077] The coordinate transformation matrix is

[0078]

[0079] In one embodiment of the present invention, based on the solution result, the support speed update and position update include:

[0080] according to ψ k+1 and γ k+1 Update the coordinate transformation matrix and update the updated coordinate transformation matrix and apparent acceleration and the acceleration due to gravity As the velocity differential equation After the input is integrated and solved, the updated speed V is obtained;

[0081] The updated velocity V is used as the position differential equation After integral solution, the updated position r is obtained.

[0082] Compared with the prior art, the present invention has the following beneficial effects:

[0083] (1) The invention provides a high-precision attitude angle fast solution method based on Krylov angle for inertial navigation. Compared with the attitude angle solved by single-step integration, the accuracy is improved by more than 2 orders of magnitude, thus realizing high-precision solution of attitude angle.

[0084] (2) The present invention provides a method for quickly calculating the high-precision attitude angle of inertial navigation based on the Krylov angle. Compared with the attitude angle calculated by iterative integration, the accuracy is improved, and the time for one-step calculation is greatly reduced compared with the time for multiple-step calculation.

[0085] (3) The method of the present invention completely covers the situation where the three attitude angles are in any quadrant, and effectively reduces the problem of large dynamic error caused by quantization error due to discretization when the ψ angle is ±90° in the original technology;

[0086] (4) The present invention provides a high-precision attitude angle solution method for inertial navigation based on the Krylov angle, which can directly and accurately give the attitude angle of the body relative to the navigation coordinate system, while the quaternion can only be given indirectly through the coordinate transformation matrix. BRIEF DESCRIPTION OF THE DRAWINGS

[0087] Figure 1 It is a schematic diagram of the relationship between the body described by the Krylov angle described by the z→y→x rotation in the strapdown inertial system and the navigation coordinate system;

[0088] Figure 2 It is a schematic diagram of the relationship between the body described by the Krylov angle described by the z→x→y rotation in the strapdown inertial system and the navigation coordinate system;

[0089] Figure 3 It is a schematic diagram of the relationship between the body described by the Krylov angle described by the x→z→y rotation in the strapdown inertial system and the navigation coordinate system;

[0090] Figure 4 It is a schematic diagram of the relationship between the body described by the Krylov angle described by the y→z→x rotation in the strapdown inertial system and the navigation coordinate system;

[0091] Figure 5 It is a schematic diagram of the relationship between the body described by the Krylov angle described by the x→y→z rotation in the strapdown inertial system and the navigation coordinate system;

[0092] Figure 6 It is a schematic diagram of the relationship between the body described by the Krylov angle described by the y→x→z rotation in the strapdown inertial system and the navigation coordinate system;

[0093] Figure 7 The invention is used to integrally solve the three attitude angles of the aircraft in the process of three turns of rolling described by the rotation of z→y→x;

[0094] Figure 8 The invention is used to integrally solve the three attitude angles of the aircraft in the process of three turns of rolling described by the rotation of z→x→y;

[0095] Fig. 9 The invention is used to integrally solve the three attitude angles of the aircraft in the process of three turns of rolling described by the rotation of x→z→y;

[0096] Fig.10 The invention is used to integrally solve the three attitude angles of the aircraft in the process of three turns of rolling described by the rotation of y→z→x;

[0097] Fig.11 The invention is used to integrally solve the three attitude angles of the aircraft in the process of three turns of rolling described by the rotation of x→y→z;

[0098] Fig.12 The invention is used to integrally solve the three attitude angles of the aircraft in the process of three turns of rolling described by y→x→z rotation;

[0099] Fig.13 A three-dimensional trajectory of aircraft motion for navigation solution based on the attitude angle calculated by the present invention;

[0100] Fig.14 The figure is a flow chart of the steps of the method of the present invention. DETAILED DESCRIPTION

[0101] In order to make the objectives, technical solutions and advantages of the present invention more clear, the embodiments of the present invention will be further described in detail below with reference to the accompanying drawings.

[0102] A high-precision attitude angle fast solution method for inertial navigation based on Krylov angle, comprising: determining the Krylov angle and the angular velocity equation corresponding to the Krylov angle; calculating the Krylov angle at t k The value at time; determine t k The angular velocity of the body coordinate system relative to the navigation coordinate system at time Without iterative calculation, the three attitude angles can be directly solved and the coordinate transformation matrix can be updated, and the speed update and position update can be supported. The present invention uses the output angular rates of the three gyroscopes orthogonally installed on the strapdown inertial system body as the input information based on the Krylov kinematic equation to realize the real-time update of the inertial navigation attitude angle. In the attitude angle update process, the solution accuracy can be improved without iteration, and the reproduction accuracy of the body coordinate system relative to the navigation coordinate system is guaranteed. The present invention provides a discretized full attitude solution method for a strapdown inertial system based on the Krylov angle for the first time, which has the advantage of high accuracy.

[0103] A high-precision attitude angle solution method for inertial navigation based on Krylov angle is implemented based on a strapdown inertial system fixed to a carrier, wherein a body coordinate system (b system, a moving system) corresponding to the strapdown inertial system is Ox′y′z′; a navigation coordinate system (p system, a fixed system) corresponding to the carrier motion attitude angle is O-xyz; the origins of the two coordinate systems coincide, and the relationship between the two coordinate systems is described by using Krylov angle, and the navigation coordinate system reaches the body coordinate system after three rotations.

[0104] The body coordinate system corresponding to the strapdown inertial system is recorded as Ox′y′z′, which is a moving system; wherein the Ox′ axis represents the longitudinal axis of the carrier, the Oz′ axis represents the transverse axis of the carrier, and the Oy′ axis, the Ox′ axis and the Oz′ axis form a right-handed coordinate system;

[0105] The navigation coordinate system corresponding to the carrier motion attitude angle is recorded as O-xyz, which is a fixed system; wherein, at the initial moment, the Ox axis points to the east, the Oy axis points to the north, and the Oz axis points to the sky;

[0106] The origins of the body coordinate system Ox′y′z′ and the navigation coordinate system O-xyz coincide, and both take the geometric center of the body of the strapdown inertial system as the origin.

[0107] The rotation process from the navigation coordinate system to the body coordinate system selects one of the following six situations:

[0108] (1) z→y→x rotation, such as Figure 1 and 7 shown.

[0109] The navigation coordinate system O-xyz rotates around the Oz axis by an angle of φ1 to reach O-LNz; O-LNz then rotates around the ON axis by an angle of ψ1 to reach Ox′NM; finally, Ox′NM rotates around the Ox′ axis by an angle of γ1 to reach Ox′y′z′.

[0110] The angular velocity equation is

[0111]

[0112] The angular velocity vector and its partial differential matrix are

[0113]

[0114] The coordinate transformation matrix is

[0115]

[0116] (2) z→x→y rotation, such as Figure 2 and 8 shown.

[0117] The navigation coordinate system Oxyz rotates around the Oz axis by an angle of φ2 to reach O-LNz; O-LNz then rotates around the OL axis by an angle of γ2 to reach O-Ly′M; finally, O-Ly′M rotates around the Oy′ axis by an angle of ψ2 to reach Ox′y′z′.

[0118] The angular velocity equation is

[0119]

[0120] The angular velocity vector and its partial differential matrix are

[0121]

[0122]

[0123] The coordinate transformation matrix is

[0124]

[0125] (3) x→z→y rotation, such as Figure 3 and 9 shown.

[0126] The navigation coordinate system O-xyz rotates around the Ox axis by an angle of γ3 to reach O-xNM; O-xNM then rotates around the OM axis by an angle of φ3 to reach OLy′M; finally, OLy′M rotates around the Oy′ axis by an angle of ψ3 to reach Ox′y′z′.

[0127] The angular velocity equation is

[0128]

[0129] The angular velocity vector and its partial differential matrix are

[0130]

[0131] The coordinate transformation matrix is

[0132]

[0133] (4) y→z→x rotation, such as Figure 4 and 10 shown.

[0134] The navigation coordinate system O-xyz rotates around the Oy axis by an angle of ψ4 to reach O-LyM; O-LyM then rotates around the OM axis by an angle of φ4 to reach Ox′NM; finally, Ox′NM rotates around the Ox′ axis by an angle of γ4 to reach Ox′y′z′.

[0135] The angular velocity equation is

[0136]

[0137] The angular velocity vector and its partial differential matrix are

[0138]

[0139] The coordinate transformation matrix is

[0140]

[0141] (5) x→y→z rotation, such as Figure 5 and 11 shown.

[0142] The navigation coordinate system Oxyz rotates around the Ox axis by an angle of γ5 to reach OxNM; OxNM then rotates around the ON axis by an angle of ψ5 to reach OLNz′; finally, OLNz′ rotates around the Oz′ axis by an angle of φ5 to reach Ox′y′z′.

[0143] The angular velocity equation is

[0144]

[0145] The angular velocity vector and its partial differential matrix are

[0146]

[0147] The coordinate transformation matrix is

[0148]

[0149] (6) y→x→z rotation, such as Figure 6 and 12 shown.

[0150] The navigation coordinate system Oxyz rotates around the Oy axis by an angle of ψ6 to reach OLyM; OLyM then rotates around the OL axis by an angle of γ6 to reach OLNz′; finally, OLNz′ rotates around the Oz′ axis by an angle of γ6 to reach Ox′y′z′.

[0151] The angular velocity equation is

[0152]

[0153] The angular velocity vector and its partial differential matrix are

[0154]

[0155] The coordinate transformation matrix is

[0156]

[0157] The implementation steps of the high-precision attitude angle fast solution method based on Krylov angle inertial navigation are as follows ( Fig.13 and 14 shown):

[0158] (1) Calculate the yaw angle φ, pitch angle ψ and roll angle γ at t k The values ​​at the time are recorded as: k , k and γ k ;

[0159] (2) Determine the rotation process, t k The angular velocity of the body coordinate system relative to the navigation coordinate system at time

[0160] (3) Assume the sampling time is ΔT, then at the next moment t k+1 =t k The three attitude angles of +ΔT are obtained according to the rotation process to obtain the angular velocity function vector corresponding to the Krylov angle (γ, ψ, φ) and its partial differential matrix

[0161] (4) The interval [t k ,t k+1 ] is divided into n subintervals: [t k ,t k +ΔT / n], [t k +ΔT / n,t k +2ΔT / n],…,[t k -ΔT / n,t k+1 ], calculate the updated value

[0162]

[0163] Get k+1 The attitude angle solution result at the moment γ k+1 , k+1 and φ k+1 ; According to the solution results, update the coordinate transformation matrix, and support velocity update and position update to improve the accuracy of inertial navigation.

[0164] In step (1), the rotation angles γ, ψ, and φ range from -180° to +180°.

[0165] The gyroscope installed on the main body is a dual-degree-of-freedom gyroscope, and the number needs to be at least two, which are installed orthogonally.

[0166] The gyroscope installed on the main body is a single-degree-of-freedom gyroscope, and the number needs to be at least three, installed orthogonally in pairs.

[0167] Embodiment 1:

[0168] Suppose there is a differential equation

[0169]

[0170] When a=1、x k | t=0 =1, ΔT = 1 × 10 -3 , find x k+1 | t=ΔT The value of .

[0171] Solution: Find the solution of the differential equation given by

[0172]

[0173] The expression of x is x=e at , and the true value at time ΔT is

[0174] 1) When the conventional integration method is used, we have

[0175]

[0176] The error between the true value and the -7 .

[0177] 2) When the iterative integration method is used, there is

[0178] x k+1,1 =x k | t=0 +x k | t=0 ×10 -3 =1.001

[0179] x k+1,2 =x k | t=0 +0.5(x k | t=0 +x k+1,1 )×10 -3 =1.0010005

[0180] x k+1,3 =x k | t=0 +0.5(x k | t=0 +x k+1,2 )×10 -3 =1.00100050025

[0181] x k+1,4 =x k | t=0 +0.5(x k | t=0 +x k+1,3 )×10 -3 =1.001000500250125

[0182] x k+1,5 =x k | t=0 +0.5(x k | t=0 +x k+1,4 )×10 -3 =1.001000500250125

[0183] Gradually converges to a stable value, and the error between it and the true value is 9.0125× -11 .

[0184] 3) When n=1, using the integration method of the present invention, we have

[0185]

[0186] It can be seen that the error between the calculated result and the true value is 9.0×10 -11 , which is of basically the same magnitude as the iterative method, but closer to the true value.

[0187] The contents not described in detail in the specification of the present invention belong to the common knowledge of those skilled in the art.

[0188] Although the present invention has been disclosed as above in the form of a preferred embodiment, it is not intended to limit the present invention. Any person skilled in the art may make possible changes and modifications to the technical solution of the present invention by using the methods and technical contents disclosed above without departing from the spirit and scope of the present invention. Therefore, any simple modifications, equivalent changes and modifications made to the above embodiments based on the technical essence of the present invention without departing from the content of the technical solution of the present invention shall fall within the protection scope of the technical solution of the present invention.

Claims

1. A high-precision attitude angle fast solution method for inertial navigation based on Krylov angle, characterized in that: include: Determine the Krylov angles (φ, ψ, γ). The Krylov angles (φ, ψ, γ) are used to describe the relationship between the navigation coordinate system and the body coordinate system. The navigation coordinate system reaches the body coordinate system after three rotations. The corresponding rotation angles of the three rotations are recorded as the yaw angle φ, the pitch angle ψ, and the roll angle γ respectively. The yaw angle φ, pitch angle ψ and roll angle γ are calculated at t k The values ​​at the time are respectively denoted as: k , ψ k and γ k ; Determine the rotation process, t k The angular velocity of the body coordinate system relative to the navigation coordinate system at time According to the rotation process, the angular velocity equation corresponding to the Krylov angle (γ, ψ, φ) is obtained to determine the partial differential matrix of the angular velocity function vector, where the angular velocity equation is: Partial differential matrix of angular velocity function vector Where, is the angular velocity function vector, for The corresponding angular velocity function is, for The corresponding angular velocity function is, for The corresponding angular velocity function; Assume the sampling time is ΔT, t k+ 1 = t k +ΔT, the interval [t k ,t k+1 ] is divided into n subintervals: [t k ,t k +ΔT / n], [t k +ΔT / n,t k +2ΔT / n],…,[t k -ΔT / n,t k+1 ], use the following formula to calculate the updated value: Get t k+1 The attitude angle solution result at the moment γ k+1 , ψ k+1 and φ k+1 ; Using t k+1 The attitude angle solution at the moment determines the coordinate transformation matrix, which is further used to determine the speed and position.

2. The high-precision attitude angle rapid calculation method for inertial navigation according to claim 1 is characterized in that: The body coordinate system corresponding to the strapdown inertial system is recorded as Ox′y′z′, which is a moving system; among them, the Ox′ axis represents the longitudinal axis of the carrier, the Oz′ axis represents the transverse axis of the carrier, and the Oy′ axis, Ox′ axis and Oz′ axis form a right-handed coordinate system; The navigation coordinate system corresponding to the carrier's motion attitude angle is denoted as O-xyz, which is the fixed system. At the initial moment, the Ox axis points to the east, the Oy axis points to the north, and the Oz axis points to the sky. The origins of the body coordinate system Ox′y′z′ and the navigation coordinate system O-xyz coincide, and both take the geometric center of the body of the strapdown inertial system as their origins.

3. The method for rapidly calculating high-precision attitude angles of inertial navigation according to claim 2, characterized in that: The navigation coordinate system rotates to the body coordinate system in the order of z→y→x: The navigation coordinate system O-xyz rotates around the Oz axis by an angle of φ1 to reach O-LNz; O-LNz then rotates around the ON axis by an angle of ψ1 to reach Ox′NM; finally, Ox′NM rotates around the Ox′ axis by an angle of γ1 to reach Ox′y′z′; The angular velocity equation is The angular velocity vector and its partial differential matrix are The coordinate transformation matrix is 4. The method for rapidly calculating high-precision attitude angles of inertial navigation according to claim 2, characterized in that: The navigation coordinate system rotates to the body coordinate system in the order of z→x→y: The navigation coordinate system Oxyz rotates around the Oz axis by an angle of φ2 to reach O-LNz; O-LNz then rotates around the OL axis by an angle of γ2 to reach O-Ly′M; finally, O-Ly′M rotates around the Oy′ axis by an angle of ψ2 to reach Ox′y′z′; The angular velocity equation is The angular velocity vector and its partial differential matrix are The coordinate transformation matrix is 5. The method for rapidly calculating high-precision attitude angles of inertial navigation according to claim 2, characterized in that: The navigation coordinate system rotates to the body coordinate system in the order of x→z→y: The navigation coordinate system O-xyz rotates around the Ox axis by an angle of γ3 to reach O-xNM; O-xNM then rotates around the OM axis by an angle of φ3 to reach OLy′M; finally, OLy′M rotates around the Oy′ axis by an angle of ψ3 to reach Ox′y′z′; The angular velocity equation is The angular velocity vector and its partial differential matrix are The coordinate transformation matrix is 6. The method for rapidly calculating high-precision attitude angles of inertial navigation according to claim 2, characterized in that: The navigation coordinate system rotates to the body coordinate system in the order of y→z→x: The navigation coordinate system O-xyz rotates around the Oy axis by an angle of ψ4 to reach O-LyM; O-LyM then rotates around the OM axis by an angle of φ4 to reach Ox′NM; finally, Ox′NM rotates around the Ox′ axis by an angle of γ4 to reach Ox′y′z′; The angular velocity equation is The angular velocity vector and its partial differential matrix are The coordinate transformation matrix is 7. The method for rapidly calculating high-precision attitude angles of inertial navigation according to claim 2, characterized in that: The navigation coordinate system rotates to the body coordinate system in the order of x→y→z: The navigation coordinate system Oxyz rotates around the Ox axis by an angle of γ5 to reach OxNM; OxNM then rotates around the ON axis by an angle of ψ5 to reach OLNz′; finally, OLNz′ rotates around the Oz′ axis by an angle of φ5 to reach Ox′y′z′; The angular velocity equation is The angular velocity vector and its partial differential matrix are The coordinate transformation matrix is 8. The method for rapidly calculating high-precision attitude angles of inertial navigation according to claim 2, characterized in that: The navigation coordinate system rotates to the body coordinate system in the order of y→x→z: The navigation coordinate system Oxyz rotates around the Oy axis by an angle of ψ6 to reach OLyM; OLyM then rotates around the OL axis by an angle of γ6 to reach OLNz′; finally, OLNz′ rotates around the Oz′ axis by an angle of γ6 to reach Ox′y′z′; The angular velocity equation is The angular velocity vector and its partial differential matrix are The coordinate transformation matrix is 9. The method for rapidly calculating high-precision attitude angles of inertial navigation according to claim 1, characterized in that: Using t k+1 The attitude angle solution result at the moment φ k+1 , ψ k+1 and γ k+1 Update the coordinate transformation matrix and update the updated coordinate transformation matrix and apparent acceleration and gravitational acceleration As the velocity differential equation After the input is integrated and solved, the updated speed V is obtained; The updated velocity V is used as the position differential equation After the integral solution, the updated position r is obtained.

10. The method for rapidly calculating high-precision attitude angles of inertial navigation according to claim 1, characterized in that: During the rotation process, obtain t k The angular velocity output by the gyroscope at this moment: Among them, the gyroscope is installed on the strapdown inertial system body; and t k The three-axis angular velocity components of the body coordinate system at the moment t k The angular velocity of the body coordinate system relative to the navigation coordinate system at time for:

Citation Information

Patent Citations

  • Attitude calculation algorithm and device and vehicle-mounted inertial navigation system

    CN110879066A

  • Inertial navigation attitude angle calculation method and system based on extended Krylov angle

    CN113447024A

  • Inertial navigation high-precision attitude angle calculation method and system based on Krylov angle

    CN113447025A

  • Method for determining object orientation parameters using semi-analytical inertial navigation system with geographical orientation of four-axis gyroplatform axes

    RU2782334C1