Mathematical Problems in Engineering

Volume 2014, Article ID 623930, 8 pages

http://dx.doi.org/10.1155/2014/623930

## Multiple Adaptive Fading Schmidt-Kalman Filter for Unknown Bias

School of Aeronautical Science and Engineering, BeiHang University, Beijing 100191, China

Received 24 September 2014; Accepted 12 November 2014; Published 24 November 2014

Academic Editor: Zheng-Guang Wu

Copyright © 2014 Tai-Shan Lou et al. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.

#### Abstract

Unknown biases in dynamic and measurement models of the dynamic systems can bring greatly negative effects to the state estimates when using a conventional Kalman filter algorithm. Schmidt introduces the “consider” analysis to account for errors in both the dynamic and measurement models due to the unknown biases. Although the Schmidt-Kalman filter “considers” the biases, the uncertain initial values and incorrect covariance matrices of the unknown biases still are not considered. To solve this problem, a multiple adaptive fading Schmidt-Kalman filter (MAFSKF) is designed by using the proposed multiple adaptive fading Kalman filter to mitigate the negative effects of the unknown biases in dynamic or measurement model. The performance of the MAFSKF algorithm is verified by simulation.

#### 1. Introduction

An underlying assumption of the Kalman filter is that the dynamic and measurement equations can be accurately modeled without any colored noise or unknown biases. However, in practice, these dynamic and measurement models include some additional biases, which always bring greatly negative effects to the state estimate.

There are many methodologies to deal with these unknown biases. Ignoring them and augmenting them to estimate are two common approaches. Based on the sensitivity to the unknown bias, some techniques have been proposed, such as filtering [1, 2], set-valued estimation [3], and Schmidt-Kalman filter (SKF) [4]. Schmidt proposed a “consider” analysis, which is the cornerstone of the SKF, to account for errors in both the dynamic and measurement models due to the unknown biases when the biases are considered as constants and remain unchanged [4]. Based on a minimum variance approach, the key idea of the SKF is the “consider” analysis that the preestimated bias covariance is formulated to update the state and covariance estimates, but these biases themselves are not estimated directly. The “consider” approach is especially useful when the unknown biases are low observable or when the extra computational power to estimate them is not worth [5].

After Schmidt, the “consider” approach for parameters has received much attention in recent years. The SKF is also called the consider Kalman filter (CKF) after its developer. Jazwinski provides the detailed derivation of the CKF in his book [6]. Subsequently, Tapley et al. amply descript the CKF and derivate a different formulation [7]. Zanetti and Souza introduce the UDU formulation into the SKF and provide a numerically stability, recursive implementation of the UDU SKF [8]. Bierman analyzes the effects on filtering accuracy of the unestimated biases and incorrect* a priori* covariance statistics and proposes a sensitivity matrix to evaluate them [9]. Woodbury et al. give novelty insight into considering biases in the measurement model and verify the negative effect of the errors in the initial parameter and covariance estimates [5, 10]. Chee and Forbes propose a norm-constrained consider Kalman filtering by taking into account the constraint on the state estimate and apply it to a nonlinear attitude estimation problem [11].

However, how to mitigate these negative effects from the initial state and covariance values of the unknown biases in the SKF has not attracted much attention. In fact, when the inaccurate initial and covariance values, that is to say the biases are not accurately modeled, are used to update the state and covariance estimates, the accuracy of the state and covariance estimates may greatly degrade. Fortunately, the adaptive technique is proposed to improve the convergence of the filtering. As a member of the adaptive Kalman filtering algorithms, the adaptive fading Kalman filtering algorithm is proposed to use a single adaptive fading factor (FF) as a multiplier to the dynamic or measurement noise covariance when the information about the dynamic or measurement model is incomplete [12–15]. Then, to consider the complex systems with multivariable, a single fading factor is not sufficiently used, and so the multiple fading factor, which is the footstone of multiple adaptive fading Kalman filtering (MAFKF), is proposed to reflect corrective effects of the multivariable in filtering [16–19]. But in the MAFKF the multiple fading factors are only used as a multiplier for the last* posteriori* covariance of the states, and the method for the whole* priori* covariance of the states is not considered until now.

To consider the incomplete information from both the covariance of the states and noises, the MAFKF is proposed to use the multiple fading factor as a multiplier on the outside of the whole* priori* error covariance equation. The proposed MAFKF not only considers the uncertainty of the models but also adjusts the covariance of inaccurate modeled noises. In addition, the multiple fading factors are derived by one-step approximate algorithm to decrease the computational complexity in the MAFKF algorithm. Then, the multiple adaptive fading Schmidt-Kalman filter (MAFSKF) is designed by using the above MAFKF to mitigate the negative effects of the uncertain parameters in dynamic or measurement model.

