Inertial navigation six-parameter coordinate transformation accurate resolving method based on trigonometric function

Through the inertial navigation six-parameter coordinate transformation method based on trigonometric functions, the coordinate transformation matrix is ​​updated in real time, and the problems of high-order truncation error and large calculation amount in the existing technology are solved, and high-precision and fast navigation solution are achieved.

CN118999538APending Publication Date: 2024-11-22BEIJING INST OF AEROSPACE CONTROL DEVICES
View PDF 0 Cites 0 Cited by

Patent Information

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

AI Technical Summary

Technical Problem

The existing six-parameter coordinate transformation matrix solution method of inertial navigation has high-order truncation errors and large calculations, which affects navigation accuracy and speed.

Method used

Using the accurate solution method of inertial navigation six-parameter coordinate transformation based on trigonometric functions, the coordinate transformation matrix is ​​updated in real time by installing orthogonal angular velocity of the gyroscope output with a strap-in inertial system to avoid iterative calculations and singular values, and reduce computational complexity. Spend.

Benefits of technology

It improves navigation accuracy and speed, realizes full-pose solution, simplifies engineering implementation, and reduces calculation complexity and error.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118999538A_ABST
    Figure CN118999538A_ABST
Patent Text Reader

Abstract

The invention relates to an inertial navigation six-parameter coordinate transformation accurate resolving method based on a trigonometric function. The method comprises the following steps: determining six parameters of a coordinate change matrix as variables; and according to the coordinate transformation matrix and the angular velocity, updating the selected six parameters, calculating the updated coordinate transformation matrix, and updating the support velocity and the position. According to the method, the angular rate is used as input, the inertial navigation coordinate transformation matrix can be updated in real time, the calculation complexity is reduced, and the calculation precision is relatively high.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to an accurate calculation method for six-parameter coordinate transformation of inertial navigation based on trigonometric functions, which is applied to the technical field of inertial navigation. 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 the angular velocity is measured by the gyroscope and the coordinate transformation matrix of the carrier coordinate system relative to the navigation coordinate system is obtained after mathematical solution.

[0003] The patent (CN202310483308.5) "Inertial Navigation 6-parameter Coordinate Transformation Matrix Solution Method" uses a six-level fifth-order England numerical integration method, which has high-order truncation errors. In addition, it requires iterative calculations, which is a lot of work. In order to overcome the lack of accuracy caused by the truncation error of numerical integration and solve the problem of large calculation amount of the six-level fifth-order England numerical integration method, it is necessary to study a new solution method for the carrier coordinate system relative to the navigation system to improve the speed and accuracy of inertial navigation and flight control. Summary of the invention

[0004] The technical problem to be solved by the present invention is: to overcome the deficiencies of the prior art, to provide an accurate solution method for six-parameter coordinate transformation of inertial navigation based on trigonometric functions, and to improve the speed and accuracy of inertial navigation and flight control.

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

[0006] An accurate solution method for six-parameter coordinate transformation of inertial navigation based on trigonometric functions takes the angular rate output by the gyroscope on the orthogonally mounted strapdown inertial system body as the input information of the six-parameter kinematic equation of the coordinate transformation matrix. The real-time update of the inertial navigation coordinate transformation matrix is ​​realized through trigonometric solution processing. No singular values ​​appear in the solution process, thus ensuring the full attitude of the body coordinate system relative to the navigation coordinate system and the requirement of small calculation amount.

[0007] A method for accurately calculating six-parameter coordinate transformation of inertial navigation based on trigonometric functions, comprising:

[0008] Calculate t k The coordinate transformation matrix of the strapdown navigation system's main coordinate system relative to the navigation coordinate system;

[0009] According to the angular rate output by the gyroscope installed on the strapdown inertial system body, calculate t k The angular velocity and angular increment of the body coordinate system relative to the navigation coordinate system at that moment;

[0010] According to the coordinate transformation matrix and the angular velocity, the selected six parameters are updated and solved, and the updated coordinate transformation matrix is ​​solved;

[0011] According to the updated coordinate transformation matrix, the velocity and position are updated.

[0012] Furthermore, in the above solution method, the calculation t k The coordinate change matrix of the strapdown navigation system's main coordinate system relative to the navigation coordinate system is:

[0013]

[0014] Among them, a 21,k 、a 22,k 、a 23,k 、a 31,k 、a 32,k 、a 33,k t k The six parameters selected from the coordinate transformation matrix at the moment are used to calculate a using the constraint equation 11,k 、a 12,k 、a 13,k :

[0015] a 11,k =a 22,k a 33,k -a 32,k a 23,k

[0016] a 12,k =a 31,k a 23,k -a 21,k a 33,k

[0017] a 13,k =a 21,k a 32,k -a 31,k a 22,k

[0018] Furthermore, in the above-mentioned solution method, the angular rate output by the gyroscope installed on the strapdown inertial system body is used to calculate t k The angular velocity of the body relative to the navigation system at this moment is:

[0019]

[0020] where ω xb ,ω yb ,ω zb are the angular velocities of the x, y, and z axes of the body coordinate system, respectively.

[0021] At the same time, the angle increment Δθ can be obtained. The specific calculation method is:

[0022]

[0023] Where ΔT is the update interval time.

[0024] Furthermore, in the above-mentioned solution method, the six selected parameters are updated and solved according to the coordinate transformation matrix and the angular velocity, and the updated coordinate transformation matrix is ​​solved, specifically:

[0025]

[0026] Among them, a 11,k+1 、a 12,k+1 、a 13,k+1 、a 21,k+1 、a 22,k+1 、a 23,k+1 、a 31,k+1 、a 32,k+1 and a 33,k+1 These are the updated 9 parameters.

[0027] The calculation method of the nine parameters is as follows:

[0028]

[0029] as well as

[0030] a 11,k+1 =a 22,k+1 a 33,k+1 -a 32,k+1 a 23,k+1

[0031] a 12,k+1 =a 31,k+1 a 23,k+1 -a 21,k+1 a 33,k+1

[0032] a 13,k+1 =a 21,k+1 a 32,k+1 -a 31,k+1 a 22,k+1 .

[0033] Furthermore, in the above-mentioned solution method, the speed update and position update are performed according to the coordinate transformation matrix obtained by solution, specifically:

[0034] When the p system is an inertial system, the navigation equation is:

[0035]

[0036] in, is the updated coordinate transformation matrix, is the apparent acceleration, is the acceleration due to gravity, is the velocity vector, is the position vector.

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

[0038] (1) The present invention uses trigonometric functions to update and solve the coordinate transformation matrix. Compared with the numerical integration method, there is no truncation error and it has higher accuracy.

[0039] (2) The present invention does not require iterative calculation and can directly solve the coordinate transformation matrix parameters, with fast calculation speed and low complexity.

[0040] (3) There are no singular points in the solution process of the present invention, and the full attitude solution of the aircraft can be achieved.

[0041] (4) The present invention discloses a method for accurately solving the six-parameter coordinate transformation matrix of inertial navigation based on trigonometric functions, which has a simple structure and is easy to implement in engineering. BRIEF DESCRIPTION OF THE DRAWINGS

[0042] Figure 1 It is a flow chart of the steps of a method for accurately calculating a six-parameter coordinate transformation matrix of inertial navigation based on trigonometric functions in an embodiment of the present invention;

[0043] Figure 2 It is a schematic diagram of the relationship between the strapdown inertial system body and the navigation coordinate system;

[0044] Figure 3 The present invention is based on the change process of nine parameters of the coordinate transformation matrix calculated by the accurate calculation method of the six-parameter coordinate transformation matrix of inertial navigation based on trigonometric functions during the three-turn process of the aircraft;

[0045] Figure 4 It is the solution result of the prior art "inertial navigation six-parameter coordinate transformation matrix solution method";

[0046] Figure 5 It is the result of the accurate calculation method of the six-parameter coordinate transformation matrix of inertial navigation based on trigonometric functions of the present invention. DETAILED DESCRIPTION

[0047] 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.

[0048] A method for accurately solving six-parameter coordinate transformation of inertial navigation based on trigonometric functions includes: determining six parameters of the coordinate change matrix as variables; updating the selected six parameters according to the coordinate transformation matrix and angular velocity, and solving the updated coordinate transformation matrix to support speed update and position update. The method uses angular velocity as input, can update the inertial navigation coordinate transformation matrix in real time, reduces the calculation complexity and has higher solution accuracy.

