基于变分贝叶斯双尺度自适应时变噪声容积卡尔曼滤波的同步定位与建图算法

作者：李帅永; 谢现乐; 毛文平; 杨雪梅; 聂嘉炜

来源：电子与信息学报, 2022, 1-9.

• SLAM
• 容积卡尔曼滤波
• 变分贝叶斯
• 一步预测误差协方差矩阵
• 观测噪声协方差矩阵

为解决移动机器人在同步定位与建图(SLAM)中因系统噪声和观测噪声时变导致状态估计精度降低的问题，该文提出一种基于变分贝叶斯的双尺度自适应时变噪声容积卡尔曼滤波SLAM算法(DSACKF SLAM)。该算法采用逆Wishart分布对一步预测误差协方差矩阵P_(k|k–1)和观测噪声协方差矩阵R_k建模，分别用来降低系统噪声和观测噪声的影响，并利用变分贝叶斯滤波实现对移动机器人状态向量X_k,P_(k|k–1)和R_k的联合估计。分别在系统噪声和观测噪声时变和时不变的条件下进行仿真实验，结果表明与基于无迹卡尔曼滤波的SLAM算法(UKF SLAM)、自适应更新观测噪声的容积卡尔曼滤波的SLAM算法(VB-ACKF SLAM)相比，提出的DSACKF SLAM算法在噪声时变时，平均位置误差分别减小1.54 m, 3.47 m；噪声时不变时，平均位置误差分别减小0.62m, 1.41 m，证明DSACKF SLAM算法有更好的估计性能。

• 单位
  重庆邮电大学