基于粒子滤波和点线相合的未知环境地图构建方法

摘要

针对粒子滤波处理未知环境地图构建时存在存储空间负荷高、计算量大的问题,本文使用线段特征描述环境信息,将点线相合的增量式地图构建方法引入粒子滤波中.在每个粒子中保存对已构建线段特征地图的假设;使用点线相合的位姿估计算法将观测信息引入重要性函数,确定采样空间;通过观测信息与已构建线段特征地图之间的相合关系更新粒子权重;最后通过选择性重采样去除因匹配不当和误差积累产生的错误地图.分析表明,该算法的复杂度较低.在真实传感器数据上的实验结果验证了该算法构建室内环境地图的有效性和鲁棒性.算法所需存储空间和粒子数远小于现有粒子滤波地图构建方法.