New sigma point filtering algorithms, including the unscented Kalman filter （UKF） and the divided difference filter （DDF）, are designed to solve the nonlinear filtering problem under the condition of correlated no...New sigma point filtering algorithms, including the unscented Kalman filter （UKF） and the divided difference filter （DDF）, are designed to solve the nonlinear filtering problem under the condition of correlated noises. Based on the minimum mean square error estimation theory, the nonlinear optimal predictive and correction recursive formulas under the hypothesis that the input noise is correlated with the measurement noise are derived and can be described in a unified framework. Then, UKF and DDF with correlated noises are proposed on the basis of approximation of the posterior mean and covariance in the unified framework by using unscented transformation and second order Stirling＇s interpolation. The proposed UKF and DDF with correlated noises break through the limitation that input noise and measurement noise must be assumed to be uneorrelated in standard UKF and DDF. Two simulation examples show the effectiveness and feasibility of new algorithms for dealing with nonlinear filtering issue with correlated noises.展开更多
Based on the principle of statistical linear regression, a set of n ＋ 2 sigma points instead of 2n ＋ 1 sigma points used in the unscented Kalman filter （UKF）, is constructed to approximate the system state. And fi...Based on the principle of statistical linear regression, a set of n ＋ 2 sigma points instead of 2n ＋ 1 sigma points used in the unscented Kalman filter （UKF）, is constructed to approximate the system state. And filter accuracy is second order. Real-time of modified UKF is improved. In order to describe accurately the maneuvering target, the ＂current＂ statistical model is used. And the equation of acceleration error covariance is modified at every sample time of the filter. The modified adaptive UKF is presented for estimating the position, velocity and acceleration of maneuvering target. Monte Carlo simulations show the modified adaptive UKF acquires good performance for tracking position of maneuvering target. The modified adaptive UKF has better computational efficiency than UKF.展开更多
In this paper, adaptive sensor fusion INS/GNSS is proposed to solve specific problem of non linear time variant state space estimation with measurement outliers, different algorithms are used to solve this specific pr...In this paper, adaptive sensor fusion INS/GNSS is proposed to solve specific problem of non linear time variant state space estimation with measurement outliers, different algorithms are used to solve this specific problem generally occurs in intentional and non-intentional interferences caused by other radio navigation sources, or by the GNSS receiver’s deterioration. Non linear approximation techniques such as Extended Kalman filter EKF, Sigma Point Kalman Filters such as UKF and CDKF are computed to estimate the navigation states for UAV flight control. Several comparisons are conduced and analyzed in order to compare the accuracy and the convergence of different approaches usually applied in navigation data fusion purposes. The last non linear filter algorithm developed is the Cubature Kalman Filter CKF which provides more accurate estimation with more stability in Tracking data fusion application. In this work, CKF is compared with SPKF and EKF in ideal conditions and during GNSS outliers supposed to occur during specific interval of time, innovation based adaptive approach is selected and used to modify the covariance calculation of the non linear filters performed in this paper. Interesting results are observed, discussed with real perspectives in navigation data fusion for real time applications. Three parallel modified algorithms are simulated and compared to non-adaptive forms according to Root Mean Square Error (RMSE) criteria.展开更多
Sigma-Point Kalman Filters (SPKFs) are popular estimation techniques for high nonlinear system applications. The benefits of using SPKFs include (but not limited to) the following: the easiness of linearizing the nonl...Sigma-Point Kalman Filters (SPKFs) are popular estimation techniques for high nonlinear system applications. The benefits of using SPKFs include (but not limited to) the following: the easiness of linearizing the nonlinear matrices statistically without the need to use the Jacobian matrices, the ability to handle more uncertainties than the Extended Kalman Filter (EKF), the ability to handle different types of noise, having less computational time than the Particle Filter (PF) and most of the adaptive techniques which makes it suitable for online applications, and having acceptable performance compared to other nonlinear estimation techniques. Therefore, SPKFs are a strong candidate for nonlinear industrial applications, i.e. robotic arm. Controlling a robotic arm is hard and challenging due to the system nature, which includes sinusoidal functions, and the dependency on the sensors’ number, quality, accuracy and functionality. SPKFs provide with a mechanism that reduces the latter issue in terms of numbers of required sensors and their sensitivity. Moreover, they could handle the nonlinearity for a certain degree. This could be used to improve the controller quality while reducing the cost. In this paper, some SPKF algorithms are applied to 4-DOF robotic arm that consists of one prismatic joint and three revolute joints (PRRR). Those include the Unscented Kalman Filter (UKF), the Cubature Kalman Filter (CKF), and the Central Differences Kalman Filter (CDKF). This study gives a study of those filters and their responses, stability, robustness, computational time, complexity and convergences in order to obtain the suitable filter for an experimental setup.展开更多
基金Projects(61135001, 61075029, 61074155) supported by the National Natural Science Foundation of ChinaProject(20110491690) supported by the Postdocteral Science Foundation of China
文摘New sigma point filtering algorithms, including the unscented Kalman filter （UKF） and the divided difference filter （DDF）, are designed to solve the nonlinear filtering problem under the condition of correlated noises. Based on the minimum mean square error estimation theory, the nonlinear optimal predictive and correction recursive formulas under the hypothesis that the input noise is correlated with the measurement noise are derived and can be described in a unified framework. Then, UKF and DDF with correlated noises are proposed on the basis of approximation of the posterior mean and covariance in the unified framework by using unscented transformation and second order Stirling＇s interpolation. The proposed UKF and DDF with correlated noises break through the limitation that input noise and measurement noise must be assumed to be uneorrelated in standard UKF and DDF. Two simulation examples show the effectiveness and feasibility of new algorithms for dealing with nonlinear filtering issue with correlated noises.
基金the National Natural Science Foundation of China (413090503)
文摘Based on the principle of statistical linear regression, a set of n ＋ 2 sigma points instead of 2n ＋ 1 sigma points used in the unscented Kalman filter （UKF）, is constructed to approximate the system state. And filter accuracy is second order. Real-time of modified UKF is improved. In order to describe accurately the maneuvering target, the ＂current＂ statistical model is used. And the equation of acceleration error covariance is modified at every sample time of the filter. The modified adaptive UKF is presented for estimating the position, velocity and acceleration of maneuvering target. Monte Carlo simulations show the modified adaptive UKF acquires good performance for tracking position of maneuvering target. The modified adaptive UKF has better computational efficiency than UKF.
文摘In this paper, adaptive sensor fusion INS/GNSS is proposed to solve specific problem of non linear time variant state space estimation with measurement outliers, different algorithms are used to solve this specific problem generally occurs in intentional and non-intentional interferences caused by other radio navigation sources, or by the GNSS receiver’s deterioration. Non linear approximation techniques such as Extended Kalman filter EKF, Sigma Point Kalman Filters such as UKF and CDKF are computed to estimate the navigation states for UAV flight control. Several comparisons are conduced and analyzed in order to compare the accuracy and the convergence of different approaches usually applied in navigation data fusion purposes. The last non linear filter algorithm developed is the Cubature Kalman Filter CKF which provides more accurate estimation with more stability in Tracking data fusion application. In this work, CKF is compared with SPKF and EKF in ideal conditions and during GNSS outliers supposed to occur during specific interval of time, innovation based adaptive approach is selected and used to modify the covariance calculation of the non linear filters performed in this paper. Interesting results are observed, discussed with real perspectives in navigation data fusion for real time applications. Three parallel modified algorithms are simulated and compared to non-adaptive forms according to Root Mean Square Error (RMSE) criteria.
文摘Sigma-Point Kalman Filters (SPKFs) are popular estimation techniques for high nonlinear system applications. The benefits of using SPKFs include (but not limited to) the following: the easiness of linearizing the nonlinear matrices statistically without the need to use the Jacobian matrices, the ability to handle more uncertainties than the Extended Kalman Filter (EKF), the ability to handle different types of noise, having less computational time than the Particle Filter (PF) and most of the adaptive techniques which makes it suitable for online applications, and having acceptable performance compared to other nonlinear estimation techniques. Therefore, SPKFs are a strong candidate for nonlinear industrial applications, i.e. robotic arm. Controlling a robotic arm is hard and challenging due to the system nature, which includes sinusoidal functions, and the dependency on the sensors’ number, quality, accuracy and functionality. SPKFs provide with a mechanism that reduces the latter issue in terms of numbers of required sensors and their sensitivity. Moreover, they could handle the nonlinearity for a certain degree. This could be used to improve the controller quality while reducing the cost. In this paper, some SPKF algorithms are applied to 4-DOF robotic arm that consists of one prismatic joint and three revolute joints (PRRR). Those include the Unscented Kalman Filter (UKF), the Cubature Kalman Filter (CKF), and the Central Differences Kalman Filter (CDKF). This study gives a study of those filters and their responses, stability, robustness, computational time, complexity and convergences in order to obtain the suitable filter for an experimental setup.
