Inertial Navigation 5-Parameter Coordinate Transformation Matrix Calculation Method

Abstract

This invention discloses a method for solving the 5-parameter coordinate transformation matrix of inertial navigation. The method includes: determining five parameters in two rows of the coordinate transformation matrix as variables for real-time updates; and using an integral formula to perform integral update calculations on the 5-parameter differential equation to obtain the five parameters at time t. k The time value is calculated; five parameters are orthogonalized and normalized; the remaining three parameters of the coordinate transformation matrix are calculated, and the updated coordinate transformation matrix is ​​obtained, supporting velocity and position updates to improve the accuracy of inertial navigation. This invention uses the angular rate output by the gyroscope orthogonally mounted on the strapdown inertial system as input information to achieve real-time updating of the inertial navigation coordinate transformation matrix, simplifying the computation while ensuring solution accuracy.

Description

Technical Field

[0001] This invention belongs to the field of aviation and aerospace technology, and in particular relates to a method for solving the coordinate transformation matrix of 5-parameter inertial navigation. Background Technology

[0002] Inertial navigation is widely used in missiles, aircraft, ships, and weapons, primarily to determine the position, velocity, and attitude of a vehicle relative to the navigation system in real time. Strapdown inertial systems are directly fixed to the vehicle, using gyroscopes to measure angular velocity and mathematically calculating the coordinate transformation matrix of the vehicle's coordinate system relative to the navigation system.

[0003] Currently, methods for determining attitude information include direction cosine kinematics, Euler-Krylov angular kinematics, and quaternion kinematics.

[0004] In engineering, only four quaternion parameters and their differential equations are commonly used. However, the drawback is that these four parameters are only intermediate variables, and nine more equations are needed to solve for the coordinate transformation matrix of the carrier coordinate system relative to the navigation system. Furthermore, the coordinate transformation matrix described by quaternions does not have a unique correspondence with the four parameters, because one coordinate transformation matrix can correspond to two different sets of quaternions.

[0005] In comparison, the Euler-Krylov angle kinematic equations only have three. However, in the book "Inertial Devices (Volume 1)" (China Aerospace Publishing House), page 46, it is argued that the kinematic equations described by Euler-Krylov angles contain singularities and degenerate. Nevertheless, a Krylov angle-based attitude calculation method is proposed in patent (202010333184.9), which can achieve full attitude motion description of the carrier. However, the problem is that when the pitch angle is 90°, the attitude calculation error is large during discretization, resulting in significant errors in the calculated velocity and position.

[0006] The method of using direction cosine matrices to represent the rotational motion relationship and attitude matrix between two coordinate systems is convenient, intuitive, and easy to understand. However, its drawback is that the transformation matrix has nine parameters and its differential equations, resulting in a large amount of integral calculation. In Chapter 18 of the book "Inertial Devices (Part 2)" (China Aerospace Publishing House), a method for solving coordinate transformation matrices based on direction cosine kinematic equations and quaternion kinematic equations is presented.

[0007] To achieve a one-to-one correspondence between the coordinate transformation matrix and parameters under all attitude conditions, and to address the problem of excessive computation caused by too many parameters in the direction cosine matrix (9 parameters), it is necessary to study a new method for solving the relative coordinate system of the carrier coordinate system to the navigation system, so as to improve the speed and accuracy of inertial navigation and flight control. Summary of the Invention

[0008] The technical problem solved by this invention is to overcome the shortcomings of the prior art and provide a method for solving the 5-parameter coordinate transformation matrix of inertial navigation. The angular rate output by the gyroscope orthogonally mounted on the body of the strapdown inertial system is used as the input information for the kinematic equations of the 5 parameters of the coordinate transformation matrix. Through integral calculation, normalization and orthogonalization processing, the inertial navigation coordinate transformation matrix is ​​updated in real time. No singular values ​​appear during the calculation process, ensuring the requirements of full attitude of the body coordinate system relative to the navigation coordinate system and low computational load.

[0009] The technical solution of this invention is as follows:

[0010] This invention discloses a method for solving the 5-parameter coordinate transformation matrix of inertial navigation, including:

[0011] The calculation yields the relative coordinate system of the strapdown navigation system to the navigation coordinate system at time t. k The coordinate transformation matrix at time step;

[0012] Calculate at t k The angular velocity of the body coordinate system relative to the navigation coordinate system at any given moment;

[0013] Select 5 parameters from the coordinate transformation matrix;

[0014] Based on the coordinate transformation matrix and angular velocity, the five parameters are updated and solved to obtain the updated coordinate transformation matrix;

[0015] Based on the updated coordinate transformation matrix, velocity and position are updated.

[0016] Furthermore, in the above solution method, the calculated body coordinate system of the strapdown navigation system relative to the navigation coordinate system at time t k The coordinate transformation matrix at time t is as follows:

[0017]

[0018] In the formula, a 11,k a 12,k a 13,k a 21,k a 22,k a 23,k a 31,k a 32,k and a 33,k For in t k Nine parameters of the time coordinate transformation matrix.

[0019] Furthermore, in the above solution method, the calculation at t k The angular velocity of the body coordinate system relative to the navigation coordinate system at any given time is as follows:

[0020]

[0021] in, These are the angular velocities of the body along the x, y, and z axes, respectively.

[0022] Furthermore, in the above solution method, the selection of 5 parameters from the 9 parameters in the coordinate transformation matrix specifically involves:

[0023] Select a in the coordinate transformation matrix 13,k a 23,k and a 33,k The maximum value among the absolute values ​​is The three elements in the corresponding row, and the minimum value in The other two elements in the corresponding row are used as five parameters.

[0024] Furthermore, in the above solution method, the five parameters are updated and solved based on the coordinate transformation matrix and angular velocity, and the updated coordinate transformation matrix is ​​calculated, specifically as follows:

[0025] when|a 13,k |Maximum,|a 23,k At its minimum, select 5 parameters a. 11,k a 12,k a 13,k a 21,k and a 22,k ; at the next moment t k+1 =t k The value of +ΔT after integration is b 11,k+1 b 12,k+1 b 13,k+1 b 21,k+1 and b 22,k+1 ;

[0026] when|a 13,k |Maximum,|a 33,k At its minimum, select 5 parameters a. 11,k a 12,k a 13,k a 31,k and a 32,k ; at the next moment t k+1 =t k The value of +ΔT after integration is b 11,k+1 b 12,k+1 b 13,k+1 b 31,k+1 and b 32,k+1 ;

[0027] when|a 23,k |Maximum,|a 13,k At its minimum, select 5 parameters a. 11,k a 12,k a21,k a 22,k and a 23,k ; at the next moment t k+1 =t k The value of +ΔT after integration is b 11,k+1 b 12,k+1 b 21,k+1 b 22,k+1 and b 23,k+1 ;

[0028] when|a 23,k |Maximum,|a 33,k At its minimum, select 5 parameters a. 21,k a 22,k a 23,k a 31,k and a 32,k ; at the next moment t k+1 =t k The value of +ΔT after integration is b 21,k+1 b 22,k+1 b 23,k+1 b 31,k+1 and b 32,k+1 ;

[0029] when|a 33,k |Maximum,|a 13,k At its minimum, select 5 parameters a. 11,k a 12,k a 31,k a 32,k and a 33,k ; at the next moment t k+1 =t k The value of +ΔT after integration is b 11,k+1 b 12,k+1 b 31,k+1 b 32,k+1 and b 33,k+1 ;

[0030] when|a 33,k |Maximum,|a 23,k At its minimum, select 5 parameters a. 21,k a 22,k a 31,k a 32,k and a 33,k ; at the next moment t k+1 =t k The value of +ΔT after integration is b 21,k+1 b 22,k+1 b 31,k+1 b 32,k+1 and b 33,k+1 .

[0031] Furthermore, in the above solution method, when |a13,k |Maximum,|a 23,k At its minimum, select 5 parameters a. 11,k a 12,k a 13,k a 21,k and a 22,k ; at the next moment t k+1 =t k The value of +ΔT after integration is b 11,k+1 b 12，k+1 b 13，k+1 b 21，k+1 and b 22，k+1 The specific calculation formula is as follows:

[0032]

[0033] Put b 11,k+1 b 12,k+1 b 13,k+1 b 21,k+1 and b 22,k+1 Substitute into the following formula and solve for t. k+1 a of time 11,k+1 a 12,k+1 a 13,k+1 a 21,k+1 and a 22,k+1 The values, and the coordinate transformation matrix from the navigation coordinate system to the body coordinate system are:

[0034]

[0035] In the formula,

[0036]

[0037]

[0038]

[0039]

[0040]

[0041] Where ΔT is the sampling time.

[0042] Furthermore, in the above solution method, when |a 13,k |Maximum,|a 33,k At its minimum, select 5 parameters a. 11,k a 12,k a 13,k a 31,k and a 32,k ; at the next moment t k+1 =t kThe value of +ΔT after integration is b 11,k+1 b 12,k+1 b 13,k+1 b 31,k+1 and b 32,k+1 The calculation formula is:

[0043]

[0044] Put b 11,k+1 b 12,k+1 b 13,k+1 b 31,k+1 and b 32,k+1 Substitute into the following formula and solve for t. k+1 a of time 11,k+1 a 12,k+1 a 13,k+1 a 31,k+1 and a 32,k+1 The values, and the coordinate transformation matrix from the navigation coordinate system to the body coordinate system, are as follows:

[0045]

[0046] In the formula,

[0047]

[0048]

[0049]

[0050]

[0051]

[0052] Furthermore, in the above solution method, when |a 23 ,k |Maximum,|a 13 ,k At its minimum, select 5 parameters a. 11,k a 12,k a 21,k a 22,k and a 23,k ; at the next moment t k+1 =t k The value of +ΔT after integration is b 11,k+1 b 12,k+1 b 21,k+1 b 22,k+1 and b 23,k+1 The calculation formula is:

[0053]

[0054] Put b11,k+1 b 12,k+1 b 21,k+1 b 22,k+1 and b 23,k+1 Substitute into the following formula and solve for t. k+1 a of time 11,k+1 a 12,k+1 a 21,k+1 a 22,k+1 and a 23,k+1 The values, and the coordinate transformation matrix from the navigation coordinate system to the body coordinate system are:

[0055]

[0056] In the formula,

[0057]

[0058]

[0059]

[0060]

[0061]

[0062] Furthermore, in the above solution method, when |a 23,k |Maximum,|a 33,k At its minimum, select 5 parameters a. 21,k a 22,k a 23,k a 31,k and a 32,k ; at the next moment t k+1 =t k The value of +ΔT after integration is b 21,k+1 b 22,k+1 b 23,k+1 b 31,k+1 and b 32,k+1 The calculation formula is:

[0063]

[0064] Put b 21,k+1 b 22,k+1 b 23,k+1 b 31,k+1 and b 32,k+1 Substitute into the following formula and solve for t. k+1 a of time 21,k+1 a 22,k+1 a 23,k+1 a 31,k+1 and a 32,k+1The values, and the coordinate transformation matrix from the navigation coordinate system to the body coordinate system, are as follows:

[0065]

[0066] In the formula,

[0067]

[0068]

[0069]

[0070]

[0071]

[0072] Furthermore, in the above solution method, when |a 33,k |Maximum,|a 13,k At its minimum, select 5 parameters a. 11,k a 12,k a 31,k a 32,k and a 33,k ; at the next moment t k+1 =t k The value of +ΔT after integration is b 11,k+1 b 12,k+1 b 31,k+1 b 32,k+1 and b 33,k+1 The calculation formula is:

[0073]

[0074] Put b 11,k+1 b 12,k+1 b 31,k+1 b 32,k+1 and b 33,k+1 Substitute into the following formula and solve for t. k+1 a of time 11,k+1 a 12,k+1 a 31,k+1 a 32,k+1 and a 33,k+1 The values, and the coordinate transformation matrix from the navigation coordinate system to the body coordinate system are:

[0075]

[0076] In the formula,

[0077]

[0078]

[0079]

[0080]

[0081]

[0082] Furthermore, in the above solution method, when |a 33,k |Maximum,|a 23,k At its minimum, select 5 parameters a. 21,k a 22,k a 31,k a 32,k and a 33,k ; at the next moment t k+1 =t k The value of +ΔT after integration is b 21,k+1 b 22,k+1 b 31,k+1 b 32,k+1 and b 33,k+1 The calculation formula is:

[0083]

[0084] Put b 11,k+1 b 12,k+1 b 31,k+1 b 32,k+1 and b 33,k+1 Substitute into the following formula and solve for t. k+1 a of time 11,k+1 a 12,k+1 a 31,k+1 a 32,k+1 and a 33,k+1 The values, and the coordinate transformation matrix from the navigation coordinate system to the body coordinate system, are as follows:

[0085]

[0086] In the formula,

[0087]

[0088]

[0089]

[0090]

[0091]

[0092] Furthermore, in the above solution method, the step of updating the velocity and position based on the updated coordinate transformation matrix specifically involves:

[0093] When p is an inertial frame of reference, the navigation equations are:

[0094]

[0095]

[0096]

[0097] in, This is the updated coordinate transformation matrix. For apparent acceleration, Let V be the acceleration due to gravity, V be the updated velocity, T be the transpose of the matrix, and r be the updated position.

[0098] The present invention has the following advantages:

[0099] (1) This invention discloses a method for solving the coordinate transformation matrix of inertial navigation with 5 parameters, which has 4 fewer differential equations than the 9-parameter direction cosine method, thus reducing the amount of calculation.

[0100] (2) This invention discloses a method for solving the 5-parameter coordinate transformation matrix of inertial navigation. Compared with the coordinate transformation matrix represented by quaternions, the relationship between the 5 parameters and the coordinate transformation matrix is ​​unique.

[0101] (3) This invention discloses a method for solving the 5-parameter coordinate transformation matrix of inertial navigation, which can achieve high-precision solution without singularities in all attitudes relative to the coordinate transformation matrix represented by 3 Krylov angles.

[0102] (4) This invention discloses a method for solving the 5-parameter coordinate transformation matrix of inertial navigation, which has a simple structure and is easy to implement in engineering. Attached Figure Description

[0103] Figure 1 This is a flowchart illustrating the steps of the inertial navigation 5-parameter coordinate transformation matrix calculation method in this embodiment of the invention.

[0104] Figure 2 This is a schematic diagram showing the relationship between the strapdown inertial system body and the navigation coordinate system of the present invention;

[0105] Figure 3 This describes the changes of the nine parameters of the coordinate transformation matrix calculated by the inertial navigation five-parameter coordinate transformation matrix calculation method of this invention during the three-roll process of the aircraft.

[0106] Figure 4 The three-dimensional trajectory of the aircraft is calculated based on the inertial navigation 5-parameter coordinate transformation matrix calculation method of the present invention. Detailed Implementation

[0107] To make the objectives, technical solutions, and advantages of the present invention clearer, the embodiments disclosed in the present invention will be described in further detail below with reference to the accompanying drawings.

[0108] The flowchart of the inertial navigation 5-parameter coordinate transformation matrix calculation method in this embodiment of the invention is as follows: Figure 1 As shown. In this embodiment, the inertial navigation 5-parameter coordinate transformation matrix calculation method includes:

[0109] like Figure 2 As shown, this is achieved using a strapdown inertial system fixed to the carrier. The body coordinate system (b-frame, the moving frame) corresponding to the strapdown inertial system is Ox′y′z′; the navigation coordinate system (p-frame, the fixed frame) describing the carrier's rotational motion is Oxyz; the origins of the two coordinate systems coincide. During rotation, the angular velocity of the body of the strapdown inertial system relative to the navigation coordinate system is... The implementation steps of the inertial navigation 5-parameter coordinate transformation matrix calculation method are as follows:

[0110] (1) The relative coordinate system of the strapdown navigation system to the navigation coordinate system at t is calculated. k The coordinate transformation matrix at time t is

[0111]

[0112] In the formula, a 11,k a 12,k a 13,k a 21,k a 22,k a 23,k a 31,k a 32,k and a 33,k For in t k Nine parameters of the time coordinate transformation matrix.

[0113] (2) Based on the angular velocity output by the gyroscope installed on the strapdown inertial system, the value at t is obtained. k angular velocity of the body relative to the navigation frame at any moment

[0114] (3) Let the sampling time be ΔT, for a 13,k a 23,k and a 33,k Sort the absolute values ​​from smallest to largest, and select the largest one. The three elements in the corresponding row, and the minimum value in The other two elements in the corresponding row are used as five parameters. These five parameters are updated and solved in the following six cases, and the coordinate transformation matrix is ​​calculated.

[0115] (3.1), when |a13,k |Maximum,|a 23,k At its minimum, select 5 parameters a. 11 a 12 a 13 a 21 and a 22 ; at the next moment t k+1 =t k The value of +ΔT after integration is b 11,k+1 b 12,k+1 b 13,k+1 b 21,k+1 and b 22,k+1 The specific calculation formula is as follows:

[0116]

[0117] Put b 11,k+1 b 12,k+1 b 13,k+1 b 21,k+1 and b 22,k+1 Substitute into the following formula and solve for t. k+1 a of time 11,k+1 a 12,k+1 a 13,k+1 a 21,k+1 and a 22,k+1 The values, and the coordinate transformation matrix from the navigation coordinate system to the body coordinate system are:

[0118]

[0119] In the formula,

[0120]

[0121]

[0122]

[0123]

[0124]

[0125] (3.2), when |a 13,k |Maximum,|a 33,k At its minimum, select 5 parameters a. 11 a 12 a 13 a 31 and a 32 ; at the next moment t k+1 =t k The value of +ΔT after integration is b 11,k+1 b 12,k+1 b13,k+1 b 31,k+1 and b 32,k+1 The specific calculation formula is as follows:

[0126]

[0127] Put b 11,k+1 b 12,k+1 b 13,k+1 b 31,k+1 and b 32,k+1 Substitute into the following formula and solve for t. k+1 a of time 11,k+1 a 12,k+1 a 13,k+1 a 31,k+1 and a 32,k+1 The values, and the coordinate transformation matrix from the navigation coordinate system to the body coordinate system are:

[0128]

[0129] In the formula,

[0130]

[0131]

[0132]

[0133]

[0134]

[0135] (3.3), when |a 23,k |Maximum,|a 13,k At its minimum, select 5 parameters a. 11 a 12 a 21 a 22 and a 23 ; at the next moment t k+1 =t k The value of +ΔT after integration is b 11,k+1 b 12,k+1 b 21,k+1 b 22,k+1 and b 23,k+1 The specific calculation formula is as follows:

[0136]

[0137] Put b 11,k+1 b 12,k+1 b 21,k+1 b 22,k+1 and b 23,k+1Substitute into the following formula and solve for t. k+1 a of time 11,k+1 a 12,k+1 a 21,k+1 a 22,k+1 and a 23,k+1 The values, and the coordinate transformation matrix from the navigation coordinate system to the body coordinate system are:

[0138]

[0139] In the formula,

[0140]

[0141]

[0142]

[0143]

[0144]

[0145] (3.4), when |a 23,k |Maximum,|a 33,k At its minimum, select 5 parameters a. 21 a 22 a 23 a 31 and a 32 ; at the next moment t k+1 =t k The value of +ΔT after integration is b 21,k+1 b 22,k+1 b 23,k+1 b 31,k+1 and b 32,k+1 The specific calculation formula is as follows:

[0146]

[0147] Put b 21,k+1 b 22,k+1 b 23,k+1 b 31,k+1 and b 32,k+1 Substitute into the following formula and solve for t. k+1 a of time 21,k+1 a 22,k+1 a 23,k+1 a 31,k+1 and a 32,k+1 The values, and the coordinate transformation matrix from the navigation coordinate system to the body coordinate system are:

[0148]

[0149] In the formula,

[0150]

[0151]

[0152]

[0153]

[0154]

[0155] (3.5), when |a 33,k |Maximum,|a 13,k At its minimum, select 5 parameters a. 11 a 12 a 31 a 32 and a 33 ; at the next moment t k+1 =t k The value of +ΔT after integration is b 11,k+1 b 12,k+1 b 31,k+1 b 32,k+1 and b 33,k+1 The specific calculation formula is as follows:

[0156]

[0157] Put b 11,k+1 b 12,k+1 b 31,k+1 b 32,k+1 and b 33,k+1 Substitute into the following formula and solve for t. k+1 a of time 11,k+1 a 12,k+1 a 31,k+1 a 32,k+1 and a 33,k+1 The values, and the coordinate transformation matrix from the navigation coordinate system to the body coordinate system are:

[0158]

[0159] In the formula,

[0160]

[0161]

[0162]

[0163]

[0164]

[0165] (3.6), when |a 33,k |Maximum,|a 23,k At its minimum, select 5 parameters a. 21 a 22 a 31 a 32 and a 33 ; at the next moment t k+1 =t k The value of +ΔT after integration is b 21,k+1 b 22,k+1 b 31,k+1 b 32,k+1 and b 33,k+1 The specific calculation formula is as follows:

[0166]

[0167] Put b 11,k+1 b 12,k+1 b 31,k+1 b 32,k+1 and b 33,k+1 Substitute into the following formula and solve for t. k+1 a of time 11,k+1 a 12,k+1 a 31,k+1 a 32,k+1 and a 33,k+1 The values, and the coordinate transformation matrix from the navigation coordinate system to the body coordinate system are:

[0168]

[0169] In the formula,

[0170]

[0171]

[0172]

[0173]

[0174]

[0175] (4) Update the coordinate transformation matrix calculated by the integral and support velocity and position updates to improve the accuracy of inertial navigation.

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

[0177] In step (4), the updated coordinate transformation matrix will be used. And apparent acceleration and gravitational acceleration As the velocity differential equation The input is integrated to obtain the updated velocity V. The updated velocity V is then used as the position differential equation. The input is integrated to obtain the updated position r.

[0178] Based on the above embodiments, the following is an explanation through a set of comparative examples.

[0179] Example 1:

[0180] First, the 5-parameter coordinate transformation matrix solution method of the present invention only requires integration to solve 5 differential equations, while the 9-parameter direction cosine matrix requires solving the following 9 differential equations.

[0181]

[0182] Therefore, the 5-parameter coordinate transformation matrix solution method of the present invention reduces the computational load compared to the 9-parameter direction cosine method.

[0183] Secondly, although the five-parameter coordinate transformation matrix solution method of this invention has two more differential equations than the quaternion method, the coordinate transformation matrix represented by quaternions...

[0184]

[0185] This necessarily corresponds to at least two sets of parameters: λ, ρ1, ρ2, ρ3; -λ, -ρ1, -ρ2, -ρ3. This causes the relationship between the coordinate transformation matrix and the rotation of the carrier relative to the navigation system to be non-unique. However, the 5-parameter coordinate transformation matrix of this invention ensures that the relationship between the 5 parameters and the coordinate transformation matrix is ​​unique.

[0186] Finally, the 5-parameter coordinate transformation matrix solution method of this invention 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 Angles", Chinese Journal of Inertial Technology, Vol.29 No.5, 2021). The 9 parameters to be solved are as follows: Figure 3 As shown, the three-dimensional trajectory of the aircraft calculated by navigation is shown below. Figure 4 As can be seen, the motion process of the aircraft with large attitude and high maneuverability is reproduced very well, which shows that the 5-parameter coordinate transformation matrix solution method of the present invention can realize full attitude solution, which is beneficial to flight control.

[0187] Although the present invention has been disclosed above with reference to preferred embodiments, it is not intended to limit the present invention. Any person skilled in the art can make possible changes and modifications to the technical solutions of the present invention by utilizing the methods and techniques disclosed above without departing from the spirit and scope of the present invention. Therefore, any simple modifications, equivalent changes and alterations made to the above embodiments based on the technical essence of the present invention without departing from the content of the technical solutions of the present invention shall fall within the protection scope of the technical solutions of the present invention.

[0188] The contents not described in detail in this specification are common knowledge to those skilled in the art.

Claims

1. A method for solving the inertial navigation 5-parameter coordinate transformation matrix, characterized in that, include: The coordinate transformation matrix of the body coordinate system of the strapdown navigation system relative to the navigation coordinate system at the moment is calculated. t k time. Computing at t k the angular velocity of the body coordinate system relative to the navigation coordinate system at the instant Select 5 parameters from the coordinate transformation matrix; Based on the coordinate transformation matrix and angular velocity, the five parameters are updated and solved to obtain the updated coordinate transformation matrix; Based on the updated coordinate transformation matrix, the velocity and position are updated. The calculation obtains the coordinate transformation matrix of the body coordinate system of the strapdown navigation system relative to the navigation coordinate system at t k a specific time, and specifically is: In the formula, a 11,k , a 12,k , a 13,k , a 21,k , a 22,k , a 23,k , a 31,k , a 32,k and a 33,k In order to be in t k Nine parameters of the time coordinate transformation matrix; Five parameters out of nine are selected from the coordinate transformation matrix, specifically: The maximum value among absolute values of a 13,k , a 23,k and a 33,k is selected as 5 parameters in a row corresponding to the maximum value in , and the other two elements in a row corresponding to the minimum value in .

