Research Article  Open Access
Yongtao Shui, Xiaogang Wang, Wutao Qin, Yu Wang, Baojun Pang, Naigang Cui, "A Novel Robust Student’s Based Cubature Information Filter with HeavyTailed Noises", International Journal of Aerospace Engineering, vol. 2020, Article ID 7075037, 11 pages, 2020. https://doi.org/10.1155/2020/7075037
A Novel Robust Student’s Based Cubature Information Filter with HeavyTailed Noises
Abstract
In this paper, a novel robust Student’s based cubature information filter is proposed for a nonlinear multisensor system with heavytailed process and measurement noises. At first, the predictive probability density function (PDF) and the likelihood PDF are approximated as two different Student’s distributions. To avoid the process uncertainty induced by the heavytailed process noise, the scale matrix of the predictive PDF is modeled as an inverse Wishart distribution and estimated dynamically. Then, the predictive PDF and the likelihood PDF are transformed into a hierarchical Gaussian form to obtain the approximate solution of posterior PDF. Based on the variational Bayesian approximation method, the posterior PDF is approximated iteratively by minimizing the KullbackLeibler divergence function. Based on the posterior PDF of the auxiliary parameters, the predicted covariance and measurement noise covariance are modified. And then the information matrix and information state are updated by summing the local information contributions, which are computed based on the modified covariance. Finally, the state, scale matrix, and posterior densities are estimated after fixed point iterations. And the simulation results for a target tracking example demonstrate the superiority of the proposed filter.
1. Introduction
To obtain the reliable and precise information, multisensor systems have become more and more popular in a wide range of applications such as cooperative tracking, autonomous navigation, signal processing, and guidance [1, 2]. Therefore, how to best fuse the observations from different sensors has gained much attention in several decades. Kalman filter (KF), one of the most popular state estimation methods, has been used extensively in many multisensor estimation problems [3, 4]. However, the KF is a linear state estimation method, and it cannot get an optimal estimation result with nonGaussian process and measurement noises. But in many engineering applications, such as tracking agile target in clutter with bearing sensors, the system is nonlinear and the heavytailed noises are presented [5, 6]. In this case, the performance of the classical KF degrades dramatically.
To apply the KF in nonlinear system and improve the accuracy of nonlinear approximation, the first order linearizationbased extended Kalman filter (EKF) [7], the unscented transformationbased unscented Kalman filtering (UKF) [8, 9], quadrature rulebased GaussHermite filtering (GHF) [10], polynomial interpolationbased divided difference filtering (DDF) [11], and the sphericalradical rulebased cubature Kalman filter (CKF) [12, 13] have been proposed successively. Although the information filter (IF) is an algebraically equivalent form of Kalman filter, it is more suitable for multisensor estimation, since the IF can reduce the computational burden significantly and be decentralized easily [14]. Soon, the abovementioned filters were formulated in the information type and applied to the multisensor estimation, such as extended information filter (EIF) [15], unscented information filter (UIF) [16], and cubature information filter (CIF) [17]. Unfortunately, the performance of these information filters will decrease in the presence of heavytailed noises, since they all derived based on the Gaussian assumption.
To tackle the heavytailed nonGaussian noise, some Huberbased information filters have been proposed by minimizing a cost function which is a combined and norm [18], such as Huberbased UIF [19] and Huberbased CIF [20]. Nevertheless, the Huber’s weight function cannot converge to zero even as the error approaches infinity. It indicates the measurements with large errors still will be employed, and the estimation performance will be deteriorated [5, 21]. Besides Huber’s technique, some maximum correntropy (MC) information filters such as MCUIF [22] and MCCIF [5] have been proposed by employing the maximum correntropy criterion as the optimality criterion. However, the estimation covariance cannot be developed due to the lack of theoretical basis, which will degrade the performance of MC Kalman filters.
Since the Student’s distribution is a reasonable model of the heavytailed noise, some Student’s based Kalman filters (STKF) have been proposed by modeling the heavytailed noises as the Student’s distribution [23–27]. To obtain the approximate solution of posterior estimations, the posterior probability density function (PDF) has also been approximated by the Student’s distribution [21, 23], in which the growth of the dof parameter in STKF degrades the estimation accuracy obviously. To tackle with the difficulty in choosing scale matrix and dof parameter, variational Bayesian (VB) approach is employed to jointly estimate the state vector, scale matrix, and dof parameter [24, 25]. In [28], the inaccurate process noise covariance noise and measurement noise covariance matrix is estimated by choosing inverse Wishart priors. In [29], both skewed noise and heavytailed noise are considered, whereas Gaussian scale mixture distributions are used to model onestep prediction and likelihood PDFs. Despite the excellent work mentioned above, there have been relatively few results concerning the nonlinear multisensor estimation problem with heavytailed process, and measurement noises have not been considered, which serves as the main motivation of this paper.
To cope with the nonlinear multisensor estimation problem with heavytailed process and measurement noises, a novel robust Student’s based cubature information filter (NRSTCIF) is proposed in this paper. At first, the onestep predicted state vector and nominal covariance is propagated based on the cubature rule. Then, the predictive PDF and the likelihood PDF are transformed into a hierarchical Gaussian form to obtain the approximate solution of posterior PDF. Next, the posterior densities are approximated iteratively based on the variational Bayesian (VB) approximation method, where the information matrix and information state are updated by summing the local information contributions. Finally, the state, scale matrix, and posterior densities are estimated after fixed point iterations.
The rest of the paper is organized as follows. In Sec. II, the problem is formulated. Sec. III gives the derivation of the proposed filter. The simulations are conducted in Sec. IV, and the conclusions are drawn in Sec. V.
2. Problem Formulation
Consider a discretetime stochastic nonlinear system described by where is the dimensional state, is the dimensional measurement, and and are zero mean heavily tailed process noise and measurement noise with nominal covariance and , respectively.
Since is a heavytailed measurement noise, its distribution is approximated as where denotes the Student’s probability distribution function (PDF) of , with mean and scale matrix , is the dof parameter.
Based on the measurement equation and the distribution of measurement noise, the likelihood PDF can be formulated as where is the mean vector of .
Due to the heavytailed process noise, the predictive PDF is also approximated as a Student’s distribution. where is the mean vector, is the dof parameter, and is the scale matrix which will be approximated as the inverse Wishart distribution in the next section.
3. Derivation of the Proportional Filter
3.1. Brief Review of Extended Information Filter
Based on the state model given by (1), the predicted information matrix and information state can be formulated as [16, 17]. where is the statetransition matrix which can be computed based on (1).
Then, the updated information matrix and information state can be formulated as where and are information state contribution and information matrix contribution, respectively. They are given by where is the measurement at time and is the measurement matrix.
3.2. The Transformation of the Predictive PDF and the Likelihood PDF
To get the approximate solution of posterior PDF , the predictive PDF and the likelihood PDF given by (5) and (4) are written as an infinite mixture of Gaussian distribution [24], i.e., where and are auxiliary parameters, is the Gamma PDF of auxiliary parameter . is defined by where denotes the Gamma function. Then, can be formulated as
Since the process noise is a zero mean vector with nominal covariance , the state vector and its associated nominal covariance can be propagated by where is the ith cubature point generated by where is the Cholesky decomposition of satisfying , and is the th element of the following set
To accurately describe the predictive PDF, the VB approximation method is applied to dynamically estimate the scale matrix rather than set nominal covariance as . Then, the PDF of can be appropriated as where denotes the inverse Wishart distribution, whose functional form will not change between prior and posterior, is the dof parameter, and is inverse scale matrix. and denote the variate gamma function and the trace operation, respectively.
Then, can be formulated as
According to the property of inverse Wishart distribution, we have
To capture the statistics of , the nominal covariance is chosen as the mean value of . Exploiting (19), the inverse scale matrix is given by where the nonnegative tuning parameter .
Based on the (10), (11), and (17), the predictive PDF and the likelihood PDF can be transformed as follows:
Note that we consider the case that the heavytailed process noise statistics, i.e., the scale matrix , is unknown and time varying, which is usually the case in practical applications especially for target tracking [29]. Therefore, the scale matrix of process noise is modeled as inverse Wishart distribution and estimated dynamically. For measurement noise, we assume that the noise statistics is known based on the prior information of sensors; therefore, it can be chosen wisely rather than estimated.
3.3. Derivation of Measurement Update Based on VB Approximation Method
To estimate the state , the joint posterior PDF is required to be approximated. By making use of the VB approximation method, we have where is the approximate posterior PDF, which could be obtained by minimizing the following function. where denotes the KullbackLeibler divergence function.
Minimizing (24) can reach the following VBmarginal [30]. where is a set consists of and , is an arbitrary element of and denotes the set without , and is the constant related to .
Since the PDF given by (21) and (22) are conditional independent, could be factored as
Substituting (21) and (22) into (26), we have
Then, can be expressed as [24].
By updating one element of and keeping the other fixed at their last estimated values, the VBmarginals given by (25) can be solved iteratively.
Let and substituting (28) in (25) results in where the superscript “” represents the th iteration. is given by
And the initial value of iteration is set as , , and .
Contrasting (13) with (29), the approximate posterior PDF can be given by where , .
Let and substituting (28) in (25) results in where is given by
The th cubature point and the predicted measurement are computed as follows: where is the Cholesky decomposition of satisfying .
Contrasting (13) with (32), the approximate posterior PDF can be given by where ,
Let and substituting (28) in (25) results in
Contrasting (36) with (18), the approximate posterior PDF can be given by where , , and .
Let and substituting (28) into (25) results in where , .
According to the Bayesian theory, the posterior PDF can be approximated by
Exploiting (38), and can be written as where , .
Since Gaussian distribution can approximate the posterior PDF more accurate than the Student’s distribution [24], the approximate posterior PDF can be formulated by
According to the basic equations of information filter, we have
Based on the linear error propagation, the cross covariance is approximated by
Multiplying and on the right hand side of (8) and (9) yields
Using (43) to simplify (44) and (45) results in
The predicted measurement and cross covariance are computed as follows: where is the th cubature point generated by and is the Cholesky decomposition of .
Based on the information contributions given by (46) and(47), the information state and matrix are updated as
Then, the estimated state and covariance can be recovered as
After the iterations, the approximate PDFs given in (23) are updated as where is the number of iterations (NOI).
The main advantage of the IF is its ability to fuse multisource measurements simply by adding the information contributions to the information matrix and state. Suppose sensors is available, the measurement equations can be given by where the subscript denotes the th sensor, is the measurement noise.
Then, the information matrix and information state can be updated by where the information contributions of th sensor are computed by
To better illustrate the proposed filtering algorithm, the computational procedures are summarized in Figure 1.
4. Simulation
To demonstrate the feasibility of the proposed algorithm, a target tracking problem is investigated in this section. The target moves in a plane with an unknown speed and unknown constant turn rate, it is observed by multiple radars in clutter. Due to the rapid motion and clutter, the heavytailed noises are introduced.
The state equation is given by where the state vector is defined as , is the turn rate, is the sampling interval, and is the process noise generated by where is probability of outlier, is given by
The measurement equation of th radar is given by where is the position of th radar, is the measurement noise generated by and is given by
The locations of the four sensors are given as
The initial state estimation is generated randomly based on the true initial value and initial covariance given by
In the simulation, the dof parameter, tuning parameter, and NOI of the proposed filter are set as , , and , respectively. The root mean square error (RMSE) is chosen as the performance metric. Based on 1000 independent Monte Carlo simulation runs, Figure 2 compares the performance of cubature information filter (CIF) [17], Huberbased cubature information filter (HCIF) [19], Student’s based cubature information filter (STCIF) [23], and the proposed filter. It can be seen that the CIF has the biggest RMSEs among four filters. This is not surprise, since the CIF is essentially a minimizer of a weighted leastsquares criterion, which is sensitive to heavytailed noises. In addition, one can also observe that the RMSEs of the proposed filter are smaller than the existing HCIF and STCIF, which indicates the superiority of the proposed filter.
(a)
(b)
(c)
The average computational costs of the various filters for each MonteCarlo run are given in Table 1. It can be seen that the computational time of the NRSTCIF is the longest, and that of the CIF is the shortest. It takes the NRSTCIF about 5 times as long as the CIF. Therefore, the algorithm proposed in this paper does not increase the computation time dramatically.

