CN110728751A - 一种室内3d点云语义地图的构建方法 - Google Patents
一种室内3d点云语义地图的构建方法 Download PDFInfo
- Publication number
- CN110728751A CN110728751A CN201910529158.0A CN201910529158A CN110728751A CN 110728751 A CN110728751 A CN 110728751A CN 201910529158 A CN201910529158 A CN 201910529158A CN 110728751 A CN110728751 A CN 110728751A
- Authority
- CN
- China
- Prior art keywords
- point cloud
- point
- semantic
- map
- image
- 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.)
- Pending
Links
- 238000010276 construction Methods 0.000 title abstract description 10
- 238000000034 method Methods 0.000 claims abstract description 19
- 238000013527 convolutional neural network Methods 0.000 claims abstract description 12
- 238000001514 detection method Methods 0.000 claims abstract description 9
- 230000011218 segmentation Effects 0.000 claims abstract description 9
- 238000005457 optimization Methods 0.000 claims abstract description 6
- 238000012545 processing Methods 0.000 claims abstract description 4
- 230000004927 fusion Effects 0.000 claims description 11
- 239000011159 matrix material Substances 0.000 claims description 5
- 230000009466 transformation Effects 0.000 claims description 5
- 238000004364 calculation method Methods 0.000 claims description 3
- 238000009616 inductively coupled plasma Methods 0.000 claims description 3
- 238000013135 deep learning Methods 0.000 description 6
- 230000003993 interaction Effects 0.000 description 3
- 230000000007 visual effect Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000008447 perception Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 238000009826 distribution Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T17/00—Three dimensional [3D] modelling, e.g. data description of 3D objects
- G06T17/05—Geographic models
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06N—COMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
- G06N3/00—Computing arrangements based on biological models
- G06N3/02—Neural networks
- G06N3/04—Architecture, e.g. interconnection topology
- G06N3/045—Combinations of networks
Abstract
本发明涉及地图构建技术领域,涉及一种室内3D点云语义地图的构建方法。该方法包括:步骤1:利用RGB‑D相机获取室内环境的RGB‑D图像;步骤2:构建一个可用于目标检测与实例分割的深度卷积神经网络Mask R‑CNN;步骤3:将采集到的RGB‑D图像输入网络中,然后对输出图像做点云处理;步骤4:将经Mask R‑CNN网络和点云处理后的图像与构建的室内环境的点云地图融合得到语义点云地图;步骤5:对点云语义地图进行全局优化。
Description
技术领域
本发明涉及深度学习领域、地图构建技术领域,具体涉到一种室内3D点云语义地图的构建方法。
背景技术
机器人的语义感知能力,是现今移动机器人(例如服务机器人,救援机器人等)研究的核心重点之一。传统的点云地图在移动机器人运动(包括但不限于:无人驾驶、人机交互、机器人导航等)和路径规划方面具有举足轻重的地位。但由于传统的点云地图缺少物体的语义信息,机器人在理解环境的能力上有所欠缺,所以在近几年有学者提出3D点云语义地图的构建。点云语义地图是指包含环境语义信息的点云地图,如环境中出现的桌子、显示屏、瓶子、键盘等在点云地图中都带有语义标签。基于视觉传感器构建含有语义信息的点云地图,可以让机器人充分理解室内环境中的语义信息,以便机器人能更精确的实现自主定位和制图是视觉SLAM的重点研究方向。
近几年,深度学习的快速发展使得其在计算机视觉领域的应用越来越广泛,利用深度卷积神经网络进行物体检测、语义分割、目标识别和自主决策等,它可以较高的精度和较快的速度获得较好的检测或分割结果。目前有学者已经提出一些语义地图构建的方法,例如通过在物体上贴二维码来获取物体的语义信息等。本发明提出一种新的室内3D点云语义地图构建的方法,将深度学习与点云地图相结合构建点云语义地图,通过深度卷积神经网络来进行目标检测与语义分割,得到物体的语义信息,再与所构建的室内三维点云地图进行融合得到点云语义地图。
发明内容
本发明的目的在于提出了一种室内3D点云语义地图的构建方法。将深度学习与点云地图相结合构建点云语义地图,通过深度卷积神经网络来进行目标检测与语义分割,再与所构建的室内三维点云地图进行融合得到点云语义地图。
基于上述目的本发明提出了一种室内3D点云语义地图的构建方法。该方法包括:
步骤1:利用RGB-D相机获取室内环境得到连续的RGB-D图像;
步骤2:构建一个可用于目标检测与实例分割的深度卷积神经网络Mask R-CNN;
步骤3:将采集到的RGB-D图像输入网络中,输出图像中的目标是含有语义信息且是像素级的,然后对输出图像做点云处理;
步骤4:将经深度卷积神经网络和点云处理后的图像与构建的室内环境的点云地图融合得到语义点云地图;
步骤5:对3D点云语义地图进行全局优化,主要利用g2o(General GraphOptimization)算法优化点云语义地图。
进一步的,所述步骤4中:主要使用改进后的迭代最近点(ICP)算法进行点云融合,从而得到语义点云地图,包括:
寻找待拼接点云的特征点,确立两个待测点云的关系;
将PK作为一个特征点,判断周围n个点的坐标与PK点坐标的汉明距离,若汉明距离小于等于1,则认为配准到参考点,否则停止计算,重新选取特征点周围的一点,再进行配准;
判断两点间的欧式距离,若欧式距离大于等于阈值则将该点存入一个新点集,否则重新选取特征点,再进行配准;
计算变换矩阵,如果误差收敛则认为配准到了参考点云,否则重新计算最近点。
进一步的,所述步骤4中:将经深度卷积神经网络和点云处理后的图像与构建的室内环境的点云地图融合得到语义点云地图,包括:
每帧RGB-D图像经过Mask R-CNN网络后都得到含有语义标签的图像,且图像中目标是像素级的,对于背景信息,通过ORB(Oriented FAST and Rotated BRIEF)算法提取每帧图像的关键点,然后针对关键点使用改进后的ICP算法将含有语义标签的图像与SLAM构建的点云地图进行点云融合;对于目标,使用ICP算法进行像素级的融合,从而得到一个完整室内环境的语义点云地图。
本发明提出的一种室内3D点云语义地图的构建方法是将采集到的RGB-D图像经过深度卷积神经网络Mask R-CNN,得到含有语义标签的图像,且目标是像素级的,再与构建的点云地图进行融合,进而得到室内环境的3D点云语义地图。该地图具有可读性,便于移动机器人精确定位、自主决策进行避障。
综上所述,本发明所提出方法的有益效果是:通过视觉传感器采集室内的RGB-D图像并结合深度卷积神经网络来构建3D点云语义地图。其中,改进后的ICP算法大大减少了计算量,缩短了迭代时间,提高了拼接速度;针对背景和目标分别使用对特征点和像素级的融合,缩短了构建点云语义地图的时间。环境中的语义信息会使移动机器人在自主探索环境时进行移动,自主避障等,同时还能理解周围环境,实现人机交互和语义感知。
附图说明
图1是本发明实施例示出的一种室内3D点云语义地图的构建方法的原理框图。
图2是本发明实施例示出的改进后的ICP算法流程图。
具体实施方式
为了使本发明的目的、技术方案和优点更加明确,以下结合具体实施例,并参照附图,对本发明进一步进行详细说明,此处描述仅解释本发明,并不用于限定本发明。
本发明的目的是提供一种室内3D点云语义地图的构建方法。本发明将深度学习与点云地图相结合构建点云语义地图,通过深度卷积神经网络(MaskR-CNN)来进行目标检测与语义分割,再与所构建的室内三维点云地图进行点云融合得到点云语义地图,其原理框图如附图1所示。具体步骤如下:
步骤1:利用RGB-D相机获取室内环境得到连续的RGB-D图像;
步骤2:构建一个可用于目标检测与实例分割的深度卷积神经网络Mask R-CNN,包括残差网络(ResNet101)、特征金字塔网络(FPN)、区域建议网络(RPN)、全卷积网络(FCN)等;
步骤3:将采集到的RGB-D图像输入网络中,输出图像中的目标是含有语义信息且是像素级的,然后对输出图像做点云处理;
步骤4:将经Mask R-CNN网络和点云处理后的图像与构建的室内环境的点云地图融合得到语义点云地图;
步骤5:对3D点云语义地图进行全局优化,主要利用g2o算法优化点云语义地图。
所述步骤4中,使用改进后的ICP算法进行点云融合,与传统的ICP算法相比较,先通过汉明距离确定配准到的可能的参考点云,再经过计算两点欧式距离,提高了算法的匹配速度,在迭代耗时上有明显优势。
传统的ICP算法通常包括以下5个步骤:
(1)假设获取的目标点云为P={Pi|Pi∈R3,i=1,2,...N},点云数为NP,参考点云记为Q={Qi|Qi∈R3,i=1,2,...M},点云数为NQ,且NP≤NQ;
(2)根据搜索到的对应点对集合求出初始旋转矩阵R1和平移向量t1:
P1=R1Q0+t1 (1)
其中,P1和Q0分布表示目标点集P和参考点云Q中的点,通常用四元数法和奇异值分解发来求解t和R。
(3)利用(2)求出的t和R对Q1进行坐标转换,得到新的变换点集Q2:
Q2=R1Q1+t1 (2)
(4)重复步骤(2)和(3),进行迭代计算,其中m表示对应点对的个数:
Pm=Rm Qm-1+tm (3)
Qm+1=Rm Qm+tm (4)
(5)构建最小二乘问题,并求出使函数达到极小值时的R和T:
i表示点云中任意一点,当上式达到极小值时停止迭代,得到均方误差dm+1:
假设给定迭代收敛阈值为τ,且τ>0,相邻两次迭代间的均方误差dm-dm-1<τ时停止迭代。若不满足式(5),则重复步骤(4)重新迭代计算新的点集,直到使得最小二乘函数达到极小值为止。
改进后的ICP算法的流程图如附图2所示,具体包括:
(1)寻找待拼接点云的特征点,确立两个待测点云的关系;
(2)将PK作为一个特征点,判断周围n个点的坐标与PK点坐标的汉明距离,若汉明距离小于等于1,则认为配准到参考点,否则停止计算,重新选取特征点周围的一点,再进行配准;
(3)判断两点间的欧式距离,若欧式距离大于等于阈值则将该点存入一个新点集,否则重新选取特征点,再进行配准;
(4)计算变换矩阵,如果误差收敛则认为配准到了参考点云,否则重新计算最近点。
假设点PK的坐标为(1,1,0),周围某一点P’的坐标为(1,0,0),则两点坐标的汉明距离(三个坐标轴上不同位的个数)为1,当两点的汉明距离小于等于1时(即在空间中某一平面进行变换),认为配准到参考点,否则重新选择点P’,再计算两点的汉明距离。此时,当PK与P’两点的欧式距离(此时两点位于同一平面,即计算某一平面两点的欧式距离, )大于等于阈值时,将该点存入一个新点集,否则重新选取特征点,再进行配准。最后,计算变换矩阵,如果误差收敛则认为配准到了参考点云,否则重新计算最近点。
改进后的ICP算法通过先计算汉明距离来快速找到可能的参考点云,再经过计算两点欧式距离来判断是否配准到参考点,大大简化了计算量。
所述步骤4中,将经Mask R-CNN网络和点云处理后的图像与构建的室内环境的点云地图融合得到语义点云地图,具体包括:
每帧RGB-D图像经过Mask R-CNN网络后都得到含有语义标签的图像,且图像中目标是像素级的,对于背景信息,通过ORB算法提取每帧图像的关键点,然后针对关键点使用改进后的ICP算法将含有语义标签的图像与SLAM构建的点云地图进行点云融合;对于目标,使用ICP算法进行像素级的融合,从而得到一个完整室内环境的语义点云地图。
通过以上对本发明所提供的一种室内3D点云语义地图的构建方法的描述,可以明确本发明所提供的方法具有可实践性,并且可以提高构建语义地图的速度。使得移动机器人在自主探索环境时感知语义信息,并在理解周围环境的基础上进行移动,避障等,达到人机交互和语义感知的目的。
本发明的上述实例仅仅是为了清晰明确地说明本发明所作的举例,而非是对本发明的限定。本发明的实施例旨在涵盖落入所附权利要求的宽泛范围之内的所有这样的替换、修改或变型。因此,凡在本发明的精神和原则之内,所做的任何等同替换等均应包含在本发明权利要求的保护范围之内。
Claims (3)
1.一种室内3D点云语义地图的构建方法,其特征在于,该方法包括:
步骤1:利用RGB-D相机获取室内环境得到连续的RGB-D图像;
步骤2:构建一个可用于目标检测与实例分割的深度卷积神经网络Mask R-CNN;
步骤3:将采集到的RGB-D图像输入网络中,输出图像中的目标是含有语义信息且是像素级的,然后对输出图像做点云处理;
步骤4:将经Mask R-CNN网络和点云处理后的图像与构建的室内环境的点云地图融合得到语义点云地图;
步骤5:对3D点云语义地图进行全局优化,主要利用g2o(General GraphOptimization)算法优化点云语义地图。
2.根据权力要求1所述的方法,其特征在于,所述步骤4中:主要使用改进后的迭代最近点(ICP)算法进行点云融合,从而得到语义点云地图,包括:
(1)寻找待拼接点云的特征点,确立两个待测点云的关系;
(2)将PK作为一个特征点,判断周围n个点的坐标与PK点坐标的汉明距离,若汉明距离小于等于1,则认为配准到参考点,否则停止计算,重新选取特征点周围的一点,再进行配准;
(3)判断两点间的欧式距离,若欧式距离大于等于阈值则将该点存入一个新点集,否则重新选取特征点,再进行配准;
(4)计算变换矩阵,如果误差收敛则认为配准到了参考点云,否则重新计算最近点。
3.根据权力要求1所述的方法,其特征在于,所述步骤4中:将经Mask R-CNN网络和点云处理后的图像与构建的室内环境的点云地图融合得到语义点云地图,包括:
每帧RGB-D图像经过Mask R-CNN网络后都得到含有语义标签的图像,且图像中目标是像素级的,对于背景信息,通过ORB(Oriented FAST and Rotated BRIEF)算法提取每帧图像的关键点,然后针对关键点使用改进后的ICP算法将含有语义标签的图像与SLAM构建的点云地图进行点云融合;对于目标,使用ICP算法进行像素级的融合,从而得到一个完整室内环境的语义点云地图。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910529158.0A CN110728751A (zh) | 2019-06-19 | 2019-06-19 | 一种室内3d点云语义地图的构建方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910529158.0A CN110728751A (zh) | 2019-06-19 | 2019-06-19 | 一种室内3d点云语义地图的构建方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110728751A true CN110728751A (zh) | 2020-01-24 |
Family
ID=69217054
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910529158.0A Pending CN110728751A (zh) | 2019-06-19 | 2019-06-19 | 一种室内3d点云语义地图的构建方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110728751A (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111461245A (zh) * | 2020-04-09 | 2020-07-28 | 武汉大学 | 一种融合点云和图像的轮式机器人语义建图方法及系统 |
CN111476894A (zh) * | 2020-05-14 | 2020-07-31 | 小狗电器互联网科技(北京)股份有限公司 | 三维语义地图构建方法、装置、存储介质及电子设备 |
CN111486855A (zh) * | 2020-04-28 | 2020-08-04 | 武汉科技大学 | 一种具有物体导航点的室内二维语义栅格地图构建方法 |
CN111664866A (zh) * | 2020-06-04 | 2020-09-15 | 浙江商汤科技开发有限公司 | 定位展示方法及装置、定位方法及装置和电子设备 |
CN112085026A (zh) * | 2020-08-26 | 2020-12-15 | 的卢技术有限公司 | 一种基于深度神经网络语义分割的闭环检测方法 |
CN112861674A (zh) * | 2021-01-28 | 2021-05-28 | 中振同辂(江苏)机器人有限公司 | 一种基于地面特征的点云优化方法及计算机可读存储介质 |
CN113505646A (zh) * | 2021-06-10 | 2021-10-15 | 清华大学 | 一种基于语义地图的目标搜索方法 |
CN113916245A (zh) * | 2021-10-09 | 2022-01-11 | 上海大学 | 一种基于实例分割和vslam的语义地图构建方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108010045A (zh) * | 2017-12-08 | 2018-05-08 | 福州大学 | 基于orb的视觉图像特征点误匹配提纯方法 |
CN109816686A (zh) * | 2019-01-15 | 2019-05-28 | 山东大学 | 基于物体实例匹配的机器人语义slam方法、处理器及机器人 |
-
2019
- 2019-06-19 CN CN201910529158.0A patent/CN110728751A/zh active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108010045A (zh) * | 2017-12-08 | 2018-05-08 | 福州大学 | 基于orb的视觉图像特征点误匹配提纯方法 |
CN109816686A (zh) * | 2019-01-15 | 2019-05-28 | 山东大学 | 基于物体实例匹配的机器人语义slam方法、处理器及机器人 |
Non-Patent Citations (2)
Title |
---|
MARTIN R¨UNZ,ETC: "MaskFusion: Real-Time Recognition, Tracking and Reconstruction of Multiple Moving Objects" * |
洪亮;冯常;: "基于RGB-D相机数据的SLAM算法" * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111461245A (zh) * | 2020-04-09 | 2020-07-28 | 武汉大学 | 一种融合点云和图像的轮式机器人语义建图方法及系统 |
CN111486855A (zh) * | 2020-04-28 | 2020-08-04 | 武汉科技大学 | 一种具有物体导航点的室内二维语义栅格地图构建方法 |
CN111476894A (zh) * | 2020-05-14 | 2020-07-31 | 小狗电器互联网科技(北京)股份有限公司 | 三维语义地图构建方法、装置、存储介质及电子设备 |
CN111664866A (zh) * | 2020-06-04 | 2020-09-15 | 浙江商汤科技开发有限公司 | 定位展示方法及装置、定位方法及装置和电子设备 |
CN112085026A (zh) * | 2020-08-26 | 2020-12-15 | 的卢技术有限公司 | 一种基于深度神经网络语义分割的闭环检测方法 |
CN112861674A (zh) * | 2021-01-28 | 2021-05-28 | 中振同辂(江苏)机器人有限公司 | 一种基于地面特征的点云优化方法及计算机可读存储介质 |
CN113505646A (zh) * | 2021-06-10 | 2021-10-15 | 清华大学 | 一种基于语义地图的目标搜索方法 |
CN113505646B (zh) * | 2021-06-10 | 2024-04-12 | 清华大学 | 一种基于语义地图的目标搜索方法 |
CN113916245A (zh) * | 2021-10-09 | 2022-01-11 | 上海大学 | 一种基于实例分割和vslam的语义地图构建方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110728751A (zh) | 一种室内3d点云语义地图的构建方法 | |
CN112258618B (zh) | 基于先验激光点云与深度图融合的语义建图与定位方法 | |
WO2021233029A1 (en) | Simultaneous localization and mapping method, device, system and storage medium | |
CN112132893B (zh) | 一种适用于室内动态环境的视觉slam方法 | |
CN111080659A (zh) | 一种基于视觉信息的环境语义感知方法 | |
CN105843223B (zh) | 一种基于空间词袋模型的移动机器人三维建图与避障方法 | |
CN109509230A (zh) | 一种应用于多镜头组合式全景相机的slam方法 | |
CN112525202A (zh) | 一种基于多传感器融合的slam定位导航方法及系统 | |
CN113674416B (zh) | 三维地图的构建方法、装置、电子设备及存储介质 | |
CN110717927A (zh) | 基于深度学习和视惯融合的室内机器人运动估计方法 | |
CN108537844B (zh) | 一种融合几何信息的视觉slam回环检测方法 | |
CN106780631A (zh) | 一种基于深度学习的机器人闭环检测方法 | |
Li et al. | Automatic targetless LiDAR–camera calibration: a survey | |
CN117315025A (zh) | 一种基于神经网络的机械臂6d位姿抓取方法 | |
WO2022246812A1 (zh) | 定位方法、装置、电子设备及存储介质 | |
Wei et al. | Novel robust simultaneous localization and mapping for long-term autonomous robots | |
CN116592897B (zh) | 基于位姿不确定性的改进orb-slam2定位方法 | |
Dang et al. | Real-time semantic plane reconstruction on a monocular drone using sparse fusion | |
Li et al. | BA-LIOM: tightly coupled laser-inertial odometry and mapping with bundle adjustment | |
Pal et al. | Evolution of Simultaneous Localization and Mapping Framework for Autonomous Robotics—A Comprehensive Review | |
Guan et al. | Recognition-driven 3D navigation in large-scale virtual environments | |
Wang et al. | Semantic Mapping Based on Visual SLAM with Object Model Replacement Visualization for Cleaning Robot | |
Zhang et al. | Research on RGB-D SLAM Method for Mobile Robot in Subway Station | |
Wang | Research on Path Planning Algorithm of Binocular Vision Positioning Mobile Robot | |
Canh et al. | Object-Oriented Semantic Mapping for Reliable UAVs Navigation |
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 | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20200124 |
|
WD01 | Invention patent application deemed withdrawn after publication |