2. The inertial navigation 5-parameter coordinate transformation matrix calculation method according to claim 1, characterized in that: The calculation is in t k The angular velocity of the body coordinate system relative to the navigation coordinate system at the moment, specifically: wherein , , are the angular velocities on the body x, y, z axes, respectively.

3. The method of claim 1, wherein: Based on the coordinate transformation matrix and angular velocity, the five parameters are updated and solved, and the updated coordinate transformation matrix is ​​calculated, specifically as follows: When | maximum, | minimum, 5 parameters are selected a 11,k 、a 12,k 、a 13,k 、a 21,k and a 22,k ; at the next instant t k+1 = t k + Δ T integrated value b 11,k+1 , b 12,k+1 , b 13,k+1 , b 21,k+1 and b 22,k+1 ; When | maximum, | minimum, 5 parameters are selected a 11,k 、a 12,k 、a 13,k 、a 31,k and a 32,k ; at the next instant t k+1 = t k + delta T integrated value b 11,k+1 , b 12,k+1 , b 13,k+1 , b 31,k+1 and b 32,k+1 ; When | |Maximum,| At its minimum, select 5 parameters. a 11,k 、a 12,k 、a 21,k 、a 22,k and a 23,k ; at the next moment t k+1 = t k +Δ T The value after integration b 11,k+1 , b 12,k+1 , b 21,k+1 , b 22,k+1 and b 23,k+1 ; When | |Maximum,| a 33,k At its minimum, select 5 parameters. a 21,k 、a 22,k 、a 23,k 、a 31,k and a 32,k ; at the next moment t k+1 = t k +Δ T The value after integration b 21,k+1 , b 22,k+1 , b 23,k+1 , b 31,k+1 and b 32,k+1 ; When | a 33,k |Maximum,| a 13,k At its minimum, select 5 parameters. a 11,k 、a 12,k 、a 31,k 、a 32,k and a 33,k ; at the next moment t k+1 = t k +Δ T The value after integration b 11,k+1 , b 12,k+1 , b 31,k+1 , b 32,k+1 and b 33,k+1 ; When | a 33,k |Maximum,| At its minimum, select 5 parameters. a 21,k 、a 22,k 、a 31,k 、a 32,k and a 33,k ; at the next moment t k+1 = t k +Δ T The value after integration b 21,k+1 , b 22,k+1 , b 31,k+1 , b 32,k+1 and b 33,k+1 ; Where, Δ T Sampling time.

4. The inertial navigation 5-parameter coordinate transformation matrix calculation method according to claim 3, characterized in that: When | |Maximum,| At its minimum, select 5 parameters. a 11,k 、a 12,k 、a 13,k 、a 21,k and a 22,k ; at the next moment t k+1 = t k +Δ T The value after integration b 11,k+1 , b 12,k+1 , b 13,k+1 , b 21,k+1 and b 22,k+1 The specific calculation formula is as follows: Bundle b 11,k+1 , b 12,k+1 , b 13,k+1 , b 21,k+1 and b 22,k+1 Substitute into the following formula and solve for... t k+1 Moment a 11,k+1 , a 12,k+1 , a 13,k+1 , a 21,k+1 and a 22,k+1 The values, and the coordinate transformation matrix from the navigation coordinate system to the body coordinate system, are as follows: In the formula, ； ； ； ； ； in, t k+1 This represents the (k+1)th time in the time series. , , These are the angular velocities of the body along the x, y, and z axes, respectively.

5. The inertial navigation 5-parameter coordinate transformation matrix calculation method according to claim 4, characterized in that: The when | |Maximum,| At its minimum, select 5 parameters. a 11,k 、a 12,k 、a 13,k 、a 31,k and a 32,k ; at the next moment t k+1 = t k +Δ T The value after integration b 11,k+1 , b 12,k+1 , b 13,k+1 , b 31,k+1 and b 32,k+1 The calculation formula is: Bundle b 11,k+1 , b 12,k+1 , b 13,k+1 , b 31,k+1 and b 32,k+1 Substitute into the following formula and solve for... t k+1 Moment a 11,k+1 , a 12,k+1 , a 13,k+1 , a 31,k+1 and a 32,k+1 The values, and the coordinate transformation matrix from the navigation coordinate system to the body coordinate system, are as follows: In the formula, ； ； ； ； 。 6. The inertial navigation 5-parameter coordinate transformation matrix calculation method according to claim 4, characterized in that: The when | |Maximum,| At its minimum, select 5 parameters. a 11,k 、a 12,k 、a 21,k 、a 22,k and a 23,k ; at the next moment t k+1 = t k +Δ T The value after integration b 11,k+1 , b 12,k+1 , b 21,k+1 , b 22,k+1 and b 23,k+1 The calculation formula is: Bundle b 11,k+1 , b 12,k+1 , b 21,k+1 , b 22,k+1 and b 23,k+1 Substitute into the following formula and solve for... t k+1 Moment a 11,k+1 , a 12,k+1 , a 21,k+1 , a 22,k+1 and a 23,k+1 The values, and the coordinate transformation matrix from the navigation coordinate system to the body coordinate system are: In the formula, ； ； ； ； 。 7. The inertial navigation 5-parameter coordinate transformation matrix calculation method according to claim 4, characterized in that: The when | |Maximum,| a 33,k At its minimum, select 5 parameters. a 21,k 、a 22,k 、a 23,k 、a 31,k and a 32,k ; at the next moment t k+1 = t k +Δ T The value after integration b 21,k+1 , b 22,k+1 , b 23,k+1 , b 31,k+1 and b 32,k+1 The calculation formula is: Bundle b 21,k+1 , b 22,k+1 , b 23,k+1 , b 31,k+1 and b 32,k+1 Substitute into the following formula and solve for... t k+1 Moment a 21,k+1 , a 22,k+1 , a 23,k+1 , a 31,k+1 and a 32,k+1 The values, and the coordinate transformation matrix from the navigation coordinate system to the body coordinate system, are as follows: In the formula, ； ； ； ； 。 8. The inertial navigation 5-parameter coordinate transformation matrix calculation method according to claim 4, characterized in that: When | a 33,k |Maximum,| a 13,k At its minimum, select 5 parameters. a 11,k 、a 12,k 、a 31,k 、a 32,k and a 33,k ; at the next moment t k+1 = t k +Δ T The value after integration b 11,k+1 , b 12,k+1 , b 31,k+1 , b 32,k+1 and b 33,k+1 The calculation formula is: Bundle b 11,k+1 , b 12,k+1 , b 31,k+1 , b 32,k+1 and b 33,k+1 Substitute into the following formula and solve for... t k+1 Moment a 11,k+1 , a 12,k+1 , a 31,k+1 , a 32,k+1 and a 33,k+1 The values, and the coordinate transformation matrix from the navigation coordinate system to the body coordinate system are: In the formula, ； ； ； ； 。 9. The inertial navigation 5-parameter coordinate transformation matrix calculation method according to claim 4, characterized in that: When | a 33,k |Maximum,| At its minimum, select 5 parameters. a 21,k 、a 22,k 、a 31,k 、a 32,k and a 33,k ; at the next moment t k+1 = t k +Δ T The value after integration b 21,k+1 , b 22,k+1 , b 31,k+1 , b 32,k+1 and b 33,k+1 The calculation formula is: Bundle b 11,k+1 , b 12,k+1 , b 31,k+1 , b 32,k+1 and b 33,k+1 Substitute into the following formula and solve for... t k+1 Moment a 11,k+1 , a 12,k+1 , a 31,k+1 , a 32,k+1 and a 33,k+1 The values, and the coordinate transformation matrix from the navigation coordinate system to the body coordinate system, are as follows: In the formula, ； ； ； ； 。 10. The inertial navigation 5-parameter coordinate transformation matrix calculation method according to claim 1, characterized in that: The step of updating the velocity and position based on the updated coordinate transformation matrix specifically involves: when p When the frame of reference is inertial, the navigation equations are: in, This is the updated coordinate transformation matrix. For apparent acceleration, It is the acceleration due to gravity. V For the updated speed, T This is the transpose of the matrix. This is the updated position.

Images