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

作     者：李中道 刘元盛 常飞翔 张军 路铭 LI Zhongdao;LIU Yuansheng;CHANG Feixiang;ZHANG Jun;LU Ming

作者机构：北京联合大学智慧城市学院北京100101 北京联合大学机器人学院北京100101 北京联合大学北京市信息服务工程重点实验室北京100101 北京联合大学应用科技学院北京100101 

出 版 物：《计算机工程与应用》 (Computer Engineering and Applications)

年 卷 期：2021年第57卷第6期

页      面：260-266页

学科分类：081104[工学-模式识别与智能系统] 08[工学] 0811[工学-控制科学与工程] 

基　　金：北京联合大学人才强校优选拔尖计划(BPHR2020BZ01) 国家自然科学基金(61871038,61871039) 北京联合大学科研项目(ZK130202002) 北京联合大学研究生资助项目 

主　　题：室内定位 超宽带 激光雷达 数据融合 粒子滤波 

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