CN114088118B - Calibration compensation method for MEMS gyroscope by forward and reverse rotation method - Google Patents
Calibration compensation method for MEMS gyroscope by forward and reverse rotation method Download PDFInfo
- Publication number
- CN114088118B CN114088118B CN202111491013.XA CN202111491013A CN114088118B CN 114088118 B CN114088118 B CN 114088118B CN 202111491013 A CN202111491013 A CN 202111491013A CN 114088118 B CN114088118 B CN 114088118B
- Authority
- CN
- China
- Prior art keywords
- gyroscope
- turntable
- mems gyroscope
- mems
- mimu
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 21
- 238000005259 measurement Methods 0.000 claims abstract description 14
- 230000003068 static effect Effects 0.000 claims abstract description 14
- 230000014509 gene expression Effects 0.000 claims abstract description 10
- 238000009434 installation Methods 0.000 claims description 11
- 238000002474 experimental method Methods 0.000 claims description 4
- 238000013178 mathematical model Methods 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 2
- 238000007689 inspection Methods 0.000 abstract description 2
- 238000005516 engineering process Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000013307 optical fiber Substances 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Gyroscopes (AREA)
Abstract
The invention provides a calibration compensation method for a MEMS gyroscope by a forward and backward rotation method, which can ensure that the precision of the calibrated MEMS gyroscope is very high. Firstly, establishing a static error model expression of the MEMS gyroscope; placing the turntable at a vertical upward position, fixing the MIMU on the turntable, and measuring error angles alpha and beta of the turntable and the MIMU; when the rotating speed input value of the turntable is omega and the rotating speed input value of the turntable is omega, respectively carrying out forward rotation and reverse rotation, the output expressions of the y-axis gyroscope and the z-axis gyroscope can be obtained; the positive rotation and the negative rotation are respectively used for measuring 3 groups of data, and the positive and negative rotation measurement results are added to obtain zero offset of the MEMS gyroscope; subtracting the positive and negative rotation measurement results, calculating all parameters in a static error model of the MEMS gyroscope, obtaining an error equation of the MEMS gyroscope, and completing the calibration of the gyroscope; finally, experimental inspection is carried out on the turntable, so that the precision of the calibrated MEMS gyroscope can be seen to be very high.
Description
Technical Field
The invention relates to the technical field of micro-mechanical inertial measurement, in particular to a calibration and compensation method of a MEMS gyroscope by a forward and reverse rotation method.
Background
With the development of micro-electromechanical system (MEMS) technology, micro Inertial Measurement Units (MIMU) are increasingly applied to various fields such as measurement, navigation, etc. by virtue of their small size, low power consumption and strong overload resistance. Compared with a measuring unit formed by a high-precision inertial sensor such as a laser gyro, an optical fiber gyro and the like, the gyro in the MIMU has larger drift and cannot sense the rotation angular velocity of the earth. And the calibration of the inertial device error determines the accuracy of the system. Therefore, how to quickly and accurately calibrate MIMU inertial devices has been a key technology for MIMU integration and application.
Error compensation of MEMS inertial devices is an important means to improve their accuracy. Many of the leading research institutions in MEMS technology focus on the research of MEMS gyroscopes and accelerometer error modeling and error compensation methods. Such as the California university MEMS Laboratory in the united states, has conducted extensive analysis of manufacturing process errors and has proposed some compensation methods. When the MEMS inertial device and IMU errors are compensated, an error model of zero offset, zero offset instability, scale factor errors, misalignment angles, random noise and the like is established to carry out model parameter identification, and then compensation is carried out. However, the input values are not considered at the same time to respectively perform the calibration during the forward rotation and the reverse rotation, so that the precision of the MEMS gyroscope calibrated by the existing calibration compensation method is not high.
Disclosure of Invention
In view of the above, the invention provides a calibration and compensation method for a positive and negative rotation MEMS gyroscope, which can enable the precision of the calibrated MEMS gyroscope to be very high.
The technical scheme for realizing the invention is as follows:
a calibration and compensation method of a MEMS gyroscope by a forward and backward rotation method comprises the following steps:
step one, establishing a static error calibration model of the MEMS gyroscope according to a mathematical model of the zero point error, the scale factor error and the installation error of the MIMU;
step two, placing the turntable at a vertical upward position, fixing the MIMU on the turntable, and measuring the error angle between the turntable and the MIMU;
thirdly, when the rotating speed input value of the turntable is omega, respectively carrying out forward rotation and reverse rotation, obtaining output expressions of the y-axis gyroscope and the z-axis gyroscope; the positive rotation and the negative rotation respectively measure 3 groups of data, and the measurement results of the positive rotation and the negative rotation are added to obtain zero offset of the MEMS gyroscope; and subtracting the forward and reverse rotation measurement results to obtain all parameters in the static error model of the MEMS gyroscope, and obtaining an error equation of the MEMS gyroscope to finish the calibration of the gyroscope.
In the first step, the static error model of the MEMS gyroscope is as follows:
in which W is o =[W x W y W z ] T Output value for gyroscope; b (B) g =[B gx B gy B gz ] T Zero drift for the gyroscope; s is S gx ,S gy ,S gz Is marked with a scaleFactor coefficient; k (K) gx1 ,K gx2 ,K gy1 ,K gy2 ,K gz1 ,K gz2 Is the installation error coefficient; omega= [ omega ] x ω y ω z ] T Values are entered for the gyroscope.
When the rotational speed input value of the turntable is omega, respectively performing forward rotation and reverse rotation, obtaining output expressions of the y-axis gyroscope and the z-axis gyroscope, wherein the output expressions are as follows:
W y+ =B gy +K gy1 ω-S gy ωα+K gy2 ωβ
W y- =B gy -K gy1 ω+S gy ωα-K gy2 ωβ
W z+ =B gz +K gz1 ω-K gz2 ωα+S gz ωβ
W z- =B gz -K gz1 ω+K gz2 ωα-S gz ωβ。
wherein, zero offset of MEMS gyroscope is:
wherein K is gy2 And K gz2 Approximately 0,S gy And S is gz Approximately 1, K gy1 And K gz1 The values of (2) are:
values of the remaining parameters:
wherein, still include the following step:
calibrating the MEMS gyroscope based on the physical experiment;
and fifthly, checking the calibration result of the MEMS gyroscope by using a turntable.
The beneficial effects are that:
firstly, establishing a static error model expression of an MEMS gyroscope; placing the turntable at a vertical upward position, fixing the MIMU on the turntable, and measuring error angles alpha and beta of the turntable and the MIMU; when the rotating speed input value of the turntable is omega and the rotating speed input value of the turntable is omega, respectively carrying out forward rotation and reverse rotation, the output expressions of the y-axis gyroscope and the z-axis gyroscope can be obtained; the forward rotation and the reverse rotation are respectively used for measuring 3 groups of data, the forward rotation and the reverse rotation are added, the zero offset of the MEMS gyroscope can be obtained, the forward rotation and the reverse rotation are subtracted, all parameters in a static error model of the MEMS gyroscope can be calculated, an error equation of the MEMS gyroscope is obtained, and the calibration of the gyroscope is completed; finally, experimental inspection is carried out on the turntable, so that the precision of the calibrated MEMS gyroscope can be seen to be very high.
Drawings
FIG. 1 is a general flow chart of the present invention.
FIG. 2 is a schematic diagram of an experimental MIMU according to the present invention.
Fig. 3 shows the output values of the MEMS gyroscope of the present invention.
Detailed Description
The invention will now be described in detail by way of example with reference to the accompanying drawings.
The positive and negative rotation method of the invention is a method that the turntable rotates positively and reversely at a fixed rotation speed respectively, and then redundant parameters are eliminated according to the established error model, so that the error model is calculated, and the calibrated MEMS gyroscope has high precision. Referring to fig. 1, which is a general execution flow chart of the invention, the invention designs a calibration and compensation method of a positive and negative rotation method MEMS gyroscope, comprising the following steps:
step one, establishing a static error model of the MEMS gyroscope according to a mathematical model of the zero point error, the scale factor error and the installation error of the MIMU:
in which W is o =[W x W y W z ] T Output value for gyroscope; b (B) g =[B gx B gy B gz ] T Zero drift for the gyroscope; s is S gx ,S gy ,S gz Is a scale factor coefficient; k (K) gx1 ,K gx2 ,K gy1 ,K gy2 ,K gz1 ,K gz2 Is the installation error coefficient; omega= [ omega ] x ω y ω z ] T Values are entered for the gyroscope.
And secondly, placing the turntable at a vertical upward position, fixing the MIMU on the turntable, and measuring error angles alpha and beta of the turntable and the MIMU. Then when the turntable rotation speed input value is omega= [ omega 00] T The actual input of the gyroscope is shown in the following equation.
ω i =[ω -ωα ωβ] T
Step three, when the rotational speed input value of the turntable is omega, respectively carrying out forward rotation and reverse rotation, obtaining the output of the y-axis gyroscope and the z-axis gyroscope, wherein the output of the y-axis gyroscope and the z-axis gyroscope are as follows:
W y+ =B gy +K gy1 ω-S gy ωα+K gy2 β
W y- =B gy -K gy1 ω+S gy ωα-K gy2 ωβ
W z+ =B gz +K gz1 ω-K gz2 ωα+S gz ωβ
W z- =B gz -K gz1 ω+K gz2 ωα-S gz ωβ
if the data of each measurement 3 groups are forward rotated and reverse rotated, the measurement results of the forward rotation and the reverse rotation are added, and zero offset of the MEMS gyroscope can be obtained:
because of both installation errors and scale factor errorsVery small, so the following assumptions are made first in the intermediate calculation process: k in the formula gy2 And K gz2 Approximately 0,S gy And S is gz Approximately 1, then K can be obtained by subtracting the positive and negative rotation measurement results gy1 And K gz1 The values of (2) are:
and continuously subtracting the forward and reverse rotation measurement results to obtain the value of the residual parameter:
thus, all parameters in the static error model of the MEMS gyroscope are calculated, and the calibration of the gyroscope is completed.
And step four, calibrating the MEMS gyroscope based on the physical experiment.
The experimental calibration MIMU consists of a MEMS triaxial accelerometer and two uniaxial MEMS gyroscopes, and the structure of the MIMU is shown in figure 2.
The turntable and MIMU are maintained in a state in which the mounting error between the two is measured, i.e., the turntable is vertically upward at this time. The control turntable rotates for more than 1 minute at +/-360 degrees/s, +/-1080 degrees/s and +/-2160 degrees/s respectively, and the output value of the MEMS gyroscope is collected at the sampling frequency of 200Hz, and the result is shown in figure 3.
As can be seen from fig. 3, the y, z-axis gyroscope exhibits significant sinusoidal fluctuations due to the coupling of the x-axis roll information. Along with the increase of the rotating speed of the turntable, the absolute values of data output by the y-axis gyroscope and the z-axis gyroscope are larger and larger, which is caused by the installation error between the MIMU and the turntable, and the influence of the larger rotating speed is more obvious, so that the error compensation has an important effect.
And selecting a section of more stable data from the measured results to obtain a mean value, wherein the obtained result is shown in table 1. Table 1 shows the gyroscope output for forward and reverse rotation at a fixed rotational speed.
Then, substituting the data in table 1 into the MEMS gyroscope static error model, each parameter in the MEMS gyroscope static error model can be calculated, and the error equation is obtained as follows:
fifthly, checking a calibration result of the accelerometer by using the turntable, and collecting output values of the gyroscope when the rotating speeds of the turntable are respectively +720 degrees/s, +/-1440 degrees/s and +/-1800 degrees/s in order to ensure that the installation error angle of the MIMU and the turntable is kept unchanged and the turntable is kept in a vertical and upward state. Then, the calibration result is written into the control unit of the MIMU, and the output value of the gyroscope is measured under the same condition, and the result obtained by comparing the two is shown in the table 2. Table 2 shows MEMS gyroscope output values before and after calibration.
It can be seen from table 2 that the calibrated MEMS gyroscope output values are very accurate. The maximum values of the y-axis and z-axis outputs before calibration were-6.8678 DEG/s and-13.0737 DEG/s, respectively. But after calibration the output became-0.089 deg./s and-0.0421 deg./s. Thus, the experiment has higher accuracy for the calibration of the MIMU and in actual measurement the effect of its deterministic error can be disregarded for the compensated MEMS gyroscope.
TABLE 1 output of gyroscopes rotating in opposite directions at fixed rotational speeds
Table 2 calibration of MEMS gyroscope output values
In summary, the above embodiments are only preferred embodiments of the present invention, and are not intended to limit the scope of the present invention. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present invention should be included in the protection scope of the present invention.
Claims (1)
1. The MEMS gyroscope calibration compensation method by the forward and backward rotation method is characterized by comprising the following steps of:
step one, establishing a static error calibration model of the MEMS gyroscope according to a mathematical model of the zero point error, the scale factor error and the installation error of the MIMU; the static error model of the MEMS gyroscope is as follows:
in which W is o =[W x W y W z ] T Output value for gyroscope; b (B) g =[B gx B gy B gz ] T Zero drift for the gyroscope; s is S gx ,S gy ,S gz Is a scale factor coefficient; k (K) gx1 ,K gx2 ,K gy1 ,K gy2 ,K gz1 ,K gz2 Is the installation error coefficient; omega= [ omega ] x ω y ω z ] T Inputting a value for a gyroscope;
step two, placing the turntable at a vertical upward position, fixing the MIMU on the turntable, and measuring the error angle between the turntable and the MIMU;
thirdly, when the rotating speed input value of the turntable is omega, respectively carrying out forward rotation and reverse rotation, obtaining output expressions of the y-axis gyroscope and the z-axis gyroscope; the positive rotation and the negative rotation respectively measure 3 groups of data, and the measurement results of the positive rotation and the negative rotation are added to obtain zero offset of the MEMS gyroscope; subtracting the positive and negative rotation measurement results to obtain all parameters in a static error model of the MEMS gyroscope, and obtaining an error equation of the MEMS gyroscope to finish the calibration of the gyroscope;
when the rotating speed input value of the turntable is omega, respectively carrying out forward rotation and reverse rotation, obtaining output expressions of the y-axis gyroscope and the z-axis gyroscope, wherein the output expressions are as follows:
the zero bias of the MEMS gyroscope is:
K gy2 and K gz2 Approximately 0,S gy And S is gz Approximately 1, K gy1 And K gz1 The values of (2) are:
values of the remaining parameters:
calibrating the MEMS gyroscope based on the physical experiment; the calibrated MIMU consists of an MEMS triaxial accelerometer and two uniaxial MEMS gyroscopes;
maintaining the turntable and the MIMU in a state of measuring an installation error between the turntable and the MIMU, namely, vertically upwards the turntable at the moment; the rotary table is controlled to rotate for more than 1 minute at the rotating speeds of +/-360 degrees/s, +/-1080 degrees/s and +/-2160 degrees/s respectively, and the output value of the MEMS gyroscope is collected at the sampling frequency of 200 Hz;
checking a MEMS gyroscope calibration result by using a turntable, and in order to ensure that the installation error angle of the MIMU and the turntable is kept unchanged, keeping the turntable in a vertical upward state, and collecting output values of the gyroscope when the rotating speeds of the turntable are +/-720 degrees/s, +/-1440 degrees/s and +/-1800 degrees/s respectively; and then writing the calibration result into a control unit of the MIMU, and measuring the output value of the gyroscope under the same condition.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111491013.XA CN114088118B (en) | 2021-12-08 | 2021-12-08 | Calibration compensation method for MEMS gyroscope by forward and reverse rotation method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111491013.XA CN114088118B (en) | 2021-12-08 | 2021-12-08 | Calibration compensation method for MEMS gyroscope by forward and reverse rotation method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114088118A CN114088118A (en) | 2022-02-25 |
CN114088118B true CN114088118B (en) | 2024-04-05 |
Family
ID=80306853
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111491013.XA Active CN114088118B (en) | 2021-12-08 | 2021-12-08 | Calibration compensation method for MEMS gyroscope by forward and reverse rotation method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114088118B (en) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103196462A (en) * | 2013-02-28 | 2013-07-10 | 南京航空航天大学 | Compensation method for error calibration of MEMS gyroscope in MIMU |
WO2013131471A1 (en) * | 2012-03-06 | 2013-09-12 | 武汉大学 | Quick calibration method for inertial measurement unit |
CN104101363A (en) * | 2014-07-28 | 2014-10-15 | 中国电子科技集团公司第二十六研究所 | Gyroscope dynamic calibration method for measuring rotary carrier transversal posture |
CN108132060A (en) * | 2017-11-17 | 2018-06-08 | 北京计算机技术及应用研究所 | A kind of systematic calibration method of Strapdown Inertial Navigation System without benchmark |
CN108458725A (en) * | 2017-11-17 | 2018-08-28 | 北京计算机技术及应用研究所 | Systematic calibration method on Strapdown Inertial Navigation System swaying base |
CN108534800A (en) * | 2018-03-09 | 2018-09-14 | 中国科学院长春光学精密机械与物理研究所 | A kind of MEMS-IMU warm population parameter calibration compensation method entirely |
-
2021
- 2021-12-08 CN CN202111491013.XA patent/CN114088118B/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2013131471A1 (en) * | 2012-03-06 | 2013-09-12 | 武汉大学 | Quick calibration method for inertial measurement unit |
CN103196462A (en) * | 2013-02-28 | 2013-07-10 | 南京航空航天大学 | Compensation method for error calibration of MEMS gyroscope in MIMU |
CN104101363A (en) * | 2014-07-28 | 2014-10-15 | 中国电子科技集团公司第二十六研究所 | Gyroscope dynamic calibration method for measuring rotary carrier transversal posture |
CN108132060A (en) * | 2017-11-17 | 2018-06-08 | 北京计算机技术及应用研究所 | A kind of systematic calibration method of Strapdown Inertial Navigation System without benchmark |
CN108458725A (en) * | 2017-11-17 | 2018-08-28 | 北京计算机技术及应用研究所 | Systematic calibration method on Strapdown Inertial Navigation System swaying base |
CN108534800A (en) * | 2018-03-09 | 2018-09-14 | 中国科学院长春光学精密机械与物理研究所 | A kind of MEMS-IMU warm population parameter calibration compensation method entirely |
Also Published As
Publication number | Publication date |
---|---|
CN114088118A (en) | 2022-02-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Wang et al. | A self-calibration method for nonorthogonal angles between gimbals of rotational inertial navigation system | |
CN110006450B (en) | Calibration method of laser strapdown inertial navigation system on horizontal three-axis turntable | |
CN107655493B (en) | SINS six-position system-level calibration method for fiber-optic gyroscope | |
CN106969783B (en) | Single-axis rotation rapid calibration technology based on fiber-optic gyroscope inertial navigation | |
CN1330935C (en) | Microinertia measuring unit precisive calibration for installation fault angle and rating factor decoupling | |
CN110160554B (en) | Single-axis rotation strapdown inertial navigation system calibration method based on optimization method | |
CN101290326B (en) | Parameter identification calibration method for rock quartz flexibility accelerometer measuring component | |
Ren et al. | A novel self-calibration method for MIMU | |
CN105043412B (en) | A kind of Inertial Measurement Unit error compensating method | |
CN108195404B (en) | Calibration method for zero drift of gyroscope | |
WO2020164206A1 (en) | Calibration method for gravity gradiometer of rotating accelerometer | |
CN103323625B (en) | Error calibration compensation method of accelerometers in MEMS-IMU under dynamic environment | |
CN104459828B (en) | Based on the non-aligned bearing calibration of earth magnetism vector system around method of principal axes | |
CN106482746B (en) | Lever arm calibration and compensation method in a kind of accelerometer for hybrid inertial navigation system | |
CN101629969A (en) | Calibration compensation and testing method and device of output errors of low-precision optical fiber inertial measurement unit | |
CN105157723A (en) | Fiber gyro-based strapdown inertial navigation system calibration method | |
CN101629830A (en) | Calibration method and device of three-axis integrative high precision fiber optic gyro | |
CN106918438A (en) | The measuring method and system of a kind of multi -components power and torque | |
CN110749338A (en) | Off-axis-rotation composite transposition error calibration method for inertial measurement unit | |
Lin et al. | A high-accuracy method for calibration of nonorthogonal angles in dual-axis rotational inertial navigation system | |
CN112577514A (en) | Calibration method of MEMS (micro-electromechanical system) inertial device | |
CN114088118B (en) | Calibration compensation method for MEMS gyroscope by forward and reverse rotation method | |
Zhang et al. | High precision tri-axial quartz flexible accelerometers resolution measurement method based on tri-axial turntable | |
CN110631605B (en) | Gyro array calibration method and system | |
CN115979311B (en) | PIGA cross quadratic term coefficient calibration method, system, equipment and medium |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |