Aimed at the problem that the state estimation in the measurement update of the simultaneous localization and mapping(SLAM)method is incorrect or even not convergent because of the non-Gaussian measurement noise,outli...Aimed at the problem that the state estimation in the measurement update of the simultaneous localization and mapping(SLAM)method is incorrect or even not convergent because of the non-Gaussian measurement noise,outliers,or unknown and time-varying noise statistical characteristics,a robust SLAM method based on the improved variational Bayesian adaptive Kalman filtering(IVBAKF)is proposed.First,the measurement noise covariance is estimated using the variable Bayesian adaptive filtering algorithm.Then,the estimated covariance matrix is robustly processed through the weight function constructed in the form of a reweighted average.Finally,the system updates are iterated multiple times to further gradually correct the state estimation error.Furthermore,to observe features at different depths,a feature measurement model containing depth parameters is constructed.Experimental results show that when the measurement noise does not obey the Gaussian distribution and there are outliers in the measurement information,compared with the variational Bayesian adaptive SLAM method,the positioning accuracy of the proposed method is improved by 17.23%,20.46%,and 17.76%,which has better applicability and robustness to environmental disturbance.展开更多
Simultaneous localization and mapping(SLAM)has been applied across a wide range of areas from robotics to automatic pilot.Most of the SLAM algorithms are based on the assumption that the noise is timeinvariant Gaussia...Simultaneous localization and mapping(SLAM)has been applied across a wide range of areas from robotics to automatic pilot.Most of the SLAM algorithms are based on the assumption that the noise is timeinvariant Gaussian distribution.In some cases,this assumption no longer holds and the performance of the traditional SLAM algorithms declines.In this paper,we present a robust SLAM algorithm based on variational Bayes method by modelling the observation noise as inverse-Wishart distribution with "harmonic mean".Besides,cubature integration is utilized to solve the problem of nonlinear system.The proposed algorithm can effectively solve the problem of filtering divergence for traditional filtering algorithm when suffering the time-variant observation noise,especially for heavy-tai led noise.To validate the algorithm,we compare it with other t raditional filtering algorithms.The results show the effectiveness of the algorithm.展开更多
为降低实际应用中由强未知干扰和仪器故障对观测造成的影响,减轻随机和未建模干扰对系统的侵蚀,从而提升系统在非高斯噪声环境下的状态估计精度,提高滤波器的鲁棒性能,提出了一种基于高斯-重尾切换分布的鲁棒卡尔曼滤波器(Gaussian-heav...为降低实际应用中由强未知干扰和仪器故障对观测造成的影响,减轻随机和未建模干扰对系统的侵蚀,从而提升系统在非高斯噪声环境下的状态估计精度,提高滤波器的鲁棒性能,提出了一种基于高斯-重尾切换分布的鲁棒卡尔曼滤波器(Gaussian-heavy-tailed switching distribution based robust Kalman filter,GHTSRKF)。首先,通过自适应学习高斯分布和一种重尾分布之间的切换概率将噪声建模为GHTS(Gaussian-heavy-tailed switching)分布,所设计的GHTS分布可以通过在线调整高斯分布和新的重尾分布之间的切换概率来对非平稳重尾噪声进行建模,具有虚拟协方差的高斯分布用于处理协方差矩阵不准确的高斯噪声。其次,引入两个分别服从Categorical分布与伯努利分布的辅助参数将GHTS分布表示为一个分层高斯形式,进一步利用变分贝叶斯方法推导了GHTSRKF。最后,利用一个仿真场景对几种不同的RKFs(robust Kalman filters)进行了对比验证。结果表明,所提出的GHTSRKF算法的估计精度对初始状态的选取不敏感,精度优于其他RKFs,它的RMSEs最接近噪声信息准确的KFTNC(KF with true noise covariances)的RMSEs(root mean square errors),且当系统与量测噪声是未知时变高斯噪声时,相比于现有的滤波器,GHTSRKF具有更好的估计性能,从而验证了GHTSRKF的有效性。展开更多
基金Primary Research and Development Plan of Jiangsu Province(No.BE2022389)Jiangsu Province Agricultural Science and Technology Independent Innovation Fund Project(No.CX(22)3091)the National Natural Science Foundation of China(No.61773113)。
文摘Aimed at the problem that the state estimation in the measurement update of the simultaneous localization and mapping(SLAM)method is incorrect or even not convergent because of the non-Gaussian measurement noise,outliers,or unknown and time-varying noise statistical characteristics,a robust SLAM method based on the improved variational Bayesian adaptive Kalman filtering(IVBAKF)is proposed.First,the measurement noise covariance is estimated using the variable Bayesian adaptive filtering algorithm.Then,the estimated covariance matrix is robustly processed through the weight function constructed in the form of a reweighted average.Finally,the system updates are iterated multiple times to further gradually correct the state estimation error.Furthermore,to observe features at different depths,a feature measurement model containing depth parameters is constructed.Experimental results show that when the measurement noise does not obey the Gaussian distribution and there are outliers in the measurement information,compared with the variational Bayesian adaptive SLAM method,the positioning accuracy of the proposed method is improved by 17.23%,20.46%,and 17.76%,which has better applicability and robustness to environmental disturbance.
基金the National Natural Science Foundation of China(No.61803260)。
文摘Simultaneous localization and mapping(SLAM)has been applied across a wide range of areas from robotics to automatic pilot.Most of the SLAM algorithms are based on the assumption that the noise is timeinvariant Gaussian distribution.In some cases,this assumption no longer holds and the performance of the traditional SLAM algorithms declines.In this paper,we present a robust SLAM algorithm based on variational Bayes method by modelling the observation noise as inverse-Wishart distribution with "harmonic mean".Besides,cubature integration is utilized to solve the problem of nonlinear system.The proposed algorithm can effectively solve the problem of filtering divergence for traditional filtering algorithm when suffering the time-variant observation noise,especially for heavy-tai led noise.To validate the algorithm,we compare it with other t raditional filtering algorithms.The results show the effectiveness of the algorithm.
文摘为降低实际应用中由强未知干扰和仪器故障对观测造成的影响,减轻随机和未建模干扰对系统的侵蚀,从而提升系统在非高斯噪声环境下的状态估计精度,提高滤波器的鲁棒性能,提出了一种基于高斯-重尾切换分布的鲁棒卡尔曼滤波器(Gaussian-heavy-tailed switching distribution based robust Kalman filter,GHTSRKF)。首先,通过自适应学习高斯分布和一种重尾分布之间的切换概率将噪声建模为GHTS(Gaussian-heavy-tailed switching)分布,所设计的GHTS分布可以通过在线调整高斯分布和新的重尾分布之间的切换概率来对非平稳重尾噪声进行建模,具有虚拟协方差的高斯分布用于处理协方差矩阵不准确的高斯噪声。其次,引入两个分别服从Categorical分布与伯努利分布的辅助参数将GHTS分布表示为一个分层高斯形式,进一步利用变分贝叶斯方法推导了GHTSRKF。最后,利用一个仿真场景对几种不同的RKFs(robust Kalman filters)进行了对比验证。结果表明,所提出的GHTSRKF算法的估计精度对初始状态的选取不敏感,精度优于其他RKFs,它的RMSEs最接近噪声信息准确的KFTNC(KF with true noise covariances)的RMSEs(root mean square errors),且当系统与量测噪声是未知时变高斯噪声时,相比于现有的滤波器,GHTSRKF具有更好的估计性能,从而验证了GHTSRKF的有效性。