[0049] The steps of the method for accurately calculating the six-parameter coordinate transformation matrix of inertial navigation based on trigonometric functions of the present invention are as follows: Figure 1 The accurate solution method of the six-parameter coordinate transformation matrix of inertial navigation based on trigonometric functions includes:

[0050] like Figure 2 As shown, it is realized based on a strapdown inertial navigation system fixed to the carrier. The body coordinate system (b system, the moving system) corresponding to the strapdown inertial system is Ox'y'z'; the navigation coordinate system (p system, the fixed system) describing the rotational motion of the carrier is Oxyz; the origins of the two coordinate systems coincide. During the rotation process, the angular velocity of the body of the strapdown inertial system relative to the navigation coordinate system is The steps for implementing the accurate solution method of the six-parameter coordinate transformation matrix of inertial navigation based on trigonometric functions are as follows:

[0051] (1) Calculate t k The coordinate transformation matrix of the strapdown navigation system's main coordinate system relative to the navigation coordinate system is:

[0052]

[0053] Among them, a 21,k 、a 22,k 、a 23,k 、a 31,k 、a 32,k 、a 33,k t k The six parameters selected from the coordinate transformation matrix at the moment are used to calculate a using the constraint equation 11,k 、a 12,k 、a 13,k :

[0054] a 11,k =a 22,k a 33,k -a 32,k a 23,k

[0055] a 12,k =a 31,k a 23,k -a 21,k a 33,k

[0056] a 13,k =a 21,k a 32,k -a 31,k a 22,k

[0057] (2) Calculate t based on the angular rate output by the gyroscope installed on the strapdown inertial system body. k The angular velocity of the body relative to the navigation system at this moment At the same time, the angle increase Δθ can be obtained. The specific calculation method is: Where ΔT is the sampling time interval.

[0058] (3) Nine parameters a 11,k 、a 12,k 、a 13,k 、a 21,k 、a 22,k 、a 23,k 、a 31,k 、a 32,k 、a 33,k At the next moment t k+1 =t k +ΔT value a 11,k+1 、a 11,k+1 、a 13,k+1 、a 21,k+1 、a 22,k+1 、a 23,k+1 、a 31,k+1 、a 32,k+1 、a 33,k+1 , the specific calculation formula is as follows:

[0059] as well as

[0060] a 11,k+1 =a 22,k+1 a 33,k+1 -a 32,k+1 a 23,k+1

[0061] a 12,k+1 =a 31,k+1 a 23,k+1 -a 21,k+1 a 33,k+1

[0062] a 13,k+1 =a 21,k+1 a 32,k+1 -a 31,k+1 a 22,k+1 .

[0063] (4) Based on the updated coordinate transformation matrix, support velocity update and position update to improve inertial navigation accuracy.

[0064] The gyroscopes installed on the strapdown inertial system body are three single-degree-of-freedom gyroscopes or two double-degree-of-freedom gyroscopes.

[0065] In step (4), the updated coordinate transformation matrix and apparent acceleration and the acceleration due to gravity As the velocity differential equation The input is solved by trigonometric function to get the updated speed The updated speed As the position equation After the integral solution, the updated position is obtained.

[0066] The calculation of the above technical solution is explained below through a group of example comparisons.

[0067] Example:

[0068] First of all, the precise solution method of the six-parameter coordinate transformation matrix based on trigonometric functions implemented in this example only needs to directly calculate the updated parameters through trigonometric functions, while the "inertial navigation six-parameter coordinate transformation matrix solution method" in the prior art requires iterative calculation. Therefore, the method described in the present invention reduces the calculation complexity and improves the solution efficiency.

[0069] Secondly, the six-parameter coordinate transformation matrix accurate solution method based on trigonometric functions in this embodiment uses trigonometric functions to calculate updated parameters, and there is no truncation error. However, the "inertial navigation six-parameter coordinate transformation matrix solution method" in the prior art uses a six-level fifth-order England numerical integration method, which has high-order errors. Therefore, the method described in the present invention improves the system accuracy and is an accurate solution method.

[0070] Finally, the six-parameter coordinate transformation matrix accurate solution method based on trigonometric functions of this embodiment is used to perform navigation solution on the data of a certain full-attitude motion of the aircraft ("Full-attitude navigation solution method based on extended Krylov angle", Journal of Chinese Inertial Technology, Vol. 29No. 5, 2021). The nine parameters solved are as follows Figure 3 As shown, the three-dimensional trajectory of the aircraft motion solved by the prior art navigation is shown in Figure 4 The solution result of the present invention is as follows Figure 5 As shown, it can be seen that the motion process of the aircraft with large attitude and high maneuverability is well reproduced, which shows that the six-parameter coordinate transformation matrix solution method of this embodiment can realize full attitude solution, which is beneficial to flight control.

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

[0072] 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 method for accurately calculating six-parameter coordinate transformation of inertial navigation based on trigonometric functions, characterized in that: include: Calculate t k The coordinate transformation matrix of the strapdown navigation system's main coordinate system relative to the navigation coordinate system; According to the angular rate output by the gyroscope installed on the strapdown inertial system body, calculate t k The angular velocity and angular increment of the body coordinate system relative to the navigation coordinate system at that moment; According to the coordinate transformation matrix and the angular velocity, the selected six parameters are updated and solved, and the updated coordinate transformation matrix is ​​solved; According to the updated coordinate transformation matrix, the velocity and position are updated.

2. The method for accurately calculating the six-parameter coordinate transformation of inertial navigation based on trigonometric functions according to claim 1 is characterized in that: t k The coordinate transformation matrix of the strapdown navigation system's main coordinate system relative to the navigation coordinate system is: Among them, a 21,k 、a 22,k 、a 23,k 、a 31,k 、a 32,k 、a 33,k t k The six parameters selected from the coordinate transformation matrix at the moment are used to calculate a using the constraint equation 11,k 、a 12,k 、a 13,k : a 11,k =a 22,k a 33,k -a 32,k a 23,k a 12,k =a 31,k a 23,k -a 21,k a 33,k a 13,k =a 21,k a 32,k -a 31,k a 22,k 。 3. The method for accurately calculating the six-parameter coordinate transformation of inertial navigation based on trigonometric functions according to claim 2 is characterized in that: t k The angular velocity of the body coordinate system relative to the navigation coordinate system at this moment is: In the formula, ω xb ,ω yb ,ω zb are the angular velocities of the x, y, and z axes of the body coordinate system, respectively; The angular increment Δθ is: Where ΔT is the update interval.

4. The method for accurately calculating the six-parameter coordinate transformation of inertial navigation based on trigonometric functions according to claim 3 is characterized in that: The updated coordinate transformation matrix is: Among them, a 11,k+1 、a 12,k+1 、a 13,k+1 、a 21,k+1 、a 22,k+1 、a 23,k+1 、a 31,k+1 、a 32,k+1 and a 33,k+1 are the nine parameters after update; The calculation method of the nine parameters is as follows: as well as a 11,k+1 =a 22,k+1 a 33,k+1 -a 32,k+1 a 23,k+1 a 12,k+1 =a 31,k+1 a 23,k+1 -a 21,k+1 a 33,k+1 a 13,k+1 =a 21,k+1 a 32,k+1 -a 31,k+1 a 22,k+1 。 5. The method for accurately calculating six-parameter coordinate transformation of inertial navigation based on trigonometric functions according to claim 1 is characterized in that: The speed update and position update are as follows: When the p system is an inertial system, the navigation equation is: in, is the updated coordinate transformation matrix, is the apparent acceleration, is the acceleration due to gravity, is the velocity vector, is the position vector.

6. The method for accurately calculating six-parameter coordinate transformation of inertial navigation based on trigonometric functions according to claim 1 is characterized in that: The gyroscopes installed on the strapdown inertial system body are three single-degree-of-freedom gyroscopes.

7. The method for accurately calculating six-parameter coordinate transformation of inertial navigation based on trigonometric functions according to claim 1 is characterized in that: Two dual-DOF gyroscopes.

8. The method for accurately calculating six-parameter coordinate transformation of inertial navigation based on trigonometric functions according to claim 1, characterized in that: The body coordinate system b corresponding to the strapdown inertial system is the moving system; the navigation coordinate system p that describes the rotational motion of the carrier is the fixed system; the origins of the two coordinate systems coincide.

9. The method for accurately calculating six-parameter coordinate transformation of inertial navigation based on trigonometric functions according to claim 1, characterized in that: There are no singular points in the calculation process of the accurate calculation method of the six-parameter coordinate transformation of inertial navigation.