CN106643720B - 一种基于uwb室内定位技术与激光雷达的地图构建方法 - Google Patents
一种基于uwb室内定位技术与激光雷达的地图构建方法 Download PDFInfo
- Publication number
- CN106643720B CN106643720B CN201610856938.2A CN201610856938A CN106643720B CN 106643720 B CN106643720 B CN 106643720B CN 201610856938 A CN201610856938 A CN 201610856938A CN 106643720 B CN106643720 B CN 106643720B
- Authority
- CN
- China
- Prior art keywords
- optimization
- laser radar
- pose
- frame
- base station
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Traffic Control Systems (AREA)
- Mobile Radio Communication Systems (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本申请涉及一种基于UWB室内定位技术与激光雷达的地图构建方法,采用UWB和激光雷达双传感器构建地图,可以保证,在室内受到金属遮挡,导致UWB定位不准时,激光雷达的数据能让误差减小。当激光雷达的数据由于运动物体的定位精度降低时,UWB定位又可以让此误差减小。该方法提升了地图构建的精度,降低了地图的扭曲感。
Description
技术领域
在本发明涉及一种地图构建方法,具体涉及一种结合了UWB与激光雷达的室内平面地图构建方法。
背景技术
基于激光雷达的室内地图构建在机器人领域应用越来越广发。常见的有3d激光雷达和2d激光雷达。3d激光雷达扫描整个环境的3d模型,2d激光雷达至于机器人底部,扫面平面底图。上述两种方法都是依据关键帧拼接技术实现底图构建。这种底图构建方法由于对传感器的位置估计是通过相邻两针的拼接得到的位移变化,在室内大范围扫描时,两两相邻位移的积分会产生累积误差,使得最终的底图构建效果不佳。尤其是对于走廊情况,狭长的走廊随着扫描的推进和误差累积会会变弯,其他大面积情况会出现地图整体扭曲的情况。
发明内容
本发明将传统的基于2d激光雷达的室内地图构建方法与UWB室内定位基站相结合提升了地图构建的精度,降低了地图的扭曲感。具体内容如下:
一种基于UWB室内定位技术与激光雷达的地图构建方法,包括以下步骤:
1) 安装UWB基站
在室内环境安装基站,安装在天花板上以减小人体对其遮挡,对无遮挡的情况,安装至少三个基站即可,有遮挡的情况可增加基站数目,使得在任意位置都同时能直线与三个以上基站进行通信;
2)基站标定
对基站初始坐标进行标定;
3)扫描数据
使用麦克纳姆轮移动平台搭载激光雷达,遥控激光雷达进行扫描,得到扫描数据;同时平台搭载UWB定位标签,读取定位基站的距离信息;
4)帧间拼接
对于激光雷达扫描出的数据,将相邻的两帧采取ICP最近点迭代方法得到平台的位姿变化;
5)闭环检测
提取所有扫描帧特征点并将该特征点存入特征字典,对每个新的帧,在特征字典中查找匹配,若匹配成功则完成闭环检测;
6)图优化
对步骤4)得到的一系列帧间拼接的位姿进行图优化,其中以每一帧观测瞬间的位姿为节点,相邻两帧的位姿变化为边构建优化图,将优化图输入isam优化方法库计算,得到优化出的每一帧的中心点位姿,以及包含该中心点位姿的处理后的优化图;
7)加入定位锚点
在上述处理后的优化图中,结合每一帧激光雷达数据采集的瞬间,对于UWB基站的定位数据得到的坐标,将该坐标作为锚点,该锚点与该锚点对应的优化图上的节点之间连接一条边;
8)二次图优化
对所述处理后的优化图重新运行图优化方法得到优化出的每一帧的中心点位姿;
9)渲染
由步骤8)得到每一帧的中心点位姿后,使用opengl绘制出occupancy grid map,其中采样点标记为黑色,从采样点到上述中心点位置的连线绘制为白色。
此方法可以保证,在室内受到金属遮挡,导致UWB定位不准时,激光雷达的数据能让误差减小。当激光雷达的数据由于运动物体的定位精度降低时,UWB定位又可以让此误差减小。
具体实施方式
一种基于UWB室内定位技术与激光雷达的地图构建方法,包括以下步骤:
1) 安装UWB基站
在室内环境安装基站,安装在天花板上以减小人体对其遮挡,对无遮挡的情况,安装至少三个基站即可,有遮挡的情况可增加基站数目,使得在任意位置都同时能直线与三个以上基站进行通信;
2)基站标定
对基站初始坐标进行标定;
3)扫描数据
使用麦克纳姆轮移动平台搭载激光雷达,遥控激光雷达进行扫描,得到扫描数据;同时平台搭载UWB定位标签,读取定位基站的距离信息;
4)帧间拼接
对于激光雷达扫描出的数据,将相邻的两帧采取ICP最近点迭代方法得到平台的位姿变化;
5)闭环检测
提取所有扫描帧特征点并将该特征点存入特征字典,对每个新的帧,在特征字典中查找匹配,若匹配成功则完成闭环检测;
6) 图优化
对步骤4)得到的一系列帧间拼接的位姿进行图优化,其中以每一帧观测瞬间的位姿为节点,相邻两帧的位姿变化为边构建优化图,将优化图输入isam优化方法库计算,得到优化出的每一帧的中心点位姿,以及包含该中心点位姿的处理后的优化图;
7) 加入定位锚点
在上述处理后的优化图中,结合每一帧激光雷达数据采集的瞬间,对于UWB基站的定位数据得到的坐标,将该坐标作为锚点,该锚点与该锚点对应的优化图上的节点之间连接一条边;
8二次图优化
对所述处理后的优化图重新运行图优化方法得到优化出的每一帧的中心点位姿;
9) 渲染
由步骤8)得到每一帧的中心点位姿后,使用opengl绘制出occupancy grid map,其中采样点标记为黑色,从采样点到上述中心点位置的连线绘制为白色。
Claims (1)
1.一种基于UWB室内定位技术与激光雷达的地图构建方法,包括以下步骤:
1)安装UWB基站
在室内环境安装基站,安装在天花板上以减小人体对其遮挡,对无遮挡的情况,安装至少三个基站即可,有遮挡的情况可增加基站数目,使得在任意位置都同时能直线与三个以上基站进行通信;
2)基站标定
对基站初始坐标进行标定;
3)扫描数据
使用麦克纳姆轮移动平台搭载激光雷达,遥控激光雷达进行扫描,得到扫描数据;同时平台搭载UWB定位标签,读取定位基站的距离信息;
4)帧间拼接
对于激光雷达扫描出的数据,将相邻的两帧采取ICP最近点迭代方法得到平台的位姿变化;
5)闭环检测
提取所有扫描帧特征点并将该特征点存入特征字典,对每个新的帧,在特征字典中查找匹配,若匹配成功则完成闭环检测;
6)图优化
对步骤4)得到的一系列帧间拼接的位姿进行图优化,其中以每一帧观测瞬间的位姿为节点,相邻两帧的位姿变化为边构建优化图,将优化图输入isam优化方法库计算,得到优化出的每一帧的中心点位姿,以及包含该中心点位姿的处理后的优化图;
7)加入定位锚点
在上述处理后的优化图中,结合每一帧激光雷达数据采集的瞬间,对于UWB基站的定位数据得到的坐标,将该坐标作为锚点,该锚点与该锚点对应的优化图上的节点之间连接一条边;
8)二次图优化
对所述处理后的优化图重新运行图优化方法得到优化出的每一帧的中心点位姿;
9)渲染
由步骤8)得到每一帧的中心点位姿后,使用opengl绘制出occupancy grid map,其中采样点标记为黑色,从采样点到上述中心点位置的连线绘制为白色。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610856938.2A CN106643720B (zh) | 2016-09-28 | 2016-09-28 | 一种基于uwb室内定位技术与激光雷达的地图构建方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610856938.2A CN106643720B (zh) | 2016-09-28 | 2016-09-28 | 一种基于uwb室内定位技术与激光雷达的地图构建方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106643720A CN106643720A (zh) | 2017-05-10 |
CN106643720B true CN106643720B (zh) | 2019-02-26 |
Family
ID=58854575
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610856938.2A Active CN106643720B (zh) | 2016-09-28 | 2016-09-28 | 一种基于uwb室内定位技术与激光雷达的地图构建方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106643720B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110366098A (zh) * | 2019-07-05 | 2019-10-22 | 北京海益同展信息科技有限公司 | 一种目标定位方法和用于目标定位的服务器、基站 |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108490388B (zh) * | 2018-03-13 | 2021-06-29 | 同济大学 | 一种基于uwb与vlc技术的多源联合室内定位方法 |
CN108520543B (zh) * | 2018-04-09 | 2022-08-09 | 杭州易现先进科技有限公司 | 一种对相对精度地图进行优化的方法、设备及存储介质 |
CN108801269B (zh) * | 2018-08-29 | 2021-11-12 | 山东大学 | 一种室内云机器人导航***及方法 |
CN109141442B (zh) * | 2018-09-07 | 2022-05-17 | 高子庆 | 基于uwb定位与图像特征匹配的导航方法和移动终端 |
CN109118940A (zh) * | 2018-09-14 | 2019-01-01 | 杭州国辰机器人科技有限公司 | 一种基于地图拼接的移动机器人构图 |
CN109613548B (zh) * | 2018-12-28 | 2022-12-23 | 芜湖哈特机器人产业技术研究院有限公司 | 一种基于图优化的激光雷达路标地图构建方法 |
CN109813319B (zh) * | 2019-03-07 | 2021-09-28 | 山东大学 | 一种基于slam建图的开环优化方法及*** |
CN109917374A (zh) * | 2019-04-01 | 2019-06-21 | 深圳乐易住智能科技股份有限公司 | 一种采用分布式网络雷达的室内探测方法 |
CN110645974B (zh) * | 2019-09-26 | 2020-11-27 | 西南科技大学 | 一种融合多传感器的移动机器人室内地图构建方法 |
CN112540345B (zh) * | 2020-11-18 | 2023-08-01 | 广东工业大学 | 一种基于高斯分布检测uwb质量的双模型定位方法及*** |
CN112611384B (zh) * | 2020-12-03 | 2023-01-24 | 之江实验室 | 一种在nlos场景下uwb与激光融合的机器人定位方法及装置 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104748743A (zh) * | 2015-03-30 | 2015-07-01 | 北京云迹科技有限公司 | Uwb定位辅助地图修正方法及*** |
CN104754515A (zh) * | 2015-03-30 | 2015-07-01 | 北京云迹科技有限公司 | 混合定位辅助地图修正方法及*** |
CN105547305A (zh) * | 2015-12-04 | 2016-05-04 | 北京布科思科技有限公司 | 一种基于无线定位和激光地图匹配的位姿解算方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101581197B1 (ko) * | 2009-01-06 | 2015-12-30 | 삼성전자주식회사 | 로봇 및 그 제어방법 |
-
2016
- 2016-09-28 CN CN201610856938.2A patent/CN106643720B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104748743A (zh) * | 2015-03-30 | 2015-07-01 | 北京云迹科技有限公司 | Uwb定位辅助地图修正方法及*** |
CN104754515A (zh) * | 2015-03-30 | 2015-07-01 | 北京云迹科技有限公司 | 混合定位辅助地图修正方法及*** |
CN105547305A (zh) * | 2015-12-04 | 2016-05-04 | 北京布科思科技有限公司 | 一种基于无线定位和激光地图匹配的位姿解算方法 |
Non-Patent Citations (1)
Title |
---|
基于图优化的同时定位与地图创建综述;梁明杰 等;《机器人》;20130731;第35卷(第4期);第500-512页 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110366098A (zh) * | 2019-07-05 | 2019-10-22 | 北京海益同展信息科技有限公司 | 一种目标定位方法和用于目标定位的服务器、基站 |
CN110366098B (zh) * | 2019-07-05 | 2020-11-03 | 北京海益同展信息科技有限公司 | 一种目标定位方法和用于目标定位的服务器、基站 |
Also Published As
Publication number | Publication date |
---|---|
CN106643720A (zh) | 2017-05-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106643720B (zh) | 一种基于uwb室内定位技术与激光雷达的地图构建方法 | |
CN107991683B (zh) | 一种基于激光雷达的机器人自主定位方法 | |
CN106324616B (zh) | 一种基于惯性导航单元与激光雷达的地图构建方法 | |
CN108073170B (zh) | 用于自主车辆的自动化协同驾驶控制 | |
CN105258702B (zh) | 一种基于slam导航移动机器人的全局定位方法 | |
KR102194426B1 (ko) | 실내 이동 로봇이 엘리베이터에서 환경을 인식하기 위한 장치 및 방법, 이를 구현하기 위한 프로그램이 저장된 기록매체 및 이를 구현하기 위해 매체에 저장된 컴퓨터프로그램 | |
CN105115497B (zh) | 一种可靠的室内移动机器人精确导航定位***及方法 | |
CN106405605B (zh) | 一种机器人基于ros和gps的室内外无缝定位方法和定位*** | |
CN103064416B (zh) | 巡检机器人室内外自主导航*** | |
CN106940562B (zh) | 一种移动机器人无线集群***及神经网络视觉导航方法 | |
CN107091642B (zh) | 一种基于异平面锚节点映射及栅格化纠偏的室内定位方法 | |
CN106227218A (zh) | 一种智能移动设备的导航避障方法及装置 | |
US8594860B2 (en) | Apparatus and method with mobile relocation | |
CN104754515A (zh) | 混合定位辅助地图修正方法及*** | |
CN104748743A (zh) | Uwb定位辅助地图修正方法及*** | |
Xue et al. | Automatic calibration of dual-LiDARs using two poles stickered with retro-reflective tape | |
CN109760064A (zh) | 一种移动机器人自身位置的调整方法和装置 | |
CN106154287A (zh) | 一种基于双轮里程计与激光雷达的地图构建方法 | |
JP2005274363A (ja) | 無線位置検出システム | |
Xiong et al. | A hybrid lidar-based indoor navigation system enhanced by ceiling visual codes for mobile robots | |
CN114721001A (zh) | 一种基于多传感器融合的移动机器人定位方法 | |
Lee et al. | Object detection using vision and LiDAR sensor fusion for multi-channel V2X system | |
CN106971144B (zh) | 一种应用Visual Graph算法提取道路中线的方法 | |
CN105554706A (zh) | 基于多网络融合的室内定位方案 | |
KR20240013706A (ko) | 자기 위치 측정이 가능한 로봇 및 위치 측정 방법 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |