CN106643720A - 一种基于uwb室内定位技术与激光雷达的地图构建方法 - Google Patents
一种基于uwb室内定位技术与激光雷达的地图构建方法 Download PDFInfo
- Publication number
- CN106643720A CN106643720A CN201610856938.2A CN201610856938A CN106643720A CN 106643720 A CN106643720 A CN 106643720A CN 201610856938 A CN201610856938 A CN 201610856938A CN 106643720 A CN106643720 A CN 106643720A
- Authority
- CN
- China
- Prior art keywords
- optimization
- laser radar
- pose
- frame
- uwb
- 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.)
- Granted
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)
- Electromagnetism (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Mobile Radio Communication Systems (AREA)
- Traffic Control 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 true CN106643720A (zh) | 2017-05-10 |
CN106643720B 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 (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108490388A (zh) * | 2018-03-13 | 2018-09-04 | 同济大学 | 一种基于uwb与vlc技术的多源联合室内定位方法 |
CN108520543A (zh) * | 2018-04-09 | 2018-09-11 | 网易(杭州)网络有限公司 | 一种对相对精度地图进行优化的方法、设备及存储介质 |
CN108801269A (zh) * | 2018-08-29 | 2018-11-13 | 山东大学 | 一种室内云机器人导航系统及方法 |
CN109118940A (zh) * | 2018-09-14 | 2019-01-01 | 杭州国辰机器人科技有限公司 | 一种基于地图拼接的移动机器人构图 |
CN109141442A (zh) * | 2018-09-07 | 2019-01-04 | 高子庆 | 基于uwb定位与图像特征匹配的导航方法和移动终端 |
CN109613548A (zh) * | 2018-12-28 | 2019-04-12 | 芜湖哈特机器人产业技术研究院有限公司 | 一种基于图优化的激光雷达路标地图构建方法 |
CN109813319A (zh) * | 2019-03-07 | 2019-05-28 | 山东大学 | 一种基于slam建图的开环优化方法及系统 |
CN109917374A (zh) * | 2019-04-01 | 2019-06-21 | 深圳乐易住智能科技股份有限公司 | 一种采用分布式网络雷达的室内探测方法 |
CN110366098A (zh) * | 2019-07-05 | 2019-10-22 | 北京海益同展信息科技有限公司 | 一种目标定位方法和用于目标定位的服务器、基站 |
CN110645974A (zh) * | 2019-09-26 | 2020-01-03 | 西南科技大学 | 一种融合多传感器的移动机器人室内地图构建方法 |
CN112540345A (zh) * | 2020-11-18 | 2021-03-23 | 广东工业大学 | 一种基于高斯分布检测uwb质量的双模型定位方法及系统 |
CN112611384A (zh) * | 2020-12-03 | 2021-04-06 | 之江实验室 | 一种在nlos场景下uwb与激光融合的机器人定位方法及装置 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100172571A1 (en) * | 2009-01-06 | 2010-07-08 | Samsung Electronics Co., Ltd. | Robot and control method thereof |
CN104754515A (zh) * | 2015-03-30 | 2015-07-01 | 北京云迹科技有限公司 | 混合定位辅助地图修正方法及系统 |
CN104748743A (zh) * | 2015-03-30 | 2015-07-01 | 北京云迹科技有限公司 | Uwb定位辅助地图修正方法及系统 |
CN105547305A (zh) * | 2015-12-04 | 2016-05-04 | 北京布科思科技有限公司 | 一种基于无线定位和激光地图匹配的位姿解算方法 |
-
2016
- 2016-09-28 CN CN201610856938.2A patent/CN106643720B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100172571A1 (en) * | 2009-01-06 | 2010-07-08 | Samsung Electronics Co., Ltd. | Robot and control method thereof |
CN104754515A (zh) * | 2015-03-30 | 2015-07-01 | 北京云迹科技有限公司 | 混合定位辅助地图修正方法及系统 |
CN104748743A (zh) * | 2015-03-30 | 2015-07-01 | 北京云迹科技有限公司 | Uwb定位辅助地图修正方法及系统 |
CN105547305A (zh) * | 2015-12-04 | 2016-05-04 | 北京布科思科技有限公司 | 一种基于无线定位和激光地图匹配的位姿解算方法 |
Non-Patent Citations (1)
Title |
---|
梁明杰 等: "基于图优化的同时定位与地图创建综述", 《机器人》 * |
Cited By (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108490388B (zh) * | 2018-03-13 | 2021-06-29 | 同济大学 | 一种基于uwb与vlc技术的多源联合室内定位方法 |
CN108490388A (zh) * | 2018-03-13 | 2018-09-04 | 同济大学 | 一种基于uwb与vlc技术的多源联合室内定位方法 |
CN108520543A (zh) * | 2018-04-09 | 2018-09-11 | 网易(杭州)网络有限公司 | 一种对相对精度地图进行优化的方法、设备及存储介质 |
CN108520543B (zh) * | 2018-04-09 | 2022-08-09 | 杭州易现先进科技有限公司 | 一种对相对精度地图进行优化的方法、设备及存储介质 |
CN108801269A (zh) * | 2018-08-29 | 2018-11-13 | 山东大学 | 一种室内云机器人导航系统及方法 |
CN109141442A (zh) * | 2018-09-07 | 2019-01-04 | 高子庆 | 基于uwb定位与图像特征匹配的导航方法和移动终端 |
CN109118940A (zh) * | 2018-09-14 | 2019-01-01 | 杭州国辰机器人科技有限公司 | 一种基于地图拼接的移动机器人构图 |
CN109613548A (zh) * | 2018-12-28 | 2019-04-12 | 芜湖哈特机器人产业技术研究院有限公司 | 一种基于图优化的激光雷达路标地图构建方法 |
CN109813319A (zh) * | 2019-03-07 | 2019-05-28 | 山东大学 | 一种基于slam建图的开环优化方法及系统 |
CN109813319B (zh) * | 2019-03-07 | 2021-09-28 | 山东大学 | 一种基于slam建图的开环优化方法及系统 |
CN109917374A (zh) * | 2019-04-01 | 2019-06-21 | 深圳乐易住智能科技股份有限公司 | 一种采用分布式网络雷达的室内探测方法 |
CN110366098A (zh) * | 2019-07-05 | 2019-10-22 | 北京海益同展信息科技有限公司 | 一种目标定位方法和用于目标定位的服务器、基站 |
CN110366098B (zh) * | 2019-07-05 | 2020-11-03 | 北京海益同展信息科技有限公司 | 一种目标定位方法和用于目标定位的服务器、基站 |
CN110645974B (zh) * | 2019-09-26 | 2020-11-27 | 西南科技大学 | 一种融合多传感器的移动机器人室内地图构建方法 |
CN110645974A (zh) * | 2019-09-26 | 2020-01-03 | 西南科技大学 | 一种融合多传感器的移动机器人室内地图构建方法 |
CN112540345A (zh) * | 2020-11-18 | 2021-03-23 | 广东工业大学 | 一种基于高斯分布检测uwb质量的双模型定位方法及系统 |
CN112540345B (zh) * | 2020-11-18 | 2023-08-01 | 广东工业大学 | 一种基于高斯分布检测uwb质量的双模型定位方法及系统 |
CN112611384A (zh) * | 2020-12-03 | 2021-04-06 | 之江实验室 | 一种在nlos场景下uwb与激光融合的机器人定位方法及装置 |
CN112611384B (zh) * | 2020-12-03 | 2023-01-24 | 之江实验室 | 一种在nlos场景下uwb与激光融合的机器人定位方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN106643720B (zh) | 2019-02-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106643720A (zh) | 一种基于uwb室内定位技术与激光雷达的地图构建方法 | |
CN109548141B (zh) | 基于卡尔曼滤波算法的室内环境基站坐标位置标定方法 | |
CN107991683B (zh) | 一种基于激光雷达的机器人自主定位方法 | |
CN105547305B (zh) | 一种基于无线定位和激光地图匹配的位姿解算方法 | |
CN105258702B (zh) | 一种基于slam导航移动机器人的全局定位方法 | |
CN106154287A (zh) | 一种基于双轮里程计与激光雷达的地图构建方法 | |
CN113269837B (zh) | 一种适用于复杂三维环境的定位导航方法 | |
CN106324616A (zh) | 一种基于惯性导航单元与激光雷达的地图构建方法 | |
CN107091642B (zh) | 一种基于异平面锚节点映射及栅格化纠偏的室内定位方法 | |
CN106940562B (zh) | 一种移动机器人无线集群系统及神经网络视觉导航方法 | |
KR102110813B1 (ko) | 무선 환경 변화에 강인한 slam 방법 및 장치 | |
CN106382917B (zh) | 一种室内环境下三维空间信息连续精确采集方法 | |
CN106291517A (zh) | 基于位置与视觉信息优化的室内云机器人角度定位方法 | |
CN108872934B (zh) | 一种基于非视距误差抑制的室内三维定位方法 | |
CN106991842B (zh) | 一种地下停车场泊车机器人停车提车定位方法 | |
CN110082783B (zh) | 一种悬崖检测的方法及装置 | |
CN105205114A (zh) | 一种基于图像处理的Wi-Fi定位指纹数据库构建方法 | |
CN110730418A (zh) | 一种基于最小二乘法的室内三维定位改进算法 | |
WO2022166323A1 (zh) | 一种道路线确定的方法,相关装置以及设备 | |
CN111207753A (zh) | 一种多玻璃隔断环境下的同时定位与建图的方法 | |
JP2012220227A (ja) | 移動体の障害認識方法及び障害認識システム | |
CN113605766B (zh) | 一种汽车搬运机器人的探测系统及位置调整方法 | |
KR102170745B1 (ko) | 실내 공간정보 데이터 융합을 통한 위치추정 방법 | |
CN111638487B (zh) | 一种自动泊车测试设备及方法 | |
CN112486172A (zh) | 道路边缘检测方法及机器人 |
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 |