刘佳蕙1, 2,
黄刚2,
陶倩文2
1.武汉理工大学信息工程学院 武汉 430070
2.武汉理工大学智能交通系统研究中心 武汉 430063
基金项目:国家重点研发计划(2018YFB1600801)，国家自然科学基金(U1764262)，武汉市科技局项目(2020010601012165, 2020010602011973, 2020010602012003)
详细信息
作者简介:胡钊政：男，1979年生，教授，研究方向为3D计算机视觉理论与应用、智能车路系统、视觉与激光SLAM定位等
刘佳蕙：女，1997年生，硕士生，研究方向为激光SLAM定位、机器人定位、多传感器融合等
黄刚：男，1989年生，博士，研究方向为计算机视觉，室内/室外定位等
陶倩文：女，1994年生，博士生，研究方向为3维计算机视觉，室内定位与车辆定位等
通讯作者:胡钊政 zzhu@whut.edu.cn
中图分类号:TN957.52; TP242计量
文章访问数:803
HTML全文浏览量:297
PDF下载量:141
被引次数:0
出版历程
收稿日期:2020-08-04
修回日期:2021-01-22
网络出版日期:2021-01-29
刊出日期:2021-08-10
Integration of WiFi, Laser, and Map for Robot Indoor Localization
Zhaozheng HU1, 2,,,Jiahui LIU1, 2,
Gang HUANG2,
Qianwen TAO2
1. School of Information Engineering, Wuhan University of Technology, Wuhan 430070, China
2. Intelligent Transportation Systems Research Center, Wuhan University of Technology, Wuhan 430063, China
Funds:The National Key R&D Program of China(2018YFB1600801), The National Natural Science Foundation of China(U1764262), The Funds of Wuhan Science and Technology Bureau(2020010601012165, 2020010602011973, 2020010602012003)
摘要
摘要:由于室内环境受多径效应影响，单一WiFi定位效果不佳；激光雷达(LiDAR)虽然测距定位精度高，但在室内存在大量单一、重复的场景结构(如走廊)时，往往会由于无法提取有效特征进行匹配而造成大量错误定位。因此，该文提出基于卡尔曼滤波框架的WiFi、激光雷达与地图的融合定位新方法。其中，滤波器的状态定义为机器人当前与历史时刻的位置序列。滤波器的观测值由两部分组成，一部分为该文所提基于多环路分割地图下信号强度加权匹配的WiFi指纹定位结果；另一部分来自激光雷达在单一重复场景中计算出来的高精度相对定位结果(如横向定位)。利用场景地图中的先验参考位置，可将该横向定位结果转变为机器人位置的线性约束。最后，利用卡尔曼滤波器实现机器人高精度的融合定位结果。实验中，针对两种典型的单一、重复的室内场景，分别采用2维与3维激光雷达对该文算法进行验证。实验结果表明，由于激光横向定位精度可达厘米级，结合厘米级地图可以极大提高机器人定位精度。与单一WiFi定位算法相比，利用激光雷达计算出来的相对定位结果结合场景地图，平均定位误差可降低70%～80%，在满足机器人实时定位需求情况下，实现定位精度与稳定性的显著提升。
关键词:地图定位/
移动机器人/
卡尔曼滤波/
激光雷达/
WiFi指纹
Abstract:WiFi-based localization methods suffer from multipath problem in indoor environments, which leads to poor accuracy. Light Detection And Ranging(LiDAR)-based localization methods can have good accuracy. However, they are not feasible in simple and repetitive scenarios as it is difficult for scene feature extraction and matching. Therefore, a novel localization method to fuse WiFi, LiDAR and Map by integrating them into a Kalman filter framework is proposed. In this framework, the state of the filter is defined as the current and historical position sequence of the robot. The observation consists of two parts. The first is the WiFi fingerprint localization results based on the proposed distance-weighted WiFi fingerprint matching method on multi-loop segmentation map; The second part comes from the high-precision relative localization results (such as lateral localization) by LiDAR in a single repeated scene. By utilizing the priori reference position in the scene map, such lateral positioning result can be integrated with the map to formulate linear constraints on the robot position. Finally, the Kalman filter is applied to accurate localization of the robot. The proposed algorithm is verified in two scenarios, where 2D and 3D LiDAR are applied. Experimental results show the average localization error of the proposed algorithm can be reduced by 70%～80%, which demonstrate that proposed method can improve the localization accuracy and stability.
Key words:Map-based localization/
Robot/
Kalman filter/
Light Detection And Ranging(LiDAR)/
WiFi fingerprint
PDF全文下载地址:
https://jeit.ac.cn/article/exportPdf?id=6bb0db4c-97a3-4c94-a474-c8b49924faa6