This paper is organized as follows. First, the problem statement with the unknown biases is given. Second, the MAFKF algorithm is proposed to compensate the effect of inaccuracy information covariance. Third, the MAFSKF is designed to mitigate the negative effects of the unknown biases. Finally, the performance of the MAFSKF algorithm is verified by simulation and the results are discussed as well.

#### 2. Problem Statement

Consider a linear discrete dynamic system with the unknown biases as follows:where is the state vector and is the measurement vector. and are the state and bias transition matrices, is the coefficient matrix of the process noise, is the measurement matrix, and is the measurement bias transition matrix. is referred to as the dynamical bias vector and is called the measurement bias vector. and are independent zero-mean Gaussian noise processes and their covariance are, respectively, and . They satisfy where is the Kronecker delta function and , .

Here, the biases and , which are considered as unknown constants and remain the same in filtering, are modeled as The initial states and biases and are assumed to be independent of the Gaussian noise and and be Gaussian random variables with

Based on the assumption that the stochastic information of the unknown biases is incomplete, a multiple adaptive fading Schmidt-Kalman filter is designed to overcome the problem with the unknown biases.

#### 3. MAFKF Algorithm

Consider the linear discrete stochastic system as follows:

If the system is observable, the optimal estimate is given by the conventional Kalman filter [7]. Unfortunately, the information is always incomplete in practice, and this leads the filter to “learn the wrong state too well” [20]. To compensate the effects of the incomplete information, the adaptive fading Kalman filter (AFKF) is proposed to overcome the problem [12, 13]. When the older data from the current estimate are no longer meaningful due to the erroneous model, the negative effects of these data are mitigated by the AFKF. Between the AFKF and the conventional Kalman filter, the big difference is that a constant fading factor is inserted into the* a priori* error covariance equation. There are three representative types with a single fading factor to be assigned [12, 13, 15, 21],However, only one constant fading factor cannot “weight” the covariance of all states, and the optimal filtering cannot be guaranteed, especially for the complicated multivariable systems. To overcome the shortcomings of the single fading factor, Zhou et al. [16] proposed a suboptimal multiple fading extended Kalman filter by using the error covariance equation of (6a), in which the single fading factor is substituted by a multiple fading factor matrix , and the orthogonality of the residual errors is remained. Zhou et al. also gave one-step approximation algorithm of the multiple fading factor and verified the affectivity of the multiple fading factor in filtering. The equation of (6b) and (6c) was considered for a single fading factor in the literature [13, 16]. But for the multiple fading factor, no researchers consider the last two equations. To consider the incomplete information from both the covariance of the states and noises, the multiple fading factor should be inserted on the outside of the* a priori* error covariance equation. Hence, based on (6c) as the comment in the literature [17], the proposed MAFKF is defined as
where ; is the multiple fading factor.

In the conventional Kalman filter, the predicted residual vector can be expressed as
and the corresponding innovation covariance matrix can be calculated as
where is* a priori* error covariance of the linear Kalman filter.

In the optimal linear Kalman filter, there is an orthogonal principle that the predicted residual sequence is mutually orthogonal when the optimal gain matrix is calculated online [16]. The optimal gain matrix is obtained in the linear Kalman filter by minimizing the following equation: and then the following equation is satisfied: Substituting (8) into the left formula of (11), the result can be obtained as follows: where is defined as (for all ) Substituting the optimal gain matrix of the linear Kalman filter into (13), is identically zero, and this means that (12) is identical to zero, too. The orthogonal principle is right when the optimal gain matrix is inserted.

In practice, the dynamic model of the stochastic system always is partially known, and so the real covariance matrix may be increased by the unknown information, and it is different from the theoretical covariance in (9). Thus, the real autocovariance matrix may not be identically zero. For (12), if the multiple fading factor in (7) is chosen so that , then the gain matrix is optimal. From the above, it can be seen that if is optimal, in (12), and if , is optimal. The basic idea to design the adaptive fading filtering is obtained from aforementioned analysis.

Hence, the optimality of the Kalman filter can be evaluated by the following function constructed: where and . describes the distance to the optimal estimate in linear Kalman filter. When is minimum, a suboptimal estimate, which is the most close to the optimal estimate, will be obtained. Hence, we can obtain the multiple fading factor by minimizing (14) as follows:

Obviously, (15) can be solved by using any unconstrained multivariate nonlinear programming methods. However, finding the optimal solution is not suitable for the online state estimate [16]. Hence, a one-step approximate algorithm is proposed to obtain the multiple fading factors for the online calculating.

Here, when the* a priori* characters of the system are roughly known, we can assume that
and then set
where is the constant from the prognosis to the state and is the undetermined factor.

Substituting the Kalman gain matrix into the generates It is obvious that one sufficient condition to establish (18) is or

Substituting (7) into (20) and reorganizing it gives From the right part of (21), it is seen that the multiple fading factor is valid when is satisfied [16]. For the measurement covariance matrix , a softening factor , which is usually given by experience, is introduced to weaken the excessive adjust of the multiple fading factor and smooth the state estimates. Hence, (21) is restructured as

Based on the property of commutative matrices in trace operator , the trace of both sides in (22) is calculated as

Simplify (23) as where

In fact, the real residual covariance matrix in (26) is unknown but can be evaluated by the following equation [16]: where is a forgetting factor, which is .

Substituting (17) into (24) gives and then is calculated as

Synthesizing condition and (17), (29) gives

*Algorithm 1 (one-step approximate MAFKF). *A discrete-time multiple adaptive fading Kalman filter is proposed by the following equations when the information about the linear stochastic system is incomplete:where

To consider the difference between the states and the multisource incomplete information, the MAFKF algorithm is proposed to use the multiple fading factor as a multiplier for the whole* a priori* covariance of the states and mitigate the negative effects of the uncertainties. Compared to the single adaptive fading Kalman filter, the MAFKF is introduced into the multiple fading factor and adjusts each component of the state vector by different fading factor to perform better. In addition, the multiple fading factor is derived by one-step approximate algorithm to decrease the computational complexity.

The asymptotical stability of the proposed MAFKF is easily proved in the literature [15], by using the results in the literature [22–24].

*Remarks*. The proportionality factor of the multiple fading factor can be designed with the* a priori* knowledge of the states before the filtering [16].

#### 4. MAFSKF for the Unknown Biases

The unknown biases in the problem statement (1a) and (1b) have a greatly negative impact on the filter accuracy and even result in filter divergence [6]. In the SKF algorithm, the covariance of unknown biases is used to update the state and covariance estimates but is not estimated directly. However, as the most important part in the SKF, the unknown covariance matrices and and the uncertain initial values of the unknown biases are still not considered. To consider the negative effects in the SKF filtering from this incomplete information, the MAFKF is proposed to solve this problem. Based on the two aforementioned aspects, the MAFSKF is designed by using the MAFKF and the conventional SKF.

Similarly to (8) and (9) in the conventional Kalman filter, the predicted residual vector and the corresponding innovation covariance matrix in SKF can be expressed as where the unknown real residual covariance matrix is calculated by (27).

The incomplete information, coming from the unknown biases in models, can be obtained from (27), (33), and (34). So the multiple fading factor can be calculated from (27) and (34) and used to compensate the corresponding covariance matrix and autocovariance matrix.

The SKF algorithm is derived as follows [4, 25]. First, the unknown biases are augmented into the states and the new augmented system is produced. Second, the standard linear Kalman filter is derived from the augmented system. Third, the estimation equations for the biases are thrown away, but the covariance between the states and biases is retrained. From the recursions in SKF [25], the* a priori* error covariance includes

From the recursive process, the three above covariance matrices should be adjusted by the multiple fading factor , for the incomplete information of the unknown biases. The multiple fading factor is calculated for the augmented system like the proposed MAFKF. Under assumption that , , is calculated as in (29), and still remains the same, but in (29) is changed into

From the analysis above, a multiple adaptive fading Schmidt-Kalman filter is proposed to mitigate the negative effects of the unknown biases.

*Algorithm 2 (one-step approximate MAFSKF). *Based on the one-step approximate MAFKF algorithm, a multiple adaptive fading Schmidt-Kalman filter is proposed by the following equations when the information about the linear stochastic system is incomplete:where

#### 5. Simulation Results and Analysis

To evaluate the performance of the proposed MAFSKF algorithm, the spacecraft attitude tracing system with the gyroscope as a measurement sensor is considered [26]. The spacecraft attitude tracking system, which is mainly used to enhance and track the spacecraft drift signal, is corrupted by the unknown bias. The corresponding discrete-time dynamic stochastic system is expressed as

As in the literature [21], we assumed that , , and . The true state and the unknown bias were added to the dynamic equation (39). The initial estimates of the state , and bias . In simulation, the dynamic system is disturbed by some external disturbances, and the values of the unknown biases are plotted in Figure 1. The MAFSKF and SKF use as the covariance of the bias , which is one thousandth of the real covariance . The constant in MAFSKF algorithm is set as and , the softening factor is set as , and the forgetting factor is .

Each single run lasts for 200 samples and 100 Monte Carlo runs are performed. The root mean squared errors (RMSE) of the state estimate are calculated to compare the performance of the MAFSKF algorithm and the SKF algorithm at each epoch. The simulation results are shown in Figures 2–5.

Figure 2 shows the time evolution of the multiple fading factor in simulation. From Figure 2, we can see that the fading factors of the states become larger in order to recover the filter from divergence, and the second fading factor is greatly larger than the first one because the second state changes largely. Figures 3 and 4 show the RMSEs of the state estimates both and by using the conventional SKF and MAFSKF algorithm, respectively. The RMSEs of the MAFSKF algorithm on its own are given in Figure 5 to well show the results. From Figures 3 and 4, it is obviously seen that the MAFSKF algorithm can adapt these unknown biases and well track the true states, compared to the SKF. As a result, the performance of the MAFSKF algorithm is better than the SKF when the information of the unknown biases is incomplete.

#### 6. Conclusions

In this paper, the multiple adaptive fading Schmidt-Kalman filter is presented to mitigate the negative effects of the unknown biases in dynamic or measurement model. In practice situations, the dynamic and measurement models include some additional unknown biases, which always bring greatly negative effects to the state estimates. Although the Schmidt-Kalman filter “considers” the biases, the uncertain initial values and incorrect covariance matrices of the unknown biases still are not considered. To solve the problem, the MAFKF is proposed to adjust the covariance of the states and noise by using the multiple fading factors as a multiplier on the outside of the* a priori* covariance equation when the information about the dynamic or measurement model is incomplete. Then, the MAFSKF is designed based on the MAFKF. Numerical simulation shows that the MAFSKF can mitigate the negative effects of incorrect covariance matrices of the unknown biases compared to the SKF.

#### Conflict of Interests

The authors declare that there is no conflict of interests regarding the publication of this paper.

#### Acknowledgments

The work described in this paper was supported by the National Nature Science Foundation of China (Grant no. 11202011) and the Fundamental Research Funds for the Central Universities (Grant no. YWK13HK11). The authors fully appreciate the financial supports. The authors would also like to thank the reviewers and the editor for their many suggestions that helped improve this paper.

#### References

- R. Lu, Y. Xu, and A. Xue, “${H}_{\infty}$ filtering for singular systems with communication delays,”
*Signal Processing*, vol. 90, no. 4, pp. 1240–1248, 2010. View at Publisher · View at Google Scholar · View at Scopus - R. Lu, H. Li, A. Xue, J. Zheng, and Q. She, “Quantized ${H}_{\infty}$ filtering for different communication channels,”
*Circuits, Systems, and Signal Processing*, vol. 31, no. 2, pp. 501–519, 2012. View at Publisher · View at Google Scholar · View at MathSciNet · View at Scopus - A. Garulli, A. Vicino, and G. Zappa, “Conditional central algorithms for worst case set-membership identification and filtering,”
*IEEE Transactions on Automatic Control*, vol. 45, no. 1, pp. 14–23, 2000. View at Publisher · View at Google Scholar · View at MathSciNet · View at Scopus - S. F. Schmidt, “Application of state space methods to navigation problems,” in
*Advanced in Control Systems*, pp. 293–340, Academic Press, New York, NY, USA, 1966. View at Google Scholar - D. Woodbury and J. Junkins, “On the consider Kalman filter,” in
*Proceedings of the AIAA Guidance, Navigation, and Control Conference*, AIAA Paper 2010-7752, Toronto, Canada, 2010. - A. H. Jazwinski,
*Stochastic Processes and Filtering Theory*, Academic Press, New York, NY, USA, 1970. - B. D. Tapley, B. E. Schutz, and G. H. Born,
*Statistical Orbit Determination*, Academic Press, New York, NY, USA, 1st edition, 2004. - R. Zanetti and C. D. Souza, “Recursive implementations of the consider filter,” in
*Proceedings of the AAS Jer-Nan Juang Astrodynamics Symposium*, College Station, Tex, USA, 2012. - G. J. Bierman,
*Factorization Methods for Discrete Sequential Estimation*, Dover Publications, 2006. - D. P. Woodbury, M. Majji, and J. L. Junkins, “Considering measurement model parameter errors in static and dynamic systems,”
*Journal of the Astronautical Sciences*, vol. 58, no. 3, pp. 461–478, 2011. View at Publisher · View at Google Scholar · View at Scopus - S. A. Chee and J. R. Forbes, “Norm-constrained consider Kalman filtering,”
*Journal of Guidance, Control, and Dynamics*, vol. 37, no. 6, pp. 2048–2053, 2014. View at Publisher · View at Google Scholar - Q. Xia, M. Rao, Y. Ying, and X. Shen, “Adaptive fading Kalman filter with an application,”
*Automatica*, vol. 30, no. 8, pp. 1333–1338, 1994. View at Publisher · View at Google Scholar · View at MathSciNet · View at Scopus - C. Hide, T. Moore, and M. Smith, “Adaptive Kalman filtering for low-cost INS/GPS,”
*Journal of Navigation*, vol. 56, no. 1, pp. 143–152, 2003. View at Publisher · View at Google Scholar · View at Scopus - C. Hu, W. Chen, Y. Chen, and D. Liu, “Adaptive Kalman filtering for vehicle navigation,”
*Journal of Global Positioning Systems*, vol. 2, no. 1, pp. 42–47, 2003. View at Publisher · View at Google Scholar - K. H. Kim, J. G. Lee, and C. G. Park, “Adaptive two-stage Kalman filter in the presence of unknown random bias,”
*International Journal of Adaptive Control and Signal Processing*, vol. 20, no. 7, pp. 305–319, 2006. View at Publisher · View at Google Scholar · View at MathSciNet · View at Scopus - D. H. Zhou, Y. G. Xi, and Z. J. Zhang, “A suboptimal multiple fading extended Kalman filter,”
*Acta Automatica Sinica*, vol. 17, no. 6, pp. 689–695, 1991. View at Google Scholar - Y. Geng and J. Wang, “Adaptive estimation of multiple fading factors in Kalman filter for navigation applications,”
*GPS Solutions*, vol. 12, no. 4, pp. 273–279, 2008. View at Publisher · View at Google Scholar · View at Scopus - W. Gao, L. Miao, and M. Ni, “Multiple fading factors kalman filter for sins static alignment application,”
*Chinese Journal of Aeronautics*, vol. 24, no. 4, pp. 476–483, 2011. View at Publisher · View at Google Scholar · View at Scopus - H. E. Söken and C. Hajiyev, “Adaptive unscented Kalman filter with multiple fading factors for pico satellite attitude estimation,” in
*Proceedings of the 4th International Conference on Recent Advances in Space Technologies (RAST '09)*, pp. 541–546, Istanbul, Turkey, June 2009. View at Publisher · View at Google Scholar · View at Scopus - D. L. Snyder, “Information processing for observed jump processes,”
*Information and Computation*, vol. 22, no. 1, pp. 69–78, 1973. View at Google Scholar · View at MathSciNet · View at Scopus - L. Ozbek and F. A. Aliev, “Comments on adaptive fading Kalman filter with an application,”
*Automatica*, vol. 34, no. 12, pp. 1663–1664, 1998. View at Publisher · View at Google Scholar · View at Scopus - J. Deyst and C. F. Price, “Conditions for asymptotic stability of the discrete minimum-variance linear estimator,”
*IEEE Transactions on Automatic Control*, vol. 13, pp. 702–705, 1968. View at Google Scholar · View at MathSciNet - H. W. Sorenson and J. E. Sacks, “Recursive fading memory filtering,”
*Information Sciences*, vol. 3, no. 2, pp. 101–119, 1971. View at Publisher · View at Google Scholar - W. Qian, L. Wang, and Y. Sun, “Improved robust stability criteria for uncertain systems with time-varying delay,”
*Asian Journal of Control*, vol. 13, no. 6, pp. 1043–1050, 2011. View at Publisher · View at Google Scholar · View at Zentralblatt MATH · View at MathSciNet · View at Scopus - J. L. Crassidis and J. L. Junkins,
*Optimal Estimation of Dynamic Systems*, Chapman & Hall/CRC Press, Boca Raton, Fla, USA, 2nd edition, 2012. - P. S. Kim, “Separate-bias estimation scheme with diversely behaved biases,”
*IEEE Transactions on Aerospace and Electronic Systems*, vol. 38, no. 1, pp. 333–339, 2002. View at Publisher · View at Google Scholar · View at Scopus