A fast alignment method for MEMS inertial navigation system based on reference surface

By fixing the reference surface on the ship, estimating and correcting the zero-bias drift value of the MEMS inertial navigation system, combined with the main inertial navigation attitude matrix, the attitude error problem of the MEMS inertial navigation unit under dynamic conditions at sea is solved, and high-precision The alignment and navigation accuracy of the inertial navigation system are maintained.

CN117589193BActive Publication Date: 2024-11-01CHINA STATE SHIPBUILDING CORP LTD RESEARCH INSTITUTE 719
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202311506360.4
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2023-11-13
Publication Date
2024-11-01
Estimated Expiration
2043-11-13

AI Technical Summary

Technical Problem

The MEMS inertial measurement unit has cumulative errors in the attitude resolution process, especially in the dynamic conditions at sea, and the traditional zero-speed correction and complementary filtering methods are not suitable for high-precision attitude measurement.

Method used

通过在舰船船体上固定参考面,将MEMS惯导系统载体固定在参考面上,进行快速对准模式,采集主惯导和MEMS惯导陀螺仪的角速度输出值,估计零偏漂移值,并利用修正后的值进行姿态解算,结合主惯导姿态矩阵进行高精度姿态测量。

Benefits of technology

It effectively suppresses the divergence of attitude errors of the MEMS inertial navigation system under dynamic conditions, extends the navigation accuracy holding time, and realizes high-precision alignment of the MEMS inertial navigation system.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN117589193B_ABST
    Figure CN117589193B_ABST
Patent Text Reader

Abstract

The present invention proposes a method for rapid alignment of a MEMS inertial navigation system based on a reference surface. Under dynamic conditions at sea, a reference surface with a known installation status is used to compensate for the device error of the MEMS using MEMS gyro zero bias estimation, and the main inertial navigation attitude is used for assignment. This method can achieve high-precision alignment of the MEMS under dynamic conditions and extend the navigation accuracy retention time.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the technical field of MEMS inertial measurement, and in particular relates to a fast alignment method of a MEMS inertial navigation system based on a reference surface. Background Art

[0002] With the continuous development of modernization and automation, the demand for low-cost, high-precision, modular and highly integrated inertial navigation and positioning systems in the civil and military fields is becoming increasingly strong. With the continuous development of semiconductor technology and sensor technology, MEMS inertial sensor devices have emerged. MEMS inertial measurement units include MEMS gyroscopes and MEMS accelerometers, which can realize real-time measurement of attitude information. However, in the process of attitude solution based solely on MEMS inertial measurement units, there are inevitably cumulative errors in attitude updates, which reduces the accuracy of attitude measurement. The marine equipment using MEMS inertial navigation systems needs to maintain the corresponding accuracy level within a certain holding time. At the same time, traditional methods such as zero-speed correction and complementary filtering are not suitable for high-precision attitude measurement during navigation. Therefore, it is necessary to design a method that can effectively suppress the divergence of attitude errors caused by MIMU drift in a short time. Summary of the invention

[0003] In view of this, an object of the present invention is to provide a fast alignment method of a MEMS inertial navigation system based on a reference surface.

[0004] A method for rapid alignment of a MEMS inertial navigation system based on a reference surface, comprising:

[0005] Step 1: Fix a reference surface on the ship hull, then fix the MEMS inertial navigation system carrier on the reference surface and enter the fast alignment mode;

[0006] Step 2: After completing step 1, the MEMS inertial navigation system carrier and the reference surface are in a relatively static state for a set time;

[0007] Step 3: In a relatively static state, collect the angular velocity output values ​​of the main inertial navigation gyroscope and the angular velocity output values ​​of the MEMS inertial navigation gyroscope, and perform MEMS zero bias drift estimation to obtain the zero bias drift value ε;

[0008] Step 4: Pass the master inertial navigation attitude matrix to the MEMS inertial navigation sub-inertial navigation:

[0009]

[0010] In the formula, Represents the direction cosine matrix of the MEMS gyroscope in the navigation coordinate system, The direction cosine matrix of the ship's main inertial navigation system at the last moment of the alignment mode is sent by the communication equipment. Represents the pre-calibrated reference plane and the installation angle direction cosine matrix of the ship hull; in the subsequent device operation process, As the initial value of strapdown attitude solution;

[0011] Step 5: In the subsequent actual side angle measurement process, the bias drift estimation value calculated in step 3 is first used to correct the angular velocity output value of the gyroscope of the MEMS-IMU;

[0012] Then use the corrected MEMS-IMU gyroscope angular velocity output value and the attitude matrix passed in step 4 Perform attitude calculation to obtain the heading measurement value at the next moment.

[0013] Preferably, in step 3, the calculation process of the MEMS gyro zero bias drift value includes:

[0014]

[0015] In the formula, They represent the angular velocity output values ​​of the gyroscopes of the main inertial navigation and the sub-inertial navigation at the i-th data point respectively, and N represents the total number of data points collected.

[0016] Preferably, the set time is 5 minutes.

[0017] The present invention has the following beneficial effects:

[0018] The present invention proposes a method for rapid alignment of a MEMS inertial navigation system based on a reference surface. Under dynamic conditions at sea, a reference surface with a known installation status is used to compensate for the device error of the MEMS using MEMS gyro zero bias estimation, and the main inertial navigation attitude is used for assignment. This method can achieve high-precision alignment of the MEMS under dynamic conditions and extend the navigation accuracy retention time. BRIEF DESCRIPTION OF THE DRAWINGS

[0019] Figure 1 It is a schematic diagram of the reference surface of the present invention docked on the hull of a ship;

[0020] Among them, 1-ship hull, 2-MEMS inertial navigation system carrier, 3-MEMS inertial navigation system, 4-reference surface. DETAILED DESCRIPTION

[0021] The present invention is described in detail below with reference to the accompanying drawings and embodiments.

[0022] The current attitude calculation process of the existing MEMS inertial measurement unit is as follows:

[0023] Select the "East-North-Sky" geographic coordinate system as the navigation reference coordinate system of the strapdown inertial navigation system, hereinafter referred to as the n system, then the attitude differential equation with the n system as the reference system is

[0024]

[0025] Among them, the matrix It represents the attitude matrix of the carrier system (b system) relative to the navigation coordinate system (n system). Since the gyro output in the MEMS inertial navigation is the angular velocity of the b system relative to the inertial system (i system), The angular velocity information It cannot be directly measured, and the differential equation (1) needs to be transformed as follows:

[0026]

[0027] in, It represents the rotation of the n system relative to the i system, which includes two parts: the rotation of the navigation system caused by the rotation of the earth, and the rotation of the n system caused by the curvature of the earth's surface when the inertial navigation system moves near the earth's surface. in:

[0028]

[0029]

[0030] In the formula, ω ie is the angular rate of the Earth's rotation, L and h are the geographical latitude and altitude respectively.

[0031] and matrix differential equations In comparison, although equation (2) is also linear and time-varying, its discretization solution is more troublesome. Generally, the equation is not solved directly, but the following method is used to solve the attitude matrix update problem.

[0032] According to the matrix chain multiplication rule, we have:

[0033]

[0034] In the formula, the symbol m in the brackets represents t m Since the i system is an absolutely stationary inertial reference coordinate system, it is independent of time and does not need to be marked with time; while the n system and the b system are both moving coordinate systems relative to the i system, and are related to time, so the time needs to be marked. Represents the transformation matrix of the n-system relative to the geocentric coordinate system at the m-th moment.

[0035] According to the attitude matrix differential equation and The update algorithm relative to the inertial system can be obtained respectively

[0036]

[0037]

[0038] Among them, the matrix Indicates that the i system is used as the reference standard, and the b system is from t m-1 Time to t m The rotation changes at any moment, The angular velocity of the gyro Sure; It means that the i system is used as the reference standard, and the n system is from t m Time to t m-1 The rotation changes at any moment, The angular velocity can be calculated by Sure.

[0039] Substituting equations (6) and (7) into equation (5), we get

[0040]

[0041] in, and Respectively represent t m-1 and t m The strapdown attitude matrix at the moment. If the gyro is in the time period [t m-1 , t m ] (T = t m -t m-1 ) were sampled twice at equal intervals, with the angular increments being △θ m1 and Δθ m2 , using the two-sample cone error compensation algorithm, we have:

[0042]

[0043]

[0044] Usually in the navigation update cycle [t m-1 , t m ], it can be considered that the The change is small, visible is a constant value, denoted by Then we have:

[0045]

[0046] Combining formula (11) and formula (8), the attitude rotation matrix of MEMS in the navigation system at the current moment can be obtained: Then, the main inertial navigation attitude information sent by the information transmission device and the reference plane installation angle need to be quickly calibrated. If the coordinate system of the device and the MEMS are set to coincide, then after the above inertial information attitude solution, the current attitude cosine matrix of the device with poor accuracy can be obtained in real time: Dock the device on the reference plane. Set the direction cosine matrix corresponding to the installation error angle of the reference plane relative to the carrier main inertial navigation as This information can be stored in the device in advance after calibration. The direction cosine matrix of the main inertial navigation relative navigation coordinate system sent by the carrier to the device is From this, we can obtain the direction cosine matrix of the reference plane relative to the navigation coordinate system:

[0047]

[0048] Since the MEMS inertial navigation system carrier is parked on the reference plane at this time, it can be considered that the attitude of the MEMS inertial navigation system coincides with the reference plane at this time, so the corrected direction cosine matrix and heading angle of the MEMS inertial navigation system can be obtained:

[0049]

[0050]

[0051] Where head represents the current MEMS heading. The difference between this heading and the main inertial navigation heading is used as the measured side angle of the target.

[0052] In order to further improve the ability of maintaining the accuracy of the device's side angle measurement, the present invention uses the difference between the original angular rate of the gyro sent by the main inertial navigation and the original angular rate of the MEMS inertial navigation itself in the rapid alignment process to estimate the zero bias of the MEMS gyro, so as to correct the original angular rate in the subsequent inertial navigation solution process. The specific process includes:

[0053] Step 1: At the initial moment of equipment operation, fix a reference surface on the ship hull, then fix the MEMS inertial navigation system carrier on the reference surface and enter the fast alignment mode.

[0054] Step 2: After completing step 1, the MEMS inertial navigation system carrier and the reference surface remain relatively stationary for a short period of 5 minutes.

[0055] Step 3: In a relatively static state, collect the angular velocity output values ​​of the main inertial navigation gyroscope and the angular velocity output values ​​of the MEMS inertial navigation gyroscope, and estimate the zero bias drift of the MEMS:

[0056]

[0057] In the formula, They represent the angular velocity output values ​​of the main inertial navigation and sub-inertial navigation gyroscopes at the i-th data point, respectively, N represents the total number of data points collected, and ε represents the estimated MEMS gyro zero bias drift value.

[0058] Step 4: Transfer the master inertial navigation attitude matrix to the MEMS inertial navigation sub-inertial navigation.

[0059]

[0060] In the formula, Represents the direction cosine matrix of the MEMS gyroscope in the navigation coordinate system, The direction cosine matrix of the ship's main inertial navigation system at the last moment of the five-minute fast alignment mode is sent by the communication equipment. represents the installation angle direction cosine matrix of the pre-calibrated reference plane and the ship hull. As the initial value of the strapdown attitude solution.

[0061] Step 5: In the subsequent actual side angle measurement process, the bias drift estimation value calculated in step 3 is first used to correct the angular velocity output value of the gyroscope of the MEMS-IMU;

[0062] Then use the corrected MEMS-IMU gyroscope angular velocity output value and the attitude matrix passed in step 4 Perform attitude calculation to obtain the heading measurement value at the next moment.

[0063] In summary, the above are only preferred embodiments of the present invention and are not intended to limit the protection scope of the present invention. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the present invention should be included in the protection scope of the present invention.

Claims

1. A method for rapid alignment of a MEMS inertial navigation system based on a reference surface, characterized in that: include: Step 1: Fix a reference surface on the ship hull, then fix the MEMS inertial navigation system carrier on the reference surface and enter the fast alignment mode; Step 2: After completing step 1, the MEMS inertial navigation system carrier and the reference surface are in a relatively static state for a set time; Step 3: In a relatively static state, collect the angular velocity output values ​​of the main inertial navigation gyroscope and the angular velocity output values ​​of the MEMS inertial navigation gyroscope, and perform MEMS zero bias drift estimation to obtain the zero bias drift value ε; Step 4: Pass the master inertial navigation attitude matrix to the MEMS inertial navigation sub-inertial navigation: In the formula, Represents the direction cosine matrix of the MEMS gyroscope in the navigation coordinate system, The direction cosine matrix of the ship's main inertial navigation system at the last moment of the alignment mode is sent by the communication equipment. Represents the pre-calibrated reference plane and the installation angle direction cosine matrix of the ship hull; in the subsequent device operation process, As the initial value of strapdown attitude solution; Step 5: In the subsequent actual side angle measurement process, the bias drift estimation value calculated in step 3 is first used to correct the angular velocity output value of the gyroscope of the MEMS-IMU; Then use the corrected MEMS-IMU gyroscope angular velocity output value and the attitude matrix passed in step 4 Perform attitude calculation to obtain the heading measurement value at the next moment.

2. A method for rapid alignment of a MEMS inertial navigation system based on a reference surface as claimed in claim 1, characterized in that: In step 3, the calculation process of the MEMS gyro zero bias drift value includes: In the formula, They represent the angular velocity output values ​​of the gyroscopes of the main inertial navigation and the sub-inertial navigation at the i-th data point respectively, and N represents the total number of data points collected.

3. A method for rapid alignment of a MEMS inertial navigation system based on a reference surface as claimed in claim 1, characterized in that: The setting time is 5 minutes.