Rapid and accurate initial alignment method for strapdown inertial system based on rotation vector method

The proposed method addresses the complexity of existing rotation vector-based initial alignment by using second-order nonlinear equations to solve for attitude angles directly, ensuring fast and accurate alignment of strapdown inertial systems.

CN119063760APending Publication Date: 2024-12-03BEIJING INST OF AEROSPACE CONTROL DEVICES
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410983854.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-22
Publication Date
2024-12-03

AI Technical Summary

Technical Problem

Existing methods for initial alignment of strapdown inertial systems using the rotation vector method are complex and time-consuming due to high-order equations and require lengthy calculations, including solving quadratic equations and back-substitution, which can lead to large truncation errors near singular points.

Method used

A fast and accurate initial alignment method is proposed, utilizing second-order nonlinear equations based on accelerometer and gyroscope output values to directly solve for the three attitude angles, eliminating the need for complex calculations and singular point issues.

Benefits of technology

The method achieves rapid and precise initial alignment with a simple calculation process, ensuring full attitude alignment without singular points and providing a clear expression for the transformation matrix.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119063760A_ABST
    Figure CN119063760A_ABST
Patent Text Reader

Abstract

A rapid and accurate initial alignment method for a strapdown inertial system based on a rotation vector method comprises the following steps: establishing a second-order nonlinear equation set during initial alignment of a static base of the strapdown system, and taking three accelerometer apparent acceleration output values and three gyroscope angular velocity output values of the strapdown inertial system as known quantities by the equation set; the initial alignment of the strapdown system can be realized by solving the three attitude angles theta x, theta y and theta z defined by the rotation vector method, and the initial alignment method has the advantages of representability, rapidness and accuracy.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to a fast and accurate initial alignment method for a strapdown inertial system, in particular to a fast and accurate initial alignment method for a strapdown inertial system based on a rotation vector method, and belongs to the technical field of inertial navigation. Background Art

[0002] At present, there are mainly three methods for solving the attitude angle of the strapdown inertial system: direction cosine method, Euler-Krylov angle method, quaternion method and rotation vector method.

[0003] The rotation vector method has the following advantages over the first three methods:

[0004] (1) The rotation vector method has only three differential equations, while the quaternion method has four differential equations and the direction cosine method has nine differential equations. Therefore, the rotation vector method has a smaller amount of integral calculations.

[0005] (2) The rotation vector method can solve the full attitude. Although the Euler-Krylov angle method also has three differential equations, it has singular points, which can easily lead to large truncation errors in integral calculations near the singular points.

[0006] Based on the above two advantages, the rotation vector method has been applied to the strapdown navigation attitude solution in different scenarios. However, in actual application, one difficulty is the initial alignment. The main reason is that the expression of the rotation vector is a high-order equation. For example, the output value of the accelerometer combination is:

[0007]

[0008] The output value of the gyroscope combination is

[0009]

[0010] The so-called "initial alignment" is to solve the attitude angle θ from the above 6 equations x ,θ y ,θ z The value of .

[0011] Chinese patent CN201218004104.1 provides a method for initial alignment of the full attitude of a strapdown inertial system based on a rotation vector. The main idea of ​​this method is to compare θ y and θ z The ratio relationship between the two is determined in this process, and then the value of θ is solved. x ,θ y ,θ z The calculation process is too complicated, requiring lengthy steps such as solving quadratic equations, determining a reasonable solution, and back-substitution to solve the problem, and this method does not give a clear expression.

[0012] In order to overcome the above problems, we need to find a new solution for θ x ,θ y ,θ z A method is proposed to achieve fast and accurate initial alignment of the strapdown inertial system. Summary of the invention

[0013] The technical problem to be solved by the present invention is to overcome the deficiencies of the prior art and realize fast and accurate initial alignment of a strapdown inertial system. The method has clear expressions and a simple calculation process and can realize full attitude alignment.

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

[0015] A fast and accurate initial alignment method for a strapdown inertial system based on a rotating vector method is proposed. This method establishes a second-order nonlinear equation group for the initial alignment of the strapdown system static base. The equation group uses the three accelerometer output values ​​of the strapdown inertial system and the three gyroscope angular velocity output values ​​as known quantities to solve the three attitude angles θ defined by the rotating vector method. x ,θ y ,θ z , the initial alignment of the strapdown system can be achieved. The initial alignment method of the present invention has the advantages of being characterizable, fast and accurate.

[0016] A fast and accurate initial alignment device for a strapdown inertial system based on a rotating vector method, comprising:

[0017] The first module is used to establish the initial alignment equation of the static base of the strapdown inertial system;

[0018] The second module uses the rotating vector attitude angle to represent the output equation of the accelerometer combination and the output equation of the gyroscope combination under the static base condition of the strapdown inertial system;

[0019] The third module uses the output values ​​of the three accelerometers in the strapdown inertial system and the output angular velocities of the three gyroscopes in the carrier coordinate system to solve the output equations of the accelerometer combination and the gyroscope combination of the second module, obtain the values ​​of the three rotation vector attitude angles, and determine the transformation matrix from the navigation coordinate system to the carrier coordinate system to complete the initial alignment.

[0020] The details include:

[0021] (1) Establish the initial alignment equation of the strapdown inertial system static base

[0022]

[0023] Among them, L is the northeast sky geographic coordinate system, b is the carrier coordinate system, i is the inertial coordinate system, and e is the inertial coordinate system; is the transformation matrix from the northeast sky geographic coordinate system to the carrier coordinate system; is the carrier angular velocity vector, is the output angular velocity of the gyroscope combination, ω x is the output angular velocity of the X-axis gyroscope in the carrier coordinate system, ω y is the output angular velocity of the Y-axis gyroscope in the carrier coordinate system, ω z is the output angular velocity of the Z-axis gyroscope in the carrier coordinate system; is the projection angular velocity vector of the northeast celestial geographic coordinate system relative to the inertial coordinate system in the northeast celestial geographic coordinate system, ω ie is the Earth's rotation angular velocity, is the local geographical latitude; is the output vector of the accelerometer combination, a x is the output of the X-axis accelerometer in the carrier coordinate system, a y is the output of the Y-axis accelerometer in the carrier coordinate system, a z is the output of the Z-axis accelerometer in the carrier coordinate system; is the local acceleration vector, g is the acceleration due to gravity;

[0024] (2) The output value of the accelerometer combination under the static base condition of the strapdown inertial system expressed in terms of the rotation vector attitude angle is

[0025]

[0026] The output value of the gyroscope combination is

[0027]

[0028] In the formula,

[0029] θ is the rotation vector attitude angle,

[0030] θ x is the component of θ on the X-axis of the navigation coordinate system;

[0031] θ y is the component of θ on the Y axis of the navigation coordinate system;

[0032] θ z is the component of θ on the Z axis of the navigation coordinate system;

[0033] (3) Using the output values ​​a of the three accelerometers in the strapdown inertial system in the carrier coordinate system x 、a y 、a z and the output angular velocity ω of the three gyroscopes x ,ω y,ω z Solve the two output equations in step (2) to obtain the three rotation vector attitude angles θ x ,θ y ,θ z The value of

[0034]

[0035]

[0036] And determine the transformation matrix from the navigation coordinate system to the carrier coordinate system for

[0037]

[0038] This completes the initial alignment of the strapdown inertial system.

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

[0040] (1) The attitude angle solved by the present invention has a clear expression, based on the output values ​​a of the three accelerometers x 、a y 、a z and the output angular velocity ω of the three gyroscopes x ,ω y ,ω z The three rotation vector attitude angles θ can be calculated in one step x ,θ y ,θ z The value of can achieve the effect of fast alignment.

[0041] (2) In the process of solving the attitude angle of the present invention, there is no complicated process such as solving quadratic equations and back-substitution solutions, the amount of calculation is small and the process is simple; there is no singular point in the solution process, and the method of the present invention can realize the full attitude alignment of the strapdown inertial system.

[0042] (3) According to the present invention, the transformation matrix of the carrier relative to the northeast celestial geographic coordinate system can be directly given, and the physical meaning is clear. BRIEF DESCRIPTION OF THE DRAWINGS

[0043] Figure 1 It is a schematic diagram of the navigation coordinate system based on the geographic coordinate system;

[0044] Figure 2 is a flow chart for implementing the initial alignment method of the present invention;

[0045] Figure 3 The coordinate transformation diagram represented by the rotation vector method, where OX0Y0Z0 represents the navigation coordinate system, OX t Y t Zt Represents the carrier coordinate system. OX0Y0Z0 around the vector Reach OX after one rotation t Y t Z t , the angle vector of rotation is DETAILED DESCRIPTION

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

[0047] A fast and accurate initial alignment method for a strapdown inertial system based on a rotating vector method is firstly established. The second-order nonlinear equations for the initial alignment of the strapdown system static base are the known quantities of the equations, which are the apparent acceleration output values ​​of the three accelerometers and the angular velocity output values ​​of the three gyroscopes of the strapdown inertial system. The state variables are the three attitude angles θ defined by the rotating vector method. x ,θ y ,θ z , and then the initial alignment of the strapdown system can be achieved by solving the above three attitude angles. Compared with the full attitude initial alignment method of the strapdown inertial system based on the rotation vector given in China CN201218004104.1, the initial alignment method of the present invention has the advantages of simple, fast and accurate calculation process and can achieve full attitude alignment.