To clarify the relation between estimation accuracy and NOI, another 1000 independent Monte Carlo simulation runs with different NOIs are conducted based on the proposed filter, and the simulation results are summarized in Figure 3. It can be seen that the averaged RMSEs decrease as the NOI increase when , but the averaged RMSEs are almost same when NOI 4. Therefore, it is unnecessary to choose the NOI as big as possible, and the result is an important reference for NOI choosing.
Figure 4 shows the RMSEs of the CIF, HCIF, and the proposed filter with different probabilities of outlier . It can be seen the proposed filter is superior to the CIF and HCIF for all values of . And the averaged RMSEs of CIF and HCIF increase more rapidly than the proposed NRSTCIF as the increase of , which indicate the superiority of the NRSTCIF is more and more significant. In other words, the proposed NRSTCIF is more promising when the probability of outlier is larger.
(a)
(b)
(c)
5. Conclusions
In this paper, a novel robust Student’s based cubature information filter is proposed to handle the heavytailed process and measurement noises in nonlinear multisensor estimation. Based on the cubature rule, the onestep predicted state and the nominal covariance are propagated. To get the approximate solution of the posterior PDF, the predictive PDF and the likelihood PDF described by Student’s distribution are transformed into a hierarchical Gaussian form. To approximate the joint posterior PDF, the VB approximation method is utilized. After fixed point iterations, the state, scale matrix, and posterior densities are estimated. And the simulation results demonstrate the superiority of the proposed filter.
Data Availability
There is no underlying data related to the submission.
Conflicts of Interest
The authors declare that there is no conflict of interest regarding the publication of this paper.
References
 X. Wang, Q. Zhang, and H. Li, “An autonomous navigation scheme based on starlight, geomagnetic and gyros with information fusion for small satellites,” Acta Astronautica, vol. 94, no. 2, pp. 708–717, 2014. View at: Publisher Site  Google Scholar
 Y. Beaudoin, A. Desbiens, E. Gagnon, and R. Landry Jr., “Observability of satellite launcher navigation with INS, GPS, attitude sensors and reference trajectory,” Acta Astronautica, vol. 142, pp. 277–288, 2018. View at: Publisher Site  Google Scholar
 D. Willner, C. B. Chang, and K. P. Dunn, “Kalman filter algorithms for a multisensor system,” in 1976 IEEE Conference on Decision and Control including the 15th Symposium on Adaptive Processes, pp. 570–574, Clearwater, FL, USA, 1976. View at: Publisher Site  Google Scholar
 Q. Gan and C. J. Harris, “Comparison of two measurement fusion methods for Kalmanfilterbased multisensor data fusion,” IEEE Transactions on Aerospace and Electronic Systems, vol. 37, no. 1, pp. 273–279, 2001. View at: Publisher Site  Google Scholar
 Y. Wang, W. Zheng, S. Sun, and L. Li, “Robust information filter based on maximum correntropy criterion,” Journal of Guidance, Control, and Dynamics, vol. 39, no. 5, pp. 1126–1131, 2016. View at: Publisher Site  Google Scholar
 M. Roth, E. Özkan, and F. Gustafsson, “A Student’s T Filter for Heavy Tailed Process and Measurement Noise,” in 2013 IEEE International Conference on Acoustics, Speech and Signal Processing, pp. 5770–5774, Vancouver, BC, Canada, 2013. View at: Publisher Site  Google Scholar
 A. Jazwinski, Stochastic Processing and Filtering Theory, Academic Press, New York, USA, 1970.
 S. Julier, J. Uhlmann, and H. F. Durrantwhyte, “A new method for the nonlinear transformation of means and covariances in filters and estimators,” IEEE Transactions on Automatic Control, vol. 45, no. 3, pp. 477–482, 2000. View at: Publisher Site  Google Scholar
 H. Leeghim, Y. Choi, and B. A. Jaroux, “Uncorrelated unscented filtering for spacecraft attitude determination,” Acta Astronautica, vol. 67, no. 12, pp. 135–144, 2010. View at: Publisher Site  Google Scholar
 K. Ito and K. Xiong, “Gaussian filters for nonlinear filtering problems,” IEEE Transactions on Automatic Control, vol. 45, no. 5, pp. 910–927, 2000. View at: Publisher Site  Google Scholar
 M. Nørgaard, N. K. Poulsen, and O. Ravn, “New developments in state estimation for nonlinear systems,” Automatica, vol. 36, no. 11, pp. 1627–1638, 2000. View at: Publisher Site  Google Scholar
 I. Arasaratnam and S. Haykin, “Cubature Kalman Filters,” IEEE Transactions on Automatic Control, vol. 54, no. 6, pp. 1254–1269, 2009. View at: Publisher Site  Google Scholar
 H. Renke, S. Chen, H. Wu, Z. Liu, and J. Chen, “Optimal Maneuver Strategy of Observer for BearingOnly Tracking in Threat Environment,” International Journal of Aerospace Engineering, vol. 2018, Article ID 7901917, 9 pages, 2018. View at: Publisher Site  Google Scholar
 B. Jia and M. Xin, “Multiple sensor estimation using a new fifthdegree cubature information filter,” Transactions of the Institute of Measurement and Control, vol. 37, no. 1, pp. 15–24, 2014. View at: Publisher Site  Google Scholar
 S. E. Webster, J. M. Walls, L. L. Whitcomb, and R. M. Eustice, “Decentralized extended information filter for singleBeacon cooperative acoustic navigation: theory and experiments,” IEEE Transactions on Robotics, vol. 29, no. 4, pp. 957–974, 2013. View at: Publisher Site  Google Scholar
 D. J. Lee, “Nonlinear estimation and multiple sensor fusion using unscented information filtering,” IEEE Signal Processing Letters, vol. 15, pp. 861–864, 2008. View at: Publisher Site  Google Scholar
 K. P. B. Chandra, D. W. Gu, and I. Postlethwaite, “Square root cubature information filter,” IEEE Sensors Journal, vol. 13, no. 2, pp. 750–758, 2013. View at: Publisher Site  Google Scholar
 X. Wang, D. Gong, L. Xu, X. Shao, and D. Duan, “Laser radar based relative navigation using improved adaptive Huber filter,” Acta Astronautica, vol. 68, no. 1112, pp. 1872–1880, 2011. View at: Publisher Site  Google Scholar
 X. Wang, N. Cui, and J. Guo, “Huberbased unscented filtering and its application to visionbased relative navigation,” IET Radar, Sonar and Navigation, vol. 4, no. 1, pp. 134–141, 2010. View at: Publisher Site  Google Scholar
 X. Wang, W. Qin, N. Cui, and Y. Wang, “Robust highdegree cubature information filter and its application to trajectory estimation for ballistic missile,” Proceedings of the Institution of Mechanical Engineers, Part G: Journal of Aerospace Engineering, vol. 232, no. 12, pp. 2364–2377, 2017. View at: Publisher Site  Google Scholar
 Y. Huang and Y. Zhang, “Robust Student’s tBased Stochastic Cubature Filter for Nonlinear Systems With HeavyTailed Process and Measurement Noises,” IEEE Access, vol. 5, pp. 7964–7974, 2017. View at: Publisher Site  Google Scholar
 G. Wang, N. Li, and Y. Zhang, “Maximum correntropy unscented Kalman and information filters for nonGaussian measurement noise,” Journal of the Franklin Institute, vol. 354, no. 18, pp. 8659–8677, 2017. View at: Publisher Site  Google Scholar
 Y. Huang, Y. Zhang, N. Li, and J. Chambers, “Robust student’s t based nonlinear filter and smoother,” IEEE Transactions on Aerospace and Electronic Systems, vol. 52, no. 5, pp. 2586–2596, 2016. View at: Publisher Site  Google Scholar
 Y. Huang, Y. Zhang, Z. Wu, N. Li, and J. Chambers, “A novel robust tBased Kalman filter,” IEEE Transactions on Aerospace and Electronic Systems, vol. 53, no. 3, pp. 1545–1554, 2017. View at: Publisher Site  Google Scholar
 Y. Huang, Y. Zhang, B. Xu, and J. Chambers, “A new outlierrobust Student’s t based Gaussian approximate filter for cooperative localization,” IEEE/ASME Transactions on Mechatronics, vol. 22, no. 5, pp. 2380–2386, 2017. View at: Publisher Site  Google Scholar
 Y. Huang, Y. Zhang, and J. A. Chambers, “A novel Kullback–Leibler divergence minimizationbased adaptive Student’s tfilter,” IEEE Transactions on Signal Processing, vol. 67, no. 20, pp. 5417–5432, 2019. View at: Publisher Site  Google Scholar
 Y. Huang, Y. Zhang, Y. Zhao, and J. A. Chambers, “A novel robust Gaussian–Student'stMixture distribution based Kalman filter,” IEEE Transactions on Signal Processing, vol. 67, no. 13, pp. 3606–3620, 2019. View at: Publisher Site  Google Scholar
 Y. Huang, Y. Zhang, Z. Wu, N. Li, and J. Chambers, “A novel adaptive Kalman filter with inaccurate process and measurement noise covariance matrices,” IEEE Transactions on Automatic Control, vol. 63, no. 2, pp. 594–601, 2018. View at: Publisher Site  Google Scholar
 Y. Huang, Y. Zhang, P. Shi, Z. Wu, J. Qian, and J. A. Chambers, “Robust Kalman filters based on Gaussian scale mixture distributions with application to target tracking,” IEEE Transactions on Systems, Man, and Cybernetics: Systems, vol. 49, no. 10, pp. 2082–2096, 2019. View at: Publisher Site  Google Scholar
 P. Dong, Z. Jing, H. Leung, and K. Shen, “Variational Bayesian Adaptive Cubature Information Filter Based on Wishart Distribution,” IEEE Trans. Automat. Contr., vol. 62, no. 11, pp. 6051–6057, 2017. View at: Publisher Site  Google Scholar
Copyright
Copyright © 2020 Yongtao Shui 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.