Abstract
In view of the large output noise and low precision of the Micro-electro-mechanical Systems (MEMS) gyroscope, the virtual gyroscope technology was used to fuse the data of the MEMS gyroscope to improve its output precision. Random error model in the conventional virtual gyroscopes contained an angular rate random walk and angle random walk ignoring other noise items and the virtual gyroscope technology can not compensate all random errors of MEMS gyroscope. So, the improved virtual gyroscope technology based on the autoregressive moving average (ARMA) model was proposed. First, the conventional virtual gyroscope technology was used to model the random error of three MEMS gyroscopes, and the data fusion was carried out by a Kalman filter to get the output of the virtual gyroscope. After that, the ARMA model was used to model the output of the virtual gyroscope, the random error model was improved with the ARMA model, and the Kalman filter was designed based on the improved random error model for data fusion of the MEMS gyroscopes. The experimental results showed that the standard deviation of the output of the virtual gyroscope based on the ARMA model was 1.4 times lower than that of the conventional virtual gyroscope output.
Keywords: MEMS, virtual gyroscope, random error, autoregressive moving average (ARMA) model
1. Introduction
With the advantages of small volume and low cost, MEMS gyroscopes are widely used in aviation, aerospace, and other navigation fields [1,2]. But, the precision of the MEMS gyroscope is lower than the traditional gyroscope because of the limit by the current level of technology. So, it is particularly important to improve the detection accuracy of the MEMS gyroscope by the use of virtual gyroscope technology [3].
The Jet Propulsion Laboratory (JPL) of the US National Space Agency (NASA) simulated 4 gyroscopes for 111 h, the performance of the gyroscope is increased by 173 times with the Kalman filter fusion, and the virtual gyroscope technology has been proposed [4]. The virtual gyroscope technology is used to carry out static and dynamic compensation of MEMS gyro random error [5]. The dynamic modeling of the angle, angular velocity, and angular acceleration is carried out, which increases the compensation precision of the virtual gyroscope in dynamic state [6]. The angular acceleration is modeled as a first order time correlation process, and the dynamic modeling of angular velocity is carried out to further improve the compensation precision of the dynamic virtual gyroscope [7]. The one order autoregressive model (AR (1)) is used to model the angular velocity and the optimal estimation process is improved, which reduces the complexity of data processing and improves the dynamic compensation performance of the virtual gyroscope technology [8]. The Allan variance and adaptive neuro-fuzzy inference system (ANFIS) are combined to carry out the weight of the MEMS gyroscope array. The output of each gyroscope is multiplied by weights, and the virtual gyroscope output is obtained by summing the product [9]. The Kalman filter is used to realize data fusion of 6 MEMS gyroscopes, which improves the output precision of MEMS gyroscope [10]. The data fusion experiments of six gyroscopes with relatively less correlation are carried out, and the influence of noise parameter on the fusion results is analyzed [11]. There are four MEMS gyroscopes integrated on one chip, which improves the correlation between the gyroscopes [12]. The relationship between correlation coefficient and data fusion results of MEMS gyroscope array is fully analyzed [13]. The design of the MEMS gyro array with 3 × 3 plane structure is carried out [14]. The data fusion test is carried out by using 72 MEMS gyroscopes, and the relationship between the number of gyroscopes and the effect of the fusion is analyzed [15].
Data fusion can be achieved by using the correlation between the gyroscope random errors in the virtual gyroscope technology, and the MEMS gyroscope random error can be compensated to a certain extent. The current virtual gyroscope technology has the following characteristics: when static, the compensation precision of the virtual gyroscope technology is high, but the compensation ability of the virtual gyroscope technology is very limited when dynamic. In addition, the current virtual gyroscope technology uses different Kalman filters in static and dynamic state, so it is necessary to use different methods to fuse static and dynamic data respectively. Because it is difficult to model the true value of the angular rate in a dynamic state, the effect of the true value of angular rate is usually offset by the output difference of gyroscope, which causes the error of the Kalman filter equation to describe the actual problem, which leads to the lower compensation precision. When static, the true value of the angular rate is 0, the true value is modeled as noise, and the modeling accuracy is high, so the accuracy of error compensation is good. But, the random error modeling in virtual gyroscope technology only takes the angle random walk and the angular rate random walk, neglects other noise terms, so the compensation precision of the virtual gyroscope technology still has some space to improve.
In this paper, the ARMA model and virtual gyroscope technology are combined, and an improved virtual gyroscope technology based on ARMA model is proposed. This method can further improve the random error compensation ability of virtual gyroscope technology in static state. The conventional virtual gyroscope technology is used to model the random error of MEMS gyroscope, and the data of three MEMS gyroscopes are fused. Then the ARMA model is used to model the virtual gyroscope output. The improved random error model is established by combining ARMA model and random error model in conventional virtual gyroscope technology. Based on the modified random error model, the Kalman filter is designed for data fusion to further compensate the residual drift in virtual gyroscope output. Finally, the feasibility of the proposed method is verified by experiments.
2. Allan Variance Analysis
Because the MEMS gyroscope is sensitive to temperature, the MEMS gyroscope array is installed on the test-bed with zero input of the external turntable for 1 h to achieve the working temperature of the MEMS gyroscope. The bandwidth of the used gyroscope is 40 Hz, so the sampling frequency is 100 Hz according to the sampling theorem. The total sampling time is 450 s. The static output of the three gyroscopes is shown in Figure 1. The 3-order polynomial fitting method is used to eliminate the trend item in the output of each gyroscope. The fitting results are shown in Figure 1, and the random drift of the three gyroscopes is shown in Figure 2.
Allan variance is a method to analyze the stability of signal frequency in the time domain. It was first proposed by the David Allan of the United States Standard Bureau, which is mainly used to determine the power spectrum of the frequency fluctuation of the atomic clock [16]. The statistical characteristics of the random drift of the MEMS gyroscope are similar to the statistical characteristics of the atomic clock, so many scholars also identify the random errors of the MEMS gyroscope using the Allan variance method. It is assumed that the MEMS gyroscope is sampled with the sampling interval of , and N sampling points are obtained. Dividing the sampling sequence into K groups, K = N/M, and each group contains M data, the total sampling time for each group is related time , . The mean of each group is shown in Equation (1).
(1) |
The Allan variance is defined as shown in Equation (2).
(2) |
In the equation, <> represents the overall mean of the data. The Allan standard deviation curves of the 3 MEMS gyroscopes are shown in Figure 3.
The MEMS gyroscope random errors mainly include such as angular random walk (ARW), bias instability (BI), rate random walk (RRW), rate slope (RR), and quantization noise (QN). Other noises such as Markov noise (MN), which is also known as exponential correlation noise and sinusoidal noise (SN), are very small in the MEMS gyroscope errors, so it is not included in the error index in this paper. Due to the difference of gyroscope type and testing environment, there may be random noises of various components in the output data. It is considered that each noise is independent of each other and the Allan variance can be expressed as the sum of all the random errors. The Allan variance is expressed as Equation (3) [5].
(3) |
The Allan variance of five random errors, such as quantization noise, angular random walk, zero bias instability, angular rate random walk, and rate slope, and the slope in the double logarithmic curve are shown in Table 1. The least squares method is used to fit the double logarithmic curve of Allan standard deviation and correlation time, and the error coefficients of five kinds of random errors are shown in Table 1. Because the rate slope is the random error of the long correlation time, this paper does not analyze it, so the error coefficients of the rate slope of the three gyroscopes are not listed in Table 1.
Table 1.
Error Term | Allan Variance | Slope | Coefficient | Unit | Gyro 1 | Gyro 1 | Gyro 1 |
---|---|---|---|---|---|---|---|
Quantization noise | −1 | Q | deg | 0.00821 | 0.00726 | 0.00707 | |
Angular random walk | −1/2 | N | deg/h1/2 | 0.355 | 0.315 | 0.314 | |
Zero bias instability | 0 | B | deg/h | 10.318 | 7.790 | 8.533 | |
Angular rate random walk | 1/2 | P | deg/h3/2 | 52.323 | 120.310 | 61.357 | |
Rate Ramp | 1 | R | deg/h2 | - | - | - |
3. Conventional Virtual Gyroscope Technology
The conventional virtual gyroscope technology mainly uses the correlation between the MEMS gyroscope random error to carry on the data fusion, which can improve the output precision of the virtual gyroscope. The specific process of the virtual gyroscope technology is shown in Figure 4. First, the static random drift data of each MEMS gyroscope is collected. The random error characteristics of each MEMS gyroscope are obtained by analyzing the static random drift data with the Allan variance analysis method. After that, the random error model of MEMS gyroscope array with angular random walk and angular rate random walk is set up, and the corresponding Kalman filter is designed to fuse the data to compensate the random drift of the MEMS gyroscope.
3.1. Random Error Model of MEMS Gyroscope
The error of MEMS gyroscope is mainly divided into the deterministic error and the random error. The deterministic error can be compensated by a reasonable calibration test, and the compensation of random error is more difficult. The random error of MEMS gyroscope array is usually modeled as Equation (4) in conventional virtual gyroscope technology [4].
(4) |
In the equation, the y indicates the rate of the gyroscope output angle; represents the real angular rate of MEMS gyroscope detection; b represents angular rate random walk and it can be represented as random walk d riven noise; n is angular random walk. The error model of the MEMS gyroscope array consisting of three MEMS gyroscopes is shown in Equation (5).
(5) |
(6) |
In the equation, , , , .
3.2. Design of Kalman Filter
According to the random error model of MEMS gyroscope, the Kalman filter is designed to carry out data fusion of three MEMS gyroscopes. The angular rate random walk and real angular rate are selected as state vector of the Kalman filter, that is . The real angular rate will not be absolutely equal to 0 due to external environment and other factors in static state. Therefore, the real angular rate is modeled as white noise driven by .
According to Equation (5), the Kalman filter state equation of MEMS gyroscope array is as shown in Equation (7). According to Equation (6), the measurement equation of the system is shown in Equation (8).
(7) |
(8) |
In the equation, , , , . represents the unit matrix of 3 rows and 3 columns, represents the unit column vector of 3 rows and 1 columns. The Equations (9) and (10) can be obtained by the discretization of the Equations (7) and (8).
(9) |
(10) |
In the equation, , , T represents the period of discretization, is the drive white noise sequence, is the measurement noise sequence. The driving noise and the measurement noise meet the following requirements.
(11) |
If there is correlation between the gyroscopes in the MEMS gyroscope array, there is correlation between the gyroscope random errors. The correlation coefficient is used to characterize the correlation degree between random errors of different gyroscopes, , . A covariance of the driving noise is as follows.
(12) |
In the equation, (i = 1, 2, 3) represents the RRW noise variance of the i gyroscope, (i, j = 1, 2, 3) indicates the correlation between the i gyroscope and the j gyroscope, represents the variance of the noise . can be obtained by solving the cross correlation coefficient between the static random drift data of different gyroscopes. , can be obtained by Allan variance. Similarly, the measurement noise covariance matrix is solved. The output data of 3 MEMS gyroscopes are fused by using Kalman filter technology, and the output of virtual gyroscope is obtained, which is recorded as .
The correlation coefficient between the gyroscopes is shown in Table 2. There are 6000 static random drift data of three gyroscopes selected as the research object, and the random error model of MEMS gyroscope array is combined with the Kalman filter technology to fuse the data of 3 gyroscopes. The comparison between the fusion result and the original random drift of gyroscope 1 is shown in Figure 5.
Table 2.
Gyroscope Number | Gyro 1 | Gyro 2 | Gyro 3 |
---|---|---|---|
Gyro 1 | 1 | −1.0582 × 10−4 | 1.6087 × 10−3 |
Gyro 2 | −1.0582 × 10−4 | 1 | 1.3325 × 10−2 |
Gyro 3 | 1.6087 × 10−3 | 1.3325 × 10−2 | 1 |
4. Virtual Gyroscope Technology Based on ARMA Model
The conventional virtual gyroscope technology only considers angular random walk and angular rate random walk when modeling MEMS gyroscope array random error. Because the random error model ignores many other random noise terms, the accuracy of the model is relatively low. In this paper, the ARMA model is used to model the output of the conventional virtual gyroscope, and the random error model of the MEMS gyroscope array is improved, and the corresponding Kalman filter is designed to achieve the data fusion of the MEMS gyroscope. This method can further improve the static compensation ability of the virtual gyroscope technology.
4.1. Modeling of ARMA Model
The ARMA model uses the form of random difference equation, which can quantitatively describe the linear relationship between the observed data, and the ARMA model has the function of predicting the time series. The ARMA model is used to model the time series of the virtual gyroscope output, and the accurate prediction of virtual gyroscope output is realized. For time series , the ARMA model is shown in Equation (13).
(13) |
In the equation, is a white noise with a variance of . is the residual variance of the fitting results of the high order AR model. , is the model parameters. For a time series with a sample length of N, the ARMA model can be expressed as Equation (14).
(14) |
(15) |
(16) |
(17) |
The multiple regression theory is used to solve the Equation (14) and the least squares estimation of is:
(18) |
The output of virtual gyroscope is , which can be described as the Equation (19) with the determination of model parameters by Equation (18).
(19) |
The high order ARMA model can better describe the output characteristics of the virtual gyroscope. However, the high order ARMA model will greatly increase the dimension and computation of the filter. The ARMA model has a 2-order autoregressive model and 1 order moving average model, which is ARMA (2,1) model. The ARMA (2,1) model is chosen to model the time series , which is the output of virtual gyroscope. The comparison between the original signal of virtual gyroscope output and the modeling results is shown in Figure 6. In the Equation (19), the model parameters are as follows. = 0.66177, = 0.32011, and = 0.62258, 2.60829 × 10−8.
4.2. Improved Random Error Model
The random error model in reference [2,3,4,5,6,7,8,9,10,11,12,13,14,15] only considers two random drift errors of angular random walk and angular rate random walk, neglecting the multiple random errors, and the virtual gyroscope technology can’t achieve the compensation of all random error. Therefore, the improved random error model of the MEMS gyroscope is established by combining Equations (4) and (19). The improved random error model is as shown in Equation (20).
(20) |
In the equation, y indicates the rate of the gyro output angle; represents the real angular rate of MEMS gyro detection; b represents angular rate random walk and it can be represented as random walk driven noise; n is angular random walk and is a compensation residual that is the output of the virtual gyroscope. , is the variance of modeling residuals.
4.3. Improved Kalman Filter Design
According to the modified random error model, the Kalman filter is designed for data fusion of MEMS gyroscope array. The state vectors of the Kalman filter are as follows:
(21) |
The observation is the actual output of three MEMS gyroscope. The discrete state equation is as Equation (22), which is obtained by combining Equations (9) and (20). Measurement equation is as shown in Equation (23).
(22) |
(23) |
In the equation,
The driving noise and measurement noise satisfy the conditions as the Equation (24). is a driving noise covariance matrix, and is as the Equation (25). In the equation, is the variance of noise , is the variance of noise . is the measurement noise covariance matrix, which is the same as the in Section 3.2.
(24) |
(25) |
The data fusion of three MEMS gyroscopes is carried out by using the designed Kalman filter to further improve the compensation ability of the virtual gyroscope.
5. Test Analysis
Data fusion of MEMS gyroscope array is carried out by using a Kalman filter based on an improved random error model. When the sample length of the fusion data is 6000, the comparison results between the output of virtual gyroscope (simply marked “virtual gyroscope 1”) based on the conventional random error model and the output of virtual gyroscope (simply marked “virtual gyroscope 2”) based on the improved random error model is shown in Figure 7.
It is shown in Figure 7 that the method proposed in this paper can further compensate the compensation residual of the virtual gyroscope, so the compensation effect of the virtual gyroscope 2 is obviously better than the compensation effect of the virtual gyroscope 1. Use standard deviation as an evaluation criterion to determine the compensation performance of different compensation algorithms. The standard deviation of compensation results of virtual gyroscope 1 is 3.3657 × 10−3°/s. And the standard deviation of compensation results of virtual gyroscope 2 is 2.3518 × 10−3°/s, which reduced by 1.4311 times compared with virtual gyroscope 1.
In order to further verify the feasibility of the proposed method, the long-time sampling of the MEMS gyroscope array is carried out, and 60,000 sampling data are obtained. The data fusion of the MEMS gyroscope array is carried out by using virtual gyroscope 1 and virtual gyroscope 2, respectively. The output contrast results of the virtual gyroscope are obtained as shown in Figure 8.
As seen in Figure 8, the algorithm is modeled for the conventional virtual gyroscope compensation residual error, and the random error model and Kalman filter are improved to increase the compensation capability of the virtual gyroscope. The standard deviation between the compensation result of virtual gyroscope 1 and virtual gyroscope 2 is calculated, respectively. The standard deviation of compensation results of virtual gyroscope 1 is 3.3124 × 10−3°/s. And the standard deviation of compensation results of virtual gyroscope 2 is 2.3277 × 10−3°/s, which reduced by 1.4230 times compared with virtual gyroscope 1.
There are 90,000 sets of static data collected to carry out the third verification tests using the proposed method. The virtual gyroscope 1 method and the virtual gyroscope 2 method are used for data fusion, respectively, and the fusion results and their comparison results are shown in Figure 9. The standard deviation of the two data fusion results is obtained to determine the accuracy of the fusion results. The standard deviation of compensation results of virtual gyroscope 1 is 3.7535 × 10−3°/s. And the standard deviation of compensation results of virtual gyroscope 2 is 2.4656 × 10−3°/s, which reduced by 1.5223 times compared with virtual gyroscope 1. In summary, the feasibility of the proposed method is verified.
6. Conclusions
In this paper, the conventional virtual gyroscope technology is used to model the random error of three MEMS gyroscopes, and the data fusion is carried out through Kalman filter, and the output of virtual gyroscope is obtained. Then the ARMA model is used to model the output of virtual gyroscope, and combine the ARMA model and conventional random error model to improve the random error model. The Kalman filter based on improved random error model is designed for data fusion of three MEMS gyroscopes. The experimental results show that the virtual gyroscope technology based on ARMA model can further improve the compensation ability of conventional virtual gyroscope technology and the standard deviation of the output has been reduced by 1.4 times compared with conventional virtual gyroscope technology.
Author Contributions
Z.S. designed the experiments. L.W. performed the experiments. H.W. analyzed the data. J.S. wrote the paper.
Conflicts of Interest
The authors declare no conflict of interest.
References
- 1.Tian Z., Fang X., Zhou M., Li L. Smartphone-Based Indoor Integrated WiFi/MEMS Positioning Algorithm in a Multi-Floor Environment. Micromachines. 2015;6:347–363. doi: 10.3390/mi6030347. [DOI] [Google Scholar]
- 2.Liu J., Shen Q., Qin W. Signal Processing Technique for Combining Numerous MEMS Gyroscopes Based on Dynamic Conditional Correlation. Micromachines. 2015;6:684–698. doi: 10.3390/mi6060684. [DOI] [Google Scholar]
- 3.Xue L., Jiang C., Wang L., Liu J., Yuan W. Noise Reduction of MEMS Gyroscope Based on Direct Modeling or an Angular Rate Signal. Micromachines. 2015;6:266–280. doi: 10.3390/mi6020266. [DOI] [Google Scholar]
- 4.David S.B., Scott R.P. High Accuracy Inertial Sensors from Inexpensive Components. No. 6,882,964. U.S. Patent. 2002 Mar 6;
- 5.Zhang P., Chang H., Yuan W., Hu M. On Improving the Accuracy of Micromachined Gyroscopes Based on Multi-Sensors Fusion. Chin. J. Sens. Actuator. 2006;19:2226–2229. [Google Scholar]
- 6.Ji X., Wang S. Research on Signal Procession of Silicon Microgyroscope Array. J. Astronaut. 2009;30:235–239. [Google Scholar]
- 7.Zhang Y., Ji X., Wang S. Signal filtering method of silicon micro-gyroscope array. J. Southeast Univ. 2013;43:1222–1226. [Google Scholar]
- 8.Liu J., Shen Q., Li C., Qin W. Fusion method of MEMS gyro array signals based on optimal KF. Syst. Eng. Electron. 2016;38:2705–2710. [Google Scholar]
- 9.Zhang L., Xiong Z., Liu J., Xu J. Research on virtual gyro configuration of redundant MEMS system based on ANFIS. Opt. Int. J. Light Electron Opt. 2018;157:25–30. doi: 10.1016/j.ijleo.2017.08.060. [DOI] [Google Scholar]
- 10.Xue L., Jiang C., Chang H., Yang Y., Qin W., Yuan W. A novel Kalman filter for combining outputs of MEMS gyroscope array. Measurement. 2012;45:745–754. doi: 10.1016/j.measurement.2011.12.016. [DOI] [Google Scholar]
- 11.Chang H., Xue L., Jiang C., Kraft M., Yuan W. Combining Numerous Uncorrelated MEMS Gyroscopes for Accuracy Improvement Based on an Optimal Kalman Filter. IEEE Trans. Instrum. Meas. 2012;61:3084–3093. doi: 10.1109/TIM.2012.2200818. [DOI] [Google Scholar]
- 12.Shen Q., Yuan W., Qu B., Xie J., Chang H. A Virtual Gyroscope Based-on a Single-Chip Four-Microgyroscoe Array; Proceedings of the IEEE International Conference on Nano/Micro Engineered and Molecular Systems; Waikiki Beach, HI, USA. 13–16 April 2014; pp. 195–198. [Google Scholar]
- 13.Xue L., Wang X., Yang B., Yuan W., Yuan G. Analysis of Correlation in MEMS Gyroscope Array and its Influence on Accuracy Improvement for the Combined Angular Rate Signal. Micromachines. 2018;9:22. doi: 10.3390/mi9010022. [DOI] [PMC free article] [PubMed] [Google Scholar]
- 14.Heera M.M., Divya J.K., Varma M.S., Divya R.A., Agrawal V.K. Minimum Variance Optimal Filter Design for a 3x3 MEMS Gyroscope Cluster Configuration; Proceedings of the 4th IFAC Conference on Advances in Control and Optimization of Dynamical Systems ACODS; Tiruchirappalli, India. 1–5 February 2016; pp. 639–645. [Google Scholar]
- 15.Wang J., Olson E. High-Performance Inertial Measurements Using a Redundant Array of Inexpensive Gyroscopes (RAIG); Proceedings of the 2015 IEEE International Conference on Multisensor Fusion and lntegration for Intelligent Systems (MFI); San Diego, CA, USA. 14–16 September 2015; pp. 71–76. [Google Scholar]
- 16.Allan D.W. Statistics of atomic frequency standards. Proc. IEEE. 1966;54:221–230. doi: 10.1109/PROC.1966.4634. [DOI] [Google Scholar]