加载语义似然估计的粒子滤波重定位

针对移动机器人全局重定位时易出现定位错误的问题,本文提出一种基于构建的语义地图,并加载语义似然估计的粒子滤波重定位的解决方法.利用激光雷达建立环境栅格地图,同时结合三维深度相机对物体的识别与定位信息,赋予栅格语义信息,得到环境语义地图.在重定位过程中,通过粒子滤波方法同时进行栅格地图结构匹配与环境语义信息的匹配,以推算机器人在地图上的实际位置.通过实验证明所提出方法克服了现有粒子滤波方法仅利用环境结构信息进行匹配的不足,有效解决机器人全局重定位容易出错的问题,增强了重定位的鲁棒性,同时增强了重定位的收敛速度.