室内环境下UWB与LiDAR融合定位算法研究

摘要

当前全球导航卫星系统与激光雷达的数据融合被广泛应用于无人驾驶车辆的定位系统中,但在室内环境下由于卫星信号的丢失导致定位精度低甚至无法定位.为此提出一种基于超宽带(Ultra-Wideband,UWB)与激光雷达(Light Detection and Ranging,LiDAR)的融合定位算法.该算法以粒子滤波为基础,对两个传感器的定位数据进行互补融合解算.利用UWB实时定位数据通过提供起始粒子范围的方式来提高LiDAR的定位速率.通过求解LiDAR定位信息与粒子之间的几何距离来更新粒子的权重,从而弥补UWB的非视距误差.搭建一个室内测试场景,并将融合定位算法在智能小车平台上进行验证.实验结果表明,该方法优于UWB或LiDAR单一传感器的定位方案,而且在UWB视距受阻或LiDAR匹配失效的情况下,车辆仍能够获得良好的定位精度和定位实时性.