Abstract
As a standard method for noise analysis of fiber optic gyro (FOG), Allan variance has too large offline computational burden and data storages to be applied to online estimation. To overcome the barriers, the state space model is firstly established for FOG. Then the Sage-husa adaptive Kalman filter (SHAKF) is introduced in this field. Through recursive calculation of measurement noise covariance matrix, SHAKF can avoid the storage of large amounts of history data. However, the precision and stability of this method are still the primary matters that needed to be addressed. Based on this point, a new online method for estimation of the coefficient of angular random walk is proposed. In the method, estimator of measurement noise is constructed by the recursive form of Allan variance at the shortest sampling time. Then the estimator is embedded into the SHAKF framework resulting in a new adaptive filter. The estimations of measurement noise variance and Kalman filter are independent of each other in this method. Therefore, it can address the problem of filtering divergence and precision degrading effectively. Test results of both digital simulation and experimental data of FOG verify the validity and feasibility of the proposed method.
1. Introduction
Fiber optic gyro (FOG) random noise has vital effect on the performance of FOG in the field of navigation and aviation. As one of the most important components of FOG random noise, angular random walk (ARW) is generally used to quantitatively characterize the intensity of white noise of FOG output signal. Estimation of ARW coefficient of FOG is useful for the performance improvement of on-board attitude determination filter [1]. In some sense, a good knowledge of ARW of FOG becomes the key information to evaluate the state of FOG.
To determine the ARW coefficient of FOG, the Allan variance method is commonly adopted as a standard [2, 3]. For example, Allan variance method is recommended by the United States IEEE (Std. 952-1997, R2008) and China’s military standard (GJB 2426A-2004) to calculate the ARW coefficient. Allan variance was initially developed by David Allan of the National Bureau of Standards to quantify the error statistics for a Caesium beam frequency standard. The method, in general, can be applied to analyze the error characteristics of any precise measurement instruments. In nature, it is offline and requires a large amount of static data of FOG to be stored [4]. Besides, it requires a procedure of data section selection to obtain accuracy estimations of the noise contributions, but the selection is usually done manually.
To calculate ARW coefficient online and decrease the requirement of data store, some methods have been proposed [5–10]. In [7, 8], coefficient of ARW is estimated for in-flight gyros, but they are offline in nature. Additionally, other methods presented in [9, 10] estimate ARW coefficient by using nonlinear adaptive filter technique, but the state-space model is difficult to be established.
Focusing on the disadvantages and requirements, the Sage-husa adaptive Kalman filter (SHAKF) method [11–14] is firstly introduced into this field, which can estimate statistical characteristic online through the measurement output while estimating state and is considered as the most promising method for general online applications [15, 16]. In particular, the SHAKF method is widely used in seam tracking monitoring, signal denoising, and integrated navigation system [17–19]. Through recursive calculation of measurement noise covariance matrix, this method can avoid the storage of large amounts of history data and therefore greatly reduce the computational burden for processing gyro data. However, the precision and stability of the SHAKF are still the primary matters that needed to be addressed [20–22]. Based on this point, a new online method for estimation of the coefficient of angular random walk is presented. In the proposed method, estimator of measurement noise is constructed by the recursive form of Allan variance at the shortest sampling time. Then the estimator is embedded into the framework of SHAKF resulting in a new adaptive filter. The processes of measurement noise variance estimation and Kalman filter (KF) are independent of each other in this method. Therefore, it can address the problem of filtering divergence and precision degrading effectively.
The rest of the paper is organized as follows. Section 2 presents the state space model of the online estimation method and gives the implementation of the proposed method. Section 3 presents the experimental results. A digital simulation test and an experimental data test are done in this section to test the performance of the SHAKF method and the proposed method compared with the classical Allan variance method. Finally, conclusions are drawn in Section 4.
2. Principle of Online Estimation
2.1. Establishment of the State Space Model
According to Allan variance analysis, generally there are five error sources existing in FOG (IEEE Std. 952-1997, R2008) [2]: ARW, quantization noise, bias instability, angular rate random walk, and ramp noise. The noise parameters of these stochastic errors can be determined by Allan variance analysis, and these parameters can be used to determine the power spectral density (PSD) of the corresponding noises [10]. The Allan variances and PSDs of noises are listed in Table 1.
For bias instability, it will be significantly reduced after increasing the rate of data sampling. For ramp noise, it is essentially a deterministic error and is only present at low frequencies. Therefore, in the mathematical model, only ARW, bias instability, and angular rate random walk are considered for model simplifying.
Then, given the PSD of a stochastic process, the transfer function can be obtained by the following equation: where is the PSD of a stochastic process, is the transfer function, and is the circular frequency and equals with being the sampling rate. According to (1) and the PSD of , , and , the transfer functions for , , and are given by
In low frequency band [0.1 Hz, 10 Hz], the approximate transfer function of the second term of (2) is
According to the theory of linear system, , , and can be described by the following three equations: where , , and are the Fourier transformation of system outputs and , , and are the Fourier transformation of system inputs. Then, the time-domain form of (4) is written as where , , and are the independent white noise. According to the differential equations, the corresponding discrete-time forms are
Then filtering state equation and observation equation can be written as follows:
2.2. Online Estimation Methods
In order to facilitate the following discussion, (7a) and (7b) can be written in a compact form as where is state vector at time , is a Gauss white noise vector at time , and its covariance matrix is . is measurement vector at time , is measurement noise vector at time , and its covariance matrix is . , , and can be easily obtained through (7a) and (7b).
The process noise in (8) and measurement noise in (9) are assumed to be independent Gaussian noise with means and covariance matrices [19] where denotes the expected values, denotes the covariance values, and denotes the Kronecker delta function.
2.2.1. Sage-Husa Adaptive Kalman Filter
In the process of the SHAKF, the system states are estimated by innovations; at the same time, the unknown noise statistics are modified. As the approximating values of , , , and are updated in real-time, the KF can get more accurate information of noise to estimate the states exactly.
For the state space models (8) and (9) with unknown statistic noise, the explicit procedure of SHAKF is given as follows: where .
The estimator of noise statistics of , , , and based on a maximum posteriori can be written as where .
2.2.2. The Proposed Method
In SHAKF, KF and adaptive noise estimator are carried out directly in time domain; the internal connecting and mutual coupling exist between the estimation of the state and the noise parameter. To this respect, it is easy to cause the instability and filtering accuracy reduction.
Based on the analysis of the frequency domain, system status is the integral of motivated white noise , and the system noise is mainly characterized by noise of low frequency, such as ARW, when it is transferred to the measurement output. Meanwhile, the white noise of measurement is mainly characterized by broadband noise when it affects the measurement output directly. Therefore, the factor of measurement noise can be isolated based on the division of frequency band of measurement output. The Allan variance estimator is a band-pass filter, and quantization noise will be significantly reduced after increasing the rate of data sampling. To this respect, white noise variance can be approximately regarded as the Allan variance of broadband white noise in the present moment
It provides a feasible way to estimate variance of white noise of measurement. When the sampling interval is , the Allan variance of FOG output in the moment is given by where , are samples of the average angular rate.
In order to simplify the analysis, it is considered that the components of measurement noise vector are irrelevant. In the step of KF, it only needs to compute the Allan variance in the present moment of which the sample interval is the shortest sampling time
Therefore, the estimator of measurement noise can be rewritten into a recursive form as follows: where The initial value of can take any value.
Considering the facts that the statistics of process noise and measurement noise are time-variant, an exponential factor is brought in to strength the weights of recent information where and and the forgetting factor is usually selected from .
Then, the new estimator of measurement noise is obtained as follows by using instead of in (16):
The new adaptive filter is presented by embedding the measurement noise estimator into the SHAKF framework. The processes of measurement noise variance estimation and KF are independent of each other in the algorithm. Therefore, it can effectively reduce the problem of filtering divergence and reduction of precision.
3. Experiments and Result
In this section, the SHAKF method and the proposed method are tested for estimating ARW coefficient. The Allan variance method is also carried out to provide a basis for comparison. Firstly, these methods are tested using the digital simulation data. Then, they are tested on FOG experimental data.
3.1. Test by the Digital Simulation Data
The simulation data is used for the algorithm validating test in this section. In the simulation data, the ARW coefficient of FOG is set to , , , and , respectively.
For comparison, the recorded data is also analyzed using Allan variance method. From the Allan variance graph, the ARW coefficient is evaluated using least square fit method. The results of classical Allan variance, SHAKF, and the proposed online method are given in Table 2. The results of simulation test curve are shown in Figure 1, respectively.
| (a) |
| (b) |
| (c) |
| (d) |
| (e) |
The computational cost test is carried out, which is divided into two groups when the ARW coefficient of FOG is set to and , respectively. The total calculation time of Allan method, SHAKF method, and the proposed method is intuitively shown in Figure 2 (calculation using the CPU of Intel Core2-P8400, 2.27 GHz).
Figure 1 and Table 2 show that Allan variance method, SHAKF method, and the proposed online method can accurately estimate the ARW of FOG in different setting conditions. It can be seen that the accuracy of the proposed online method and the classical Allan variance method is basically identical. Especially it can be seen, from Figures 1(d) to 1(e), that when the range of ARW is less than twice magnitude, the accuracy of the proposed method is slightly better than the SHAKF and the stability of filtering is stronger. Figure 2 shows that the proposed method outperforms Allan variance method in terms of the computational cost in simulation test. Note that the proposed method spends a little more time in estimation compared with SHAKF. The reason is that the delicate designed estimator of measurement noise is embedded into the framework of SHAKF and it will cost a little extra time in the calculation of the estimator.
3.2. Test by FOG Experimental Data
Currently, the laboratory has a FOG (F120H) for -axis and two other FOGs (F98H) for and -axis, and the bias stabilities are and , respectively. In the paper, the test is carried out by using the experimental data at 100 Hz of F120H and F98H as shown in Figure 3. FOGs are installed in biaxial rate turntable as shown in Figure 4. The output-signal waveforms of the X, Z FOGs are shown in Figure 5, respectively.
(a)
(b)
(a)
(b)
The results of classical Allan variance, SHAKF method, and the proposed online method are shown in Table 3. The results of simulation test curve are shown in Figure 6, respectively. The total calculation time of these methods is intuitively shown in Figure 7 (calculation using the CPU of Intel Core2-P8400, 2.27 GHz).
(a) X Axis
(b) Y Axis
(c) Z Axis
With reference to the estimated value by Allan variance method, Table 3 and Figure 6 show that the proposed method can estimate the ARW of X, Y, Z FOGs online in practical application. The relative errors of the estimation of ARW of X, Y, Z FOGs by the proposed online method relative to the Allan variance method are 3.51%, 3.70%, and 1.79%, respectively. By comparison, the relative errors of the SHAKF method are 19.35%, 18.41%, and 19.64%. Therefore, to some extent, the SHAKF method can estimate the ARW; however, the estimated accuracy and the rate of convergence are not ideal in practice. Figure 7 shows intuitively that the proposed method outperforms the Allan variance method in terms of the computational cost in field test.
4. Conclusion
As a standard method for noise analysis of FOG, Allan variance method is offline and requires storing a large number of hours of FOG output data. A new online method based on the SHAKF is proposed in the paper for estimating the ARW coefficient of FOG. The main innovation is based on embedding the delicate designed estimator of measurement noise into the framework of SHAKF that performs better in general online applications. The proposed method can analyze data as it arrives from onboard FOG and estimate ARW coefficient online. Therefore, it does not require large amounts of data storage or manual analysis for an Allan variance graph. Experimental results including the digital simulation test and experimental data test of FOG show that the proposed method based on SHAKF framework is basically identical in terms of accuracy compared with Allan variance method and outperforms Allan variance method in terms of computational cost. Meanwhile, it can be seen from the test data that the proposed online method in the paper making use of only a little more time can achieve more accurate performance than the SHAKF method, which further demonstrates the effectiveness of the proposed method.
Conflict of Interests
The authors declare that there is no conflict of interests regarding the publication of this paper.
Acknowledgment
This work is supported by the National Natural Science Foundation of China (no. 61304241, no. 61374206, and no. 61104184).