平方根容积卡尔曼滤波概率假设密度算法在移动机器人同时定位与地图构建中的应用

作者：闫德立; 宋永端; 宋宇; 康轶非

来源：控制理论与应用, 2014, 31(08): 1008-1016.

• 移动机器人
• 同时定位与地图构建
• 平方根容积卡尔曼滤波
• 概率假设密度

针对杂波环境或数据关联模糊环境下移动机器人同时定位与地图构建(SLAM)的问题,本文提出平方根容积卡尔曼滤波概率假设密度(SRCKF-PHD)SLAM算法,该算法的主要特点在于:1)采用容积规则方法计算非线性函数高斯权重积分以及机器人位姿粒子权重,达到改善位姿估计性能的目的;2)在高斯混合概率假设密度更新过程中,将平方根容积卡尔曼滤波应用于高斯项权重更新及观测似然计算中,保证了协方差矩阵的对称性和半正定性,提高了地图估计的精度和稳定性.通过仿真实验及CarPark数据集,将提出算法与RB-PHD-SLAM算法进行对比,结果表明该算法对机器人位姿估计精度及地图估计精度的提高是有效的.

• 单位
  石家庄铁道大学; 北京交通大学; 电子工程学院; 电子信息工程学院