[0048] Combine the following Figure 3 The method of the present invention is introduced, and the steps are as follows Figure 2 shown.

[0049] (1) Establish the initial alignment equation of the strapdown inertial system static base

[0050]

[0051] Among them, L is the northeast sky geographic coordinate system, Figure 1 is the navigation coordinate system based on the geographic coordinate system, b is the carrier coordinate system, i is the inertial coordinate system, and e is the inertial coordinate system; is the transformation matrix from the northeast sky geographic coordinate system to the carrier coordinate system; is the carrier angular velocity vector, is the output angular velocity of the gyroscope combination, ω x is the output angular velocity of the X-axis gyroscope in the carrier coordinate system, ω y is the output angular velocity of the Y-axis gyroscope in the carrier coordinate system, ω z is the output angular velocity of the Z-axis gyroscope in the carrier coordinate system; is the projection angular velocity vector of the northeast celestial geographic coordinate system relative to the inertial coordinate system in the northeast celestial geographic coordinate system, ωie is the Earth's rotation angular velocity, is the local geographical latitude; is the output vector of the accelerometer combination, a x is the output of the X-axis accelerometer in the carrier coordinate system, a y is the output of the Y-axis accelerometer in the carrier coordinate system, a z is the output of the Z-axis accelerometer in the carrier coordinate system; is the local acceleration vector, g is the acceleration due to gravity;

[0052] (2) The output value of the accelerometer combination under the static base condition of the strapdown inertial system expressed in terms of the rotation vector attitude angle is

[0053]

[0054] The output value of the gyroscope combination is

[0055]

[0056] In the formula,

[0057] θ is the rotation vector attitude angle,

[0058] θ x is the component of θ on the X-axis of the navigation coordinate system;

[0059] θ y is the component of θ on the Y axis of the navigation coordinate system;

[0060] θ z is the component of θ on the Z axis of the navigation coordinate system;

[0061] (3) Using the output values ​​a of the three accelerometers in the strapdown inertial system in the carrier coordinate system x 、a y 、a z and the output angular velocity ω of the three gyroscopes x ,ω y ,ω z Solve the two output equations in step (2) to obtain the three rotation vector attitude angles θ x ,θ y ,θ z The value of

[0062]

[0063] And determine the transformation matrix from the navigation coordinate system to the carrier coordinate system for

[0064]

[0065] This completes the initial alignment of the strapdown inertial system.

[0066] Example:

[0067] Assume that the coordinate transformation matrix of the carrier coordinate system relative to the navigation coordinate system is

[0068]

[0069] The corresponding rotation vector is

[0070]

[0071] The corresponding accelerometer output value is

[0072]

[0073] The combined output of the gyroscope is

[0074]

[0075] The initial alignment can be achieved by using the combined output value of the accelerometer and the output value of the gyroscope. The method given in Chinese patent CN201218004104.1 is compared with the method given in the present invention.

[0076] (1) The method given in Chinese patent CN201218004104.1

[0077] because

[0078]

[0079] is a quadratic equation, and its roots are solved according to the following formula

[0080]

[0081] Substitute the two roots into the following formula

[0082]

[0083] We can calculate r1 = 0.64 and r2 = -16. We can choose a value of r ≥ 0.5 between the two to find the unique

[0084] On this basis, we solve

[0085]

[0086] (2) The method provided by the present invention

[0087] According to step (3) of the present invention, the value of the rotation vector can be directly calculated.

[0088]

[0089]

[0090] It can be seen that compared with the method given in Chinese patent CN201218004104.1, the method given in the present invention is simple and accurate in calculation.

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

[0092] 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 fast and accurate initial alignment method for a strapdown inertial system based on a rotating vector method, characterized in that: include: Establish the initial alignment equation of the static base of the strapdown inertial system; The output equation of the accelerometer combination and the output equation of the gyroscope combination of the strapdown inertial system under the static base condition are expressed in terms of the rotating vector attitude angle; Using the output values ​​of the three accelerometers in the strapdown inertial system and the output angular velocities of the three gyroscopes in the carrier coordinate system, the output equations of the accelerometer combination and the gyroscope combination are solved to obtain the values ​​of the three rotation vector attitude angles, and the transformation matrix from the navigation coordinate system to the carrier coordinate system is determined to complete the initial alignment.

