A novel low-cost adaptive square-root cubature Kalmanfilter （LCASCKF） is proposed to enhance the robustness of processmodels while only increasing the computational load slightly.It is well-known that the Kalman fil...A novel low-cost adaptive square-root cubature Kalmanfilter （LCASCKF） is proposed to enhance the robustness of processmodels while only increasing the computational load slightly.It is well-known that the Kalman filter cannot handle uncertainties ina process model, such as initial state estimation errors, parametermismatch and abrupt state changes. These uncertainties severelyaffect filter performance and may even provoke divergence. Astrong tracking filter （STF）, which utilizes a suboptimal fading factor,is an adaptive approach that is commonly adopted to solvethis problem. However, if the strong tracking SCKF （STSCKF）uses the same method as the extended Kalman filter （EKF） tointroduce the suboptimal fading factor, it greatly increases thecomputational load. To avoid this problem, a low-cost introductorymethod is proposed and a hypothesis testing theory is applied todetect uncertainties. The computational load analysis is performedby counting the total number of floating-point operations and it isfound that the computational load of LCASCKF is close to that ofSCKF. Experimental results prove that the LCASCKF performs aswell as STSCKF, while the increase in computational load is muchlower than STSCKF.展开更多
Mobile robot systems performing simultaneous localization and mapping(SLAM) are generally plagued by non-Gaussian noise.To improve both accuracy and robustness under non-Gaussian measurement noise,a robust SLAM algori...Mobile robot systems performing simultaneous localization and mapping(SLAM) are generally plagued by non-Gaussian noise.To improve both accuracy and robustness under non-Gaussian measurement noise,a robust SLAM algorithm is proposed.It is based on the square-root cubature Kalman filter equipped with a Huber' s generalized maximum likelihood estimator(GM-estimator).In particular,the square-root cubature rule is applied to propagate the robot state vector and covariance matrix in the time update,the measurement update and the new landmark initialization stages of the SLAM.Moreover,gain weight matrices with respect to the measurement residuals are calculated by utilizing Huber' s technique in the measurement update step.The measurement outliers are suppressed by lower Kalman gains as merging into the system.The proposed algorithm can achieve better performance under the condition of non-Gaussian measurement noise in comparison with benchmark algorithms.The simulation results demonstrate the advantages of the proposed SLAM algorithm.展开更多
The stochastic convergence of the cubature Kalmanfilter with intermittent observations （CKFI） for general nonlinearstochastic systems is investigated. The Bernoulli distributed ran-dom variable is employed to descri...The stochastic convergence of the cubature Kalmanfilter with intermittent observations （CKFI） for general nonlinearstochastic systems is investigated. The Bernoulli distributed ran-dom variable is employed to describe the phenomenon of intermit-tent observations. According to the cubature sample principle, theestimation error and the error covariance matrix （ECM） of CKFIare derived by Taylor series expansion, respectively. Afterwards, itis theoretically proved that the ECM will be bounded if the obser-vation arrival probability exceeds a critical minimum observationarrival probability. Meanwhile, under proper assumption corre-sponding with real engineering situations, the stochastic stabilityof the estimation error can be guaranteed when the initial estima-tion error and the stochastic noise terms are sufficiently small. Thetheoretical conclusions are verified by numerical simulations fortwo illustrative examples; also by evaluating the tracking perfor-mance of the optical-electric target tracking system implementedby CKFI and unscented Kalman filter with intermittent observa-tions （UKFI） separately, it is demonstrated that the proposed CKFIslightly outperforms the UKFI with respect to tracking accuracy aswell as real time performance.展开更多
Reasonable selection and optimization of a filter used in model estimation for a multiple model structure is the key to improve tracking accuracy of maneuvering target.Combining with the cubature Kalman filter with it...Reasonable selection and optimization of a filter used in model estimation for a multiple model structure is the key to improve tracking accuracy of maneuvering target.Combining with the cubature Kalman filter with iterated observation update and the interacting multiple model method,a novel interacting multiple model algorithm based on the cubature Kalman filter with observation iterated update is proposed.Firstly,aiming to the structural features of cubature Kalman filter,the cubature Kalman filter with observation iterated update is constructed by the mechanism of iterated observation update.Secondly,the improved cubature Kalman filter is used as the model filter of interacting multiple model,and the stability and reliability of model identification and state estimation are effectively promoted by the optimization of model filtering step.In the simulations,compared with classic improved interacting multiple model algorithms,the theoretical analysis and experimental results show the feasibility and validity of the proposed algorithm.展开更多
To solve the problem that the choice of softening factor in conventional adaptive strong tracking filter( STF) greatly relies on the experience and computer simulation,a new concept of softening factor matrix is intro...To solve the problem that the choice of softening factor in conventional adaptive strong tracking filter( STF) greatly relies on the experience and computer simulation,a new concept of softening factor matrix is introduced and a fuzzy adaptive strong tracking cubature Kalman filter( FASTCKF) based on fuzzy logic controller is proposed. This method monitors residual absolute mean and standard deviation of each measurement component with fuzzy logic adaptive controller( FLAC),and adjusts the softening factor matrix dynamically by fuzzy rules,which is capable to modify suboptimal fading factor of STF adaptively and improve the filter's robust adaptive capacity. The simulation results show that the improved filtering performance is superior to the conventional square root cubature Kalman filter( SCKF) and the strong tracking square root cubature Kalman filter( STSCKF).展开更多
A novel variational Bayesian inference based on adaptive cubature Kalman filter(VBACKF)algorithm is proposed for the problem of state estimation in a target tracking system with time-varying measurement noise and rand...A novel variational Bayesian inference based on adaptive cubature Kalman filter(VBACKF)algorithm is proposed for the problem of state estimation in a target tracking system with time-varying measurement noise and random measurement losses.Firstly,the Inverse-Wishart(IW)distribution is chosen to model the covariance matrix of time-varying measurement noise in the cubature Kalman filter framework.Secondly,the Bernoulli random variable is introduced as the judgement factor of the measurement losses,and the Beta distribution is selected as the conjugate prior distribution of measurement loss probability to ensure that the posterior distribution and prior distribution have the same function form.Finally,the joint posterior probability density function of the estimated variables is approximately decoupled by the variational Bayesian inference,and the fixed-point iteration approach is used to update the estimated variables.The simulation results show that the proposed VBACKF algorithm considers the comprehensive effects of system nonlinearity,time-varying measurement noise and unknown measurement loss probability,moreover,effectively improves the accuracy of target state estimation in complex scene.展开更多
Traditional cubature Kalman filter(CKF)is a preferable tool for the inertial navigation system(INS)/global positioning system(GPS)integration under Gaussian noises.The CKF,however,may provide a significantly biased es...Traditional cubature Kalman filter(CKF)is a preferable tool for the inertial navigation system(INS)/global positioning system(GPS)integration under Gaussian noises.The CKF,however,may provide a significantly biased estimate when the INS/GPS system suffers from complex non-Gaussian disturbances.To address this issue,a robust nonlinear Kalman filter referred to as cubature Kalman filter under minimum error entropy with fiducial points(MEEF-CKF)is proposed.The MEEF-CKF behaves a strong robustness against complex nonGaussian noises by operating several major steps,i.e.,regression model construction,robust state estimation and free parameters optimization.More concretely,a regression model is constructed with the consideration of residual error caused by linearizing a nonlinear function at the first step.The MEEF-CKF is then developed by solving an optimization problem based on minimum error entropy with fiducial points(MEEF)under the framework of the regression model.In the MEEF-CKF,a novel optimization approach is provided for the purpose of determining free parameters adaptively.In addition,the computational complexity and convergence analyses of the MEEF-CKF are conducted for demonstrating the calculational burden and convergence characteristic.The enhanced robustness of the MEEF-CKF is demonstrated by Monte Carlo simulations on the application of a target tracking with INS/GPS integration under complex nonGaussian noises.展开更多
Aiming at the adverse effect caused by observation noise on system state estimation precision,a novel distributed cubature Kalman filter(CKF) based on observation bootstrap sampling is proposed.Firstly,combining with ...Aiming at the adverse effect caused by observation noise on system state estimation precision,a novel distributed cubature Kalman filter(CKF) based on observation bootstrap sampling is proposed.Firstly,combining with the extraction and utilization of the latest observation information and the prior statistical information from observation noise modeling,an observation bootstrap sampling strategy is designed.The objective is to deal with the adverse influence of observation uncertainty by increasing observations information.Secondly,the strategy is dynamically introduced into the cubature Kalman filter,and the distributed fusion framework of filtering realization is constructed.Better filtering precision is obtained by promoting observation reliability without increasing the hardware cost of observation system.Theory analysis and simulation results show the proposed algorithm feasibility and effectiveness.展开更多
The paper deals with state estimation problem of nonlinear non-Gaussian discrete dynamic systems for improvement of accuracy and consistency. An efficient new algorithm called the adaptive Gaussian-sum square-root cub...The paper deals with state estimation problem of nonlinear non-Gaussian discrete dynamic systems for improvement of accuracy and consistency. An efficient new algorithm called the adaptive Gaussian-sum square-root cubature Kalman filter（AGSSCKF） with a split-merge scheme is proposed. It is developed based on the squared-root extension of newly introduced cubature Kalman filter（SCKF） and is built within a Gaussian-sum framework. Based on the condition that the probability density functions of process noises and initial state are denoted by a Gaussian sum using optimization method, a bank of SCKF are used as the sub-filters to estimate state of system with the corresponding weights respectively, which is adaptively updated. The new algorithm consists of an adaptive splitting and merging procedure according to a proposed split-decision model based on the nonlinearity degree of measurement. The results of two simulation scenarios（one-dimensional state estimation and bearings-only tracking） show that the proposed filter demonstrates comparable performance to the particle filter with significantly reduced computational cost.展开更多
基金Supported by the National Natural Science Foundation of China （50979017, NSFC60775060） the National High Technology Ship Research Project of China （GJCB09001）
基金supported by the National Natural Science Foundation of China(61573283)
文摘A novel low-cost adaptive square-root cubature Kalmanfilter （LCASCKF） is proposed to enhance the robustness of processmodels while only increasing the computational load slightly.It is well-known that the Kalman filter cannot handle uncertainties ina process model, such as initial state estimation errors, parametermismatch and abrupt state changes. These uncertainties severelyaffect filter performance and may even provoke divergence. Astrong tracking filter （STF）, which utilizes a suboptimal fading factor,is an adaptive approach that is commonly adopted to solvethis problem. However, if the strong tracking SCKF （STSCKF）uses the same method as the extended Kalman filter （EKF） tointroduce the suboptimal fading factor, it greatly increases thecomputational load. To avoid this problem, a low-cost introductorymethod is proposed and a hypothesis testing theory is applied todetect uncertainties. The computational load analysis is performedby counting the total number of floating-point operations and it isfound that the computational load of LCASCKF is close to that ofSCKF. Experimental results prove that the LCASCKF performs aswell as STSCKF, while the increase in computational load is muchlower than STSCKF.
基金Supported by the National High Technology Research and Development Program of China(2010AA09Z104)the Fundamental Research Funds of the Zhejiang University(2014FZA5020)
文摘Mobile robot systems performing simultaneous localization and mapping(SLAM) are generally plagued by non-Gaussian noise.To improve both accuracy and robustness under non-Gaussian measurement noise,a robust SLAM algorithm is proposed.It is based on the square-root cubature Kalman filter equipped with a Huber' s generalized maximum likelihood estimator(GM-estimator).In particular,the square-root cubature rule is applied to propagate the robot state vector and covariance matrix in the time update,the measurement update and the new landmark initialization stages of the SLAM.Moreover,gain weight matrices with respect to the measurement residuals are calculated by utilizing Huber' s technique in the measurement update step.The measurement outliers are suppressed by lower Kalman gains as merging into the system.The proposed algorithm can achieve better performance under the condition of non-Gaussian measurement noise in comparison with benchmark algorithms.The simulation results demonstrate the advantages of the proposed SLAM algorithm.
基金supported by the National Natural Science Foundation of China(6110418661273076)
文摘The stochastic convergence of the cubature Kalmanfilter with intermittent observations （CKFI） for general nonlinearstochastic systems is investigated. The Bernoulli distributed ran-dom variable is employed to describe the phenomenon of intermit-tent observations. According to the cubature sample principle, theestimation error and the error covariance matrix （ECM） of CKFIare derived by Taylor series expansion, respectively. Afterwards, itis theoretically proved that the ECM will be bounded if the obser-vation arrival probability exceeds a critical minimum observationarrival probability. Meanwhile, under proper assumption corre-sponding with real engineering situations, the stochastic stabilityof the estimation error can be guaranteed when the initial estima-tion error and the stochastic noise terms are sufficiently small. Thetheoretical conclusions are verified by numerical simulations fortwo illustrative examples; also by evaluating the tracking perfor-mance of the optical-electric target tracking system implementedby CKFI and unscented Kalman filter with intermittent observa-tions （UKFI） separately, it is demonstrated that the proposed CKFIslightly outperforms the UKFI with respect to tracking accuracy aswell as real time performance.
基金Supported by the National Nature Science Foundations of China(No.61300214,U1204611,61170243)the Science and Technology Innovation Team Support Plan of Education Department of Henan Province(No.13IRTSTHN021)+3 种基金the Science and Technology Research Key Project of Education Department of Henan Province(No.13A413066)the Basic and Frontier Technology Research Plan of Henan Province(No.132300410148)the Funding Scheme of Young Key Teacher of Henan Province Universitiesthe Key Project of Teaching Reform Research of Henan University(No.HDXJJG2013-07)
文摘Reasonable selection and optimization of a filter used in model estimation for a multiple model structure is the key to improve tracking accuracy of maneuvering target.Combining with the cubature Kalman filter with iterated observation update and the interacting multiple model method,a novel interacting multiple model algorithm based on the cubature Kalman filter with observation iterated update is proposed.Firstly,aiming to the structural features of cubature Kalman filter,the cubature Kalman filter with observation iterated update is constructed by the mechanism of iterated observation update.Secondly,the improved cubature Kalman filter is used as the model filter of interacting multiple model,and the stability and reliability of model identification and state estimation are effectively promoted by the optimization of model filtering step.In the simulations,compared with classic improved interacting multiple model algorithms,the theoretical analysis and experimental results show the feasibility and validity of the proposed algorithm.
基金National Natural Science Foundations of China(Nos.51175082,60874092,51375088)
文摘To solve the problem that the choice of softening factor in conventional adaptive strong tracking filter( STF) greatly relies on the experience and computer simulation,a new concept of softening factor matrix is introduced and a fuzzy adaptive strong tracking cubature Kalman filter( FASTCKF) based on fuzzy logic controller is proposed. This method monitors residual absolute mean and standard deviation of each measurement component with fuzzy logic adaptive controller( FLAC),and adjusts the softening factor matrix dynamically by fuzzy rules,which is capable to modify suboptimal fading factor of STF adaptively and improve the filter's robust adaptive capacity. The simulation results show that the improved filtering performance is superior to the conventional square root cubature Kalman filter( SCKF) and the strong tracking square root cubature Kalman filter( STSCKF).
基金Supported by the National Natural Science Foundation of China(No.61976080)the Science and Technology Key Project of Science and TechnologyDepartment of Henan Province(No.212102310298)+1 种基金the Academic Degrees&Graduate Education Reform Project of Henan Province(No.2021SJGLX195Y)the Innovation and Quality Improvement Project for Graduate Education of Henan University(No.SYL20010101)。
文摘A novel variational Bayesian inference based on adaptive cubature Kalman filter(VBACKF)algorithm is proposed for the problem of state estimation in a target tracking system with time-varying measurement noise and random measurement losses.Firstly,the Inverse-Wishart(IW)distribution is chosen to model the covariance matrix of time-varying measurement noise in the cubature Kalman filter framework.Secondly,the Bernoulli random variable is introduced as the judgement factor of the measurement losses,and the Beta distribution is selected as the conjugate prior distribution of measurement loss probability to ensure that the posterior distribution and prior distribution have the same function form.Finally,the joint posterior probability density function of the estimated variables is approximately decoupled by the variational Bayesian inference,and the fixed-point iteration approach is used to update the estimated variables.The simulation results show that the proposed VBACKF algorithm considers the comprehensive effects of system nonlinearity,time-varying measurement noise and unknown measurement loss probability,moreover,effectively improves the accuracy of target state estimation in complex scene.
基金supported by the Fundamental Research Funds for the Central Universities(xzy022020045)the National Natural Science Foundation of China(61976175)。
文摘Traditional cubature Kalman filter(CKF)is a preferable tool for the inertial navigation system(INS)/global positioning system(GPS)integration under Gaussian noises.The CKF,however,may provide a significantly biased estimate when the INS/GPS system suffers from complex non-Gaussian disturbances.To address this issue,a robust nonlinear Kalman filter referred to as cubature Kalman filter under minimum error entropy with fiducial points(MEEF-CKF)is proposed.The MEEF-CKF behaves a strong robustness against complex nonGaussian noises by operating several major steps,i.e.,regression model construction,robust state estimation and free parameters optimization.More concretely,a regression model is constructed with the consideration of residual error caused by linearizing a nonlinear function at the first step.The MEEF-CKF is then developed by solving an optimization problem based on minimum error entropy with fiducial points(MEEF)under the framework of the regression model.In the MEEF-CKF,a novel optimization approach is provided for the purpose of determining free parameters adaptively.In addition,the computational complexity and convergence analyses of the MEEF-CKF are conducted for demonstrating the calculational burden and convergence characteristic.The enhanced robustness of the MEEF-CKF is demonstrated by Monte Carlo simulations on the application of a target tracking with INS/GPS integration under complex nonGaussian noises.
基金Supported by the National Natural Science Foundation of China(No.61300214)the Science and Technology Innovation Team Support Plan of Education Department of Henan Province(13IRTSTHN021)+1 种基金the Post-doctoral Science Foundation of China(No.2014M551999)the Funding Scheme of Young Key Teacher of Henan Province Universities(No.2013GGJS-026)
文摘Aiming at the adverse effect caused by observation noise on system state estimation precision,a novel distributed cubature Kalman filter(CKF) based on observation bootstrap sampling is proposed.Firstly,combining with the extraction and utilization of the latest observation information and the prior statistical information from observation noise modeling,an observation bootstrap sampling strategy is designed.The objective is to deal with the adverse influence of observation uncertainty by increasing observations information.Secondly,the strategy is dynamically introduced into the cubature Kalman filter,and the distributed fusion framework of filtering realization is constructed.Better filtering precision is obtained by promoting observation reliability without increasing the hardware cost of observation system.Theory analysis and simulation results show the proposed algorithm feasibility and effectiveness.
基金supported by the National Natural Science Foundation of China(No. 61032001)Shandong Provincial Natural Science Foundation of China (No. ZR2012FQ004)
文摘The paper deals with state estimation problem of nonlinear non-Gaussian discrete dynamic systems for improvement of accuracy and consistency. An efficient new algorithm called the adaptive Gaussian-sum square-root cubature Kalman filter（AGSSCKF） with a split-merge scheme is proposed. It is developed based on the squared-root extension of newly introduced cubature Kalman filter（SCKF） and is built within a Gaussian-sum framework. Based on the condition that the probability density functions of process noises and initial state are denoted by a Gaussian sum using optimization method, a bank of SCKF are used as the sub-filters to estimate state of system with the corresponding weights respectively, which is adaptively updated. The new algorithm consists of an adaptive splitting and merging procedure according to a proposed split-decision model based on the nonlinearity degree of measurement. The results of two simulation scenarios（one-dimensional state estimation and bearings-only tracking） show that the proposed filter demonstrates comparable performance to the particle filter with significantly reduced computational cost.
