摘要

针对超宽带(UWB)测距存在非视距(NLOS)误差以及LiDAR存在累计误差影响定位精确度的问题,本文提出了一种基于改进天牛须搜索算法(IBAS)优化粒子滤波的UWB/LiDAR室内定位方法。该方法综合UWB抗干扰能力强、时间分辨率高和LiDAR高精度、高效率的优点,使用LiDAR量测信息解算组合定位系统与UWB基站的距离,剔除UWB量测值中的NLOS误差。改进天牛须搜索算法的引入消除了粒子滤波的粒子退化现象,减少了算法所需粒子数,提升了算法运行速度和实时性。最后构建UWB/LiDAR的组合函数,使用图优化方法优化全局位姿。实验结果表明,同等效果下经改进天牛须搜索算法优化后所需的粒子数仅为原粒子滤波算法的20%,同时相较于单一的UWB、LiDAR定位,本文方法的定位精度分别提升了44.75%和74.47%,效果良好。