2. The strapdown inertial system fast and accurate initial alignment method according to claim 1, characterized in that: The initial alignment equation of the strapdown inertial system static base is: Among them, L is the northeast sky geographic coordinate system, b is the carrier coordinate system, and i is the inertial coordinate system; is the transformation matrix from the northeast sky geographic coordinate system to the carrier coordinate system; is the carrier angular velocity vector, is the projection angular velocity vector of the northeast celestial geographic coordinate system relative to the inertial coordinate system in the northeast celestial geographic coordinate system, is the output vector of the accelerometer combination, is the local acceleration vector.

3. The strapdown inertial system fast and accurate initial alignment method according to claim 1, characterized in that: The output equation of the accelerometer combination of the strapdown inertial system under static base conditions expressed in terms of the rotating vector attitude angle is: The output equation of the gyroscope combination is In the formula θ is the rotation vector attitude angle, θ x is the component of θ on the X-axis of the navigation coordinate system; θ y is the component of θ on the Y axis of the navigation coordinate system; θ z is the component of θ on the Z axis of the navigation coordinate system; a x is the output of the X-axis accelerometer in the carrier coordinate system, a y is the output of the Y-axis accelerometer in the carrier coordinate system, a z is the output of the Z-axis accelerometer in the carrier coordinate system; g is the gravitational acceleration; ω x is the output angular velocity of the X-axis gyroscope in the carrier coordinate system, ω y is the output angular velocity of the Y-axis gyroscope in the carrier coordinate system, ω z is the output angular velocity of the Z-axis gyroscope in the carrier coordinate system; ω ie is the Earth's rotation angular velocity, is the local geographical latitude.

4. The strapdown inertial system fast and accurate initial alignment method according to claim 3, characterized in that: Three rotation vector attitude angles θ x ,θ y ,θ z The values ​​are:

5. The strapdown inertial system fast and accurate initial alignment method according to claim 4, characterized in that: Transformation matrix from navigation coordinate system to carrier coordinate system for 6. A fast and accurate initial alignment device for a strapdown inertial system based on a rotating vector method, characterized in that: include: The first module is used to establish the initial alignment equation of the static base of the strapdown inertial system; The second module uses the rotating vector attitude angle to represent the output equation of the accelerometer combination and the output equation of the gyroscope combination under the static base condition of the strapdown inertial system; The third module uses the output values ​​of the three accelerometers in the strapdown inertial system and the output angular velocities of the three gyroscopes in the carrier coordinate system to solve the output equations of the accelerometer combination and the gyroscope combination of the second module, obtain the values ​​of the three rotation vector attitude angles, and determine the transformation matrix from the navigation coordinate system to the carrier coordinate system to complete the initial alignment.

7. The fast and accurate initial alignment device for a strapdown inertial system according to claim 6, characterized in that: The initial alignment equation of the strapdown inertial system static base is: Among them, L is the northeast sky geographic coordinate system, b is the carrier coordinate system, and i is the inertial coordinate system; is the transformation matrix from the northeast sky geographic coordinate system to the carrier coordinate system; is the carrier angular velocity vector, is the projection angular velocity vector of the northeast celestial geographic coordinate system relative to the inertial coordinate system in the northeast celestial geographic coordinate system, is the output vector of the accelerometer combination, is the local acceleration vector.

8. The fast and accurate initial alignment device for a strapdown inertial system according to claim 6, characterized in that: The output equation of the accelerometer combination of the strapdown inertial system under static base conditions expressed in terms of the rotating vector attitude angle is: The output equation of the gyroscope combination is In the formula θ is the rotation vector attitude angle, θ x is the component of θ on the X-axis of the navigation coordinate system; θ y is the component of θ on the Y axis of the navigation coordinate system; θ z is the component of θ on the Z axis of the navigation coordinate system; a x is the output of the X-axis accelerometer in the carrier coordinate system, a y is the output of the Y-axis accelerometer in the carrier coordinate system, a z is the output of the Z-axis accelerometer in the carrier coordinate system; g is the gravitational acceleration; ω x is the output angular velocity of the X-axis gyroscope in the carrier coordinate system, ω y is the output angular velocity of the Y-axis gyroscope in the carrier coordinate system, ω z is the output angular velocity of the Z-axis gyroscope in the carrier coordinate system; ω ie is the Earth's rotation angular velocity, is the local geographical latitude.

9. The fast and accurate initial alignment device for a strapdown inertial system according to claim 8, characterized in that: Three rotation vector attitude angles θ x ,θ y ,θ z The values ​​are:

10. The fast and accurate initial alignment device for a strapdown inertial system according to claim 9, characterized in that: Transformation matrix from navigation coordinate system to carrier coordinate system for