平方根容积卡尔曼滤波概率假设密度算法在移动机器人同时定位与地图构建中的应用
闫德立1
宋永端2
宋宇2
康轶非2
1.北京交通大学电子信息工程学院,北京100044;石家庄铁道大学电气与电子工程学院,河北石家庄0500432.北京交通大学电子信息工程学院,北京,100044
摘要：针对杂波环境或数据关联模糊环境下移动机器人同时定位与地图构建(SLAM)的问题,本文提出平方根容积卡尔曼滤波概率假设密度(SRCKF-PHD)SLAM算法,该算法的主要特点在于:1)采用容积规则方法计算非线性函数高斯权重积分以及机器人位姿粒子权重,达到改善位姿估计性能的目的;2)在高斯混合概率假设密度更新过程中,将平方根容积卡尔曼滤波应用于高斯项权重更新及观测似然计算中,保证了协方差矩阵的对称性和半正定性,提高了地图估计的精度和稳定性.通过仿真实验及Car Park数据集,将提出算法与RB-PHD-SLAM算法进行对比,结果表明该算法对机器人位姿估计精度及地图估计精度的提高是有效的.
关键词：移动机器人同时定位与地图构建平方根容积卡尔曼滤波概率假设密度
分类号：TP242(自动化技术及设备)
资助基金：国家自然科学基金(61134001,60905055,51274144)国家重点基础研究发展计划（973计划）(973;2012CB215202)国家高技术研究发展计划（863计划）(863;SS2012AA052302)河北省自然科学基金(F2012210031)中国博士后科学基金(2013T60197)中央高校基本科研业务费专项(2014JBM014)
论文发表日期：2014-01-01
在线出版日期：2025-08-15（本平台首次上网日期，不代表文献的发表时间）
页数：9( 1009-1017 )
英文信息