CN112486184A - 一种扫地机器人及其避障路径确定方法 - Google Patents
一种扫地机器人及其避障路径确定方法 Download PDFInfo
- Publication number
- CN112486184A CN112486184A CN202011452212.5A CN202011452212A CN112486184A CN 112486184 A CN112486184 A CN 112486184A CN 202011452212 A CN202011452212 A CN 202011452212A CN 112486184 A CN112486184 A CN 112486184A
- Authority
- CN
- China
- Prior art keywords
- sweeping robot
- obstacle
- determining
- dimensional map
- avoidance path
- 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
- 238000010408 sweeping Methods 0.000 title claims abstract description 184
- 238000000034 method Methods 0.000 title claims abstract description 31
- 238000010276 construction Methods 0.000 claims description 3
- 238000004140 cleaning Methods 0.000 abstract description 7
- 238000010586 diagram Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0234—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons
- G05D1/0236—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons in combination with a laser
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
- G05D1/0251—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means extracting 3D information from a plurality of images taken from different locations, e.g. stereo vision
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02E—REDUCTION OF GREENHOUSE GAS [GHG] EMISSIONS, RELATED TO ENERGY GENERATION, TRANSMISSION OR DISTRIBUTION
- Y02E10/00—Energy generation through renewable energy sources
- Y02E10/50—Photovoltaic [PV] energy
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Optics & Photonics (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明适用于清洁设备技术领域,提供了一种扫地机器人及其避障路径确定方法,其中,所述方法包括:获取扫地机器人在环境空间的三维地图;利用与三维地图中地面/扫地机器人底部平行的一个平面,对所述三维地图截取的一个截面,所述截面与所述地面或扫地机器人底部的距离大于等于所述扫地机器人的高度;基于所述截面确定扫地机器人在所述三维地图中的避障路径。本发明利用对三维地图的截面来确定扫地机器人避开障碍物的避障路径,避免了实际中扫地机器人与障碍物发生碰撞和清扫区域不够充分的问题。
Description
技术领域
本发明属于清洁设备技术领域,尤其涉及一种扫地机器人及其避障路径确定方法。
背景技术
利用智能清洁设备来代替人进行清扫工作,在现有家庭中已经非常普遍。例如,采用扫地机器人来进行地面清扫工作。利用扫地机器人进行清扫过程中,会探测自己与障碍物的距离来自动避开障碍物。但对于一些倾斜的物体或者有镂空的家具的情况,扫地机器人则无法有效识别自己是否能够通过障碍物,因此会出现与障碍物发生磕碰,或者出现有些区域无法被有效清洁到位的情况。因此,如何有效识别扫地机器人是否能够避开障碍物是提高清扫质量的关键。
发明内容
有鉴于此,本发明实施例提供了一种扫地机器人及其避障路径确定方法,以解决扫地机器人如何有效识别障碍物来提高清扫质量的问题。
本发明实施例的第一方面,提供了一种扫地机器人及其避障路径确定方法,包括:获取扫地机器人在环境空间的三维地图;利用与三维地图中地面/扫地机器人底部平行的一个平面,对所述三维地图截取的一个截面,所述截面与所述地面或扫地机器人底部的距离大于等于所述扫地机器人的高度;基于所述截面确定扫地机器人在所述三维地图中的避障路径。
在一些实施方案中,所述三维地图包括:基于激光点云数据和深度数据确定的虚拟三维地图;或者,基于深度数据和RGB数据确定三维语义地图。
在一些实施方案中,基于所述截面确定扫地机器人在所述三维地图中的避障路径,包括:根据所述截面,确定障碍物在所述截面中的边界轮廓;基于所述障碍物的边界轮廓确定扫地机器人在所述三维地图中的避障路径。
在一些实施方案中,所述基于所述障碍物的边界轮廓确定扫地机器人在所述三维地图中的避障路径,包括:基于所述障碍物的边界轮廓确定扫地机器人在所述三维地图中通过所述障碍物的路径/绕开所述障碍物的路径。
在一些实施方案中,基于所述障碍物的边界轮廓确定扫地机器人在所述三维地图中通过所述障碍物的路径,包括:计算障碍物与其他障碍物之间的距离;判断所述距离是否能够允许所述扫地机器人通过:若是,则确定扫地机器人在所述三维地图中通过所述障碍物的路径;若否,则确定扫地机器人在所述三维地图中绕开所述障碍物的路径。
在一些实施方案中,判断所述距离是否能够允许所述扫地机器人通过,包括:沿所述障碍物的边界轮廓向外膨胀预设宽度,得到所述障碍物的膨胀边界轮廓,其中,所述预设宽度大于等于所述扫地机器人的直径;判断所述障碍物的膨胀边界轮廓与其他障碍物的边界轮廓是否交叉/重叠;若是,则确定所述扫地机器人不能通过所述障碍物与其他障碍物之间的距离;若否,则确定所述扫地机器人能通过所述障碍物与其他障碍物之间的距离。
在一些实施方案中,确定扫地机器人在所述三维地图中通过所述障碍物的路径,包括:沿所述障碍物的边界轮廓向外膨胀预设宽度,得到所述障碍物的膨胀边界轮廓,其中,所述预设宽度大于等于所述扫地机器人的半径;沿同一方向获取所述膨胀边界轮廓的有序边缘像素序列;根据所述有序边缘像素序列,在所述三维地图中确定所述扫地机器人通过所述障碍物的避障路径。
在一些实施方案中,确定扫地机器人在所述三维地图中绕开所述障碍物的路径,包括:确定所述障碍物与其他障碍物之间的公切线线段;沿所述公切线线段以及对应的多个障碍物的边界轮廓向外膨胀预设宽度,得到所述多个障碍物和公切线线段的共同膨胀边界轮廓,其中,所述预设宽度大于等于所述扫地机器人的半径;沿同一方向获取所述共同膨胀边界轮廓的有序边缘像素序列;根据所述有序边缘像素序列,在所述三维地图中确定所述扫地机器人绕过所述障碍物的避障路径。
在一些实施方案中,确定扫地机器人在所述三维地图中绕开所述障碍物的路径,包括:沿所述障碍物和其他障碍物的边界轮廓分别向外膨胀预设宽度,得到所述多个障碍物的膨胀边界轮廓,其中,所述预设宽度大于等于所述扫地机器人的半径;确定相交/重叠的膨胀边界轮廓之间的公切线线段;沿同一方向获取所述公切线线段和膨胀边界轮廓的有序边缘像素序列;根据所述有序边缘像素序列,在所述三维地图中确定所述扫地机器人绕过所述障碍物的避障路径。
本发明实施例的第二方面,提供了一种扫地机器人,至少包括:清扫组件、图像获取组件和主控模块,所述清扫组件和图像获取组件分别连接于所述主控模块,其特征在于,在所述扫地机器人中还包括:避障路径确定装置,所述避障路径确定装置,至少包括:三维图像构建模块,被配置为获取扫地机器人在环境空间的三维地图;三维地图截图模块,被配置为利用与三维地图中地面/扫地机器人底部平行的一个平面,对所述三维地图截取的一个截面,所述截面与所述地面或扫地机器人底部的距离大于等于所述扫地机器人的高度;避障路径规划模块,被配置为基于所述截面确定扫地机器人在所述三维地图中的避障路径。
本发明实施例与现有技术相比存在的有益效果是:本发明利用对三维地图的截面来确定扫地机器人避开障碍物的避障路径,避免了实际中扫地机器人与障碍物发生碰撞和清扫区域不够充分的问题,从而实现了扫地机器人的清扫质量。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其它的附图。
图1是本发明提供的扫地机器人的避障路径确定方法在一实施例中的流程示意图。
图2是本发明提供的扫地机器人在一实施例中的结构示意图。
具体实施方式
以下描述中,为了说明而不是为了限定,提出了诸如特定***结构、技术之类的具体细节,以便透彻理解本发明实施例。然而,本领域的技术人员应当清楚,在没有这些具体细节的其它实施例中也可以实现本发明。在其它情况中,省略对众所周知的***、装置、电路以及方法的详细说明,以免不必要的细节妨碍本发明的描述。
为了说明本发明所述的技术方案,下面通过具体实施例来进行说明。
请参见图1,示出了本发明提供的扫地机器人的避障路径确定方法在一实施例中的流程示意图。
如图1所示,所述扫地机器人的避障路径确定方法,包括以下步骤:
S01:获取扫地机器人在环境空间的三维地图;
S02:利用与三维地图中地面/扫地机器人底部平行的一个平面,对所述三维地图截取的一个截面,所述截面与所述地面或扫地机器人底部的距离大于等于所述扫地机器人的高度;
S03:基于所述截面确定扫地机器人在所述三维地图中的避障路径。
本示例提供的扫地机器人的避障路径确定方法的工作原理为:利用对扫地机器人所在环境空间的三维地图进行截图,来得到在该三维地图中不低于扫地机器人高度的截图,基于该截图可以确定在不低于扫地机器人高度的三维空间中各个物体的边界轮廓,所述物体包括各种障碍物,例如墙体、桌椅、家居等,这样根据截图下的各障碍物的边界轮廓,可以确保扫地机器人能够准确的规划出避开障碍物或通过障碍物的路径,从而避免出现一些碰头的情况,以及盲目避开障碍物导致清扫路径不合理,有些区域实际可以被清扫到,而却没有被规划到的情况,进而提高了扫地机器人的清扫质量。
在步骤S01中,所述三维地图可以是基于激光点云数据和深度数据确定的虚拟三维地图。例如,在扫地机器人上配置有激光雷达,利用激光雷达可以获取扫地机器人所在环境空间的激光点云数据,以此建立环境空间的虚拟三维地图。其中,所述激光雷达可以包括单线激光累活或/和多线激光雷达。
在步骤S01中,所述三维地图还可以是基于深度数据和RGB数据确定三维语义地图。例如,在扫地机器人上配置有深度相机,例如,所述深度相机可以为RGB-D相机,由此可以获取到一个深度数据和一个RGB图像数据。其中,所述深度数据包括深度相机距离每个物体的距离信息。
其中,与虚拟三维地图相比,三维语义地图的信息丰富,且位置信息的精度更高。在实际应用中,如果采用精度更高的三维地图,相应确定的避障路径与实际越接近,从而对于避障路径的规划就更为准确。
在步骤S02中,截面与地面或扫地机器人底部的距离不同,在截面中同一物体的边界轮廓也可能不同。例如,对于一个倾斜的物体,在不同高度位置的截面,其在截面中的边界轮廓是不一样的。因此,如果扫地机器人验证截面中物体的边界轮廓移动,那么扫地机器人就不会与障碍物发生接触或碰撞。
在一个示例中,以上步骤S03,可以具体包括步骤S31-S32:
S31:根据所述截面,确定障碍物在所述截面中的边界轮廓;
S32:基于所述障碍物的边界轮廓确定扫地机器人在所述三维地图中的避障路径。
本示例通过在对三维地图进行截面后,利用截面中物体的边界轮廓来确定扫地机器人的避障路径,以此来保证扫地机器人规划的路径可以不与障碍物发生碰撞。
其中,扫地机器人避开障碍物的方式可以是沿着障碍物的边缘移动来绕开障碍物,例如,在障碍物为墙壁这类物体时,根据在三维地图上的截面,只需让扫地机器人沿着截面中墙壁的边缘轮廓移动即可绕开障碍物。另外,扫地机器人避开障碍物的方式还可以是通过障碍物,例如,在障碍物为桌椅这类镂空物体时,根据在三维地图上的截面,可以让扫地机器人从截面中桌椅的四个脚的边缘轮廓之间通过来避开障碍物,当然,前提是座椅的四个脚之间的距离运行扫地机器人通过。
由此,在一个示例中,以上步骤S32,可以具体包括:基于所述障碍物的边界轮廓确定扫地机器人在所述三维地图中通过所述障碍物的路径/绕开所述障碍物的路径。
其中,基于所述障碍物的边界轮廓确定扫地机器人在所述三维地图中通过所述障碍物的路径,可以具体包括以下步骤S321-S324。
S321:计算障碍物与其他障碍物之间的距离。
其中,步骤S321中,障碍物可以是扫地机器人当前识别到的需要避开的障碍物,而其他障碍物则可以是与扫地机器人当前识别到的需要避开的障碍物相邻的障碍物。具体的,所述距离可以是障碍物中心位置之间的距离,也可以是扫地机器人当前识别到的需要避开的障碍物的边缘到其他障碍物的中心或边缘的最小距离。
S322:判断所述距离是否能够允许所述扫地机器人通过。
其中,只要两个障碍物的边缘之间的最小距离大于等于扫地机器人的最小通过距离,则所述距离就能允许扫地机器人通过。
S323:若是,则确定扫地机器人在所述三维地图中通过所述障碍物的路径;
S324:若否,则确定扫地机器人在所述三维地图中绕开所述障碍物的路径。
本示例根据障碍物在截面中的距离情况来判定扫地机器人是否能穿过不同障碍之间,即通过障碍物,以此来确定是选择绕开障碍物还是通过障碍物的避障路径,从而提高了扫地机器人避开障碍物的准确性。
在一个示例中,针对以上步骤S322,可以具体包括下列步骤A01-A32。
A01:沿所述障碍物的边界轮廓向外膨胀预设宽度的像素,得到所述障碍物的膨胀边界轮廓,其中,所述预设宽度大于等于所述扫地机器人的直径。
其中,向外膨胀预设宽度的像素,即沿着边界轮廓依次向外一层一层的填充像素,在边界轮廓垂直方向上的像素填充长度,即预设宽度。
A02:判断所述障碍物的膨胀边界轮廓与其他障碍物的边界轮廓是否交叉/重叠:
A31:若是,则确定所述扫地机器人不能通过所述障碍物与其他障碍物之间的距离。如果在对障碍物的边界轮廓进行像素膨胀处理后,依旧有与其他障碍物形成交叉或重叠,相当于说扫地机器人在沿障碍物的边界轮廓移动过程中会接触的其他障碍物,由此认定扫地机器人不能通过障碍物。
A32:若否,则确定所述扫地机器人能通过所述障碍物与其他障碍物之间的距离。具体的,与以上不能通过的情况正好相反,当不存在交叉或重叠时,相当于扫地机器人不会与其他障碍物相接触,此时则认定扫地机器人可以通过障碍物。
在本示例中,利用在障碍物的边界轮廓向外膨胀预设宽度的像素来得到障碍物的膨胀边界轮廓,相当于假设让扫地机器人沿着障碍物的边界轮廓进行移动,由于在三地地图中,一般障碍物的像素和非障碍物区域的像素值是不一样的,这样便可以确定该障碍物的膨胀边界轮廓是否与其他障碍的边界轮廓有接触,如果存在交叉或重叠,即表示有接触,也就是说此时扫地机器人无法通过障碍物,由此可以根据通过情况来选择具体的避开路径的方式。
在一个示例中,针对以上步骤S323,其中,所述确定扫地机器人在所述三维地图中通过所述障碍物的路径,可以具体包括步骤B01-B03:
B01:沿所述障碍物的边界轮廓向外膨胀预设宽度,得到所述障碍物的膨胀边界轮廓,其中,所述预设宽度大于等于所述扫地机器人的半径;
B02:沿同一方向获取所述膨胀边界轮廓的有序边缘像素序列;
B03:根据所述有序边缘像素序列,在所述三维地图中确定所述扫地机器人通过所述障碍物的避障路径。
在允许扫地机器人通过的情况下,利用对障碍物的边界轮廓的像素膨胀处理,来模拟规划扫地机器人的避障路径。其中,由于扫地机器人一般为圆形结构,其圆形中心为移动中心,由此利用沿同一方向来获取对障碍物的边界轮廓的像素膨胀处理后的有序边缘像素序列,在三维地图中与该有序边缘像素序列对应的路径位置即为避障路径。
其中,有序边缘像素序列可以是连续的像素序列,也可以是不连续的像素序列,即相邻像素之间存在间隔位置。
在一个示例中,针对以上步骤S324,其中,所述确定扫地机器人在所述三维地图中绕开所述障碍物的路径,可以具体包括下列步骤C01-C04。
C01:确定所述障碍物与其他障碍物之间的公切线线段。
其中,在扫地机器人无法通过障碍物的情况下,扫地机器人是绕着障碍物来进行避障的,而不同障碍物之间是存在间隔空间的,此时扫地机器人如何在两个障碍物之间的避障路径,是一个本示例所要克服的技术问题。
具体的,在截面中,障碍物的形状一般为一个封闭的实体,在两个彼此分开的或者不关联的障碍物之间,可以通过公切线线段来将两个障碍物合并为一个障碍物。也就是说,利用公切线线段,可以是一条或多条,来将两个彼此间隔的障碍物合并为一个障碍物。
C02:沿所述公切线线段以及对应的多个障碍物的边界轮廓向外膨胀预设宽度,得到所述多个障碍物和公切线线段的共同膨胀边界轮廓,其中,所述预设宽度大于等于所述扫地机器人的半径。
同理,对障碍物的边界轮廓进行像素膨胀处理,可以模拟确定扫地机器人绕着障碍物的边界轮廓来避开障碍物的路径。
C03:沿同一方向获取所述共同膨胀边界轮廓的有序边缘像素序列。
其中,在获取有序边缘像素序列中的像素时,对每个像素进行有向标记,这样可以便于确定扫地机器人避障路径的移动方向。
C04:根据所述有序边缘像素序列,在所述三维地图中确定所述扫地机器人绕过所述障碍物的避障路径。
在一个示例中,针对以上步骤S324,其中,所述确定扫地机器人在所述三维地图中绕开所述障碍物的路径,还可以具体包括下列步骤D01-C04。
D01:沿所述障碍物和其他障碍物的边界轮廓分别向外膨胀预设宽度,得到所述多个障碍物的膨胀边界轮廓,其中,所述预设宽度大于等于所述扫地机器人的半径。
D02:确定相交/重叠的膨胀边界轮廓之间的公切线线段。
D03:沿同一方向获取所述公切线线段和膨胀边界轮廓的有序边缘像素序列。
C04:根据所述有序边缘像素序列,在所述三维地图中确定所述扫地机器人绕过所述障碍物的避障路径。
与以上示例不同的是:本示例是在对不同的障碍物进行像素膨胀处理的基础上来确定公切线线段,从而来确定不同障碍物合并为一个障碍物之后的边界轮廓可以运行扫地机器人通过更多的区域,以此来扩大清扫区域。
应理解,上述实施例中各步骤的序号的大小并不意味着执行顺序的先后,各过程的执行顺序应以其功能和内在逻辑确定,而不应对本发明实施例的实施过程构成任何限定。
在于上述扫地机器人的避障路径确定方法属于同一个发明构思的基础上,本发明还提供了一种可以用于实现图1所示方法的扫地机器人。
见图2,示出了本发明提供的扫地机器人在一实施例中的结构示意图。
在一个示例中,如图2所示,所述扫地机器人200,可以具体包括:清扫组件210、图像获取组件220、避障路径确定装置230和主控模块240,其中,清扫组件210、图像获取组件220、避障路径确定装置230分别连接于所述主控模块240,所述避障路径确定装置230,至少包括:三维图像构建模块231,被配置为获取扫地机器人在环境空间的三维地图;三维地图截图模块232,被配置为利用与三维地图中地面/扫地机器人底部平行的一个平面,对所述三维地图截取的一个截面,所述截面与所述地面或扫地机器人底部的距离大于等于所述扫地机器人的高度;避障路径规划模块233,被配置为基于所述截面确定扫地机器人在所述三维地图中的避障路径。
在一些示例中,所述扫地机器人还可以包括:深度相机。利用深度相机来获取深度数据和图像数据,与此同时与激光雷达获取的激光点云数据,来生成信息更丰富和信息更准确的高精地图,即三维语义地图。
以上所述实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围,均应包含在本发明的保护范围之内。
Claims (10)
1.一种扫地机器人的避障路径确定方法,其特征在于,包括:
获取扫地机器人在环境空间的三维地图;
利用与三维地图中地面/扫地机器人底部平行的一个平面,对所述三维地图截取的一个截面,所述截面与所述地面或扫地机器人底部的距离大于等于所述扫地机器人的高度;
基于所述截面确定扫地机器人在所述三维地图中的避障路径。
2.根据权利要求1所述的扫地机器人的避障路径确定方法,其特征在于,所述三维地图包括:
基于激光点云数据和深度数据确定的虚拟三维地图;或者,
基于深度数据和RGB数据确定三维语义地图。
3.根据权利要求1或2所述的扫地机器人的避障路径确定方法,其特征在于,基于所述截面确定扫地机器人在所述三维地图中的避障路径,包括:
根据所述截面,确定障碍物在所述截面中的边界轮廓;
基于所述障碍物的边界轮廓确定扫地机器人在所述三维地图中的避障路径。
4.根据权利要求3所述的扫地机器人的避障路径确定方法,其特征在于,所述基于所述障碍物的边界轮廓确定扫地机器人在所述三维地图中的避障路径,包括:
基于所述障碍物的边界轮廓确定扫地机器人在所述三维地图中通过所述障碍物的路径/绕开所述障碍物的路径。
5.根据权利要求4所述的扫地机器人的避障路径确定方法,其特征在于,基于所述障碍物的边界轮廓确定扫地机器人在所述三维地图中通过所述障碍物的路径,包括:
计算障碍物与其他障碍物之间的距离;
判断所述距离是否能够允许所述扫地机器人通过:
若是,则确定扫地机器人在所述三维地图中通过所述障碍物的路径;
若否,则确定扫地机器人在所述三维地图中绕开所述障碍物的路径。
6.根据权利要求5所述的扫地机器人的避障路径确定方法,其特征在于,判断所述距离是否能够允许所述扫地机器人通过,包括:
沿所述障碍物的边界轮廓向外膨胀预设宽度,得到所述障碍物的膨胀边界轮廓,其中,所述预设宽度大于等于所述扫地机器人的直径;
判断所述障碍物的膨胀边界轮廓与其他障碍物的边界轮廓是否交叉/重叠;
若是,则确定所述扫地机器人不能通过所述障碍物与其他障碍物之间的距离;
若否,则确定所述扫地机器人能通过所述障碍物与其他障碍物之间的距离。
7.根据权利要求5所述的扫地机器人的避障路径确定方法,其特征在于,确定扫地机器人在所述三维地图中通过所述障碍物的路径,包括:
沿所述障碍物的边界轮廓向外膨胀预设宽度,得到所述障碍物的膨胀边界轮廓,其中,所述预设宽度大于等于所述扫地机器人的半径;
沿同一方向获取所述膨胀边界轮廓的有序边缘像素序列;
根据所述有序边缘像素序列,在所述三维地图中确定所述扫地机器人通过所述障碍物的避障路径。
8.根据权利要求5所述的扫地机器人的避障路径确定方法,其特征在于,确定扫地机器人在所述三维地图中绕开所述障碍物的路径,包括:
确定所述障碍物与其他障碍物之间的公切线线段;
沿所述公切线线段以及对应的多个障碍物的边界轮廓向外膨胀预设宽度,得到所述多个障碍物和公切线线段的共同膨胀边界轮廓,其中,所述预设宽度大于等于所述扫地机器人的半径;
沿同一方向获取所述共同膨胀边界轮廓的有序边缘像素序列;
根据所述有序边缘像素序列,在所述三维地图中确定所述扫地机器人绕过所述障碍物的避障路径。
9.根据权利要求5所述的扫地机器人的避障路径确定方法,其特征在于,确定扫地机器人在所述三维地图中绕开所述障碍物的路径,包括:
沿所述障碍物和其他障碍物的边界轮廓分别向外膨胀预设宽度,得到所述多个障碍物的膨胀边界轮廓,其中,所述预设宽度大于等于所述扫地机器人的半径;
确定相交/重叠的膨胀边界轮廓之间的公切线线段;
沿同一方向获取所述公切线线段和膨胀边界轮廓的有序边缘像素序列;
根据所述有序边缘像素序列,在所述三维地图中确定所述扫地机器人绕过所述障碍物的避障路径。
10.一种扫地机器人,至少包括:清扫组件、图像获取组件和主控模块,所述清扫组件和图像获取组件分别连接于所述主控模块,其特征在于,在所述扫地机器人中还包括:避障路径确定装置,所述避障路径确定装置,至少包括:
三维图像构建模块,被配置为获取扫地机器人在环境空间的三维地图;
三维地图截图模块,被配置为利用与三维地图中地面/扫地机器人底部平行的一个平面,对所述三维地图截取的一个截面,所述截面与所述地面或扫地机器人底部的距离大于等于所述扫地机器人的高度;
避障路径规划模块,被配置为基于所述截面确定扫地机器人在所述三维地图中的避障路径。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011452212.5A CN112486184B (zh) | 2020-12-10 | 2020-12-10 | 一种扫地机器人及其避障路径确定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011452212.5A CN112486184B (zh) | 2020-12-10 | 2020-12-10 | 一种扫地机器人及其避障路径确定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112486184A true CN112486184A (zh) | 2021-03-12 |
CN112486184B CN112486184B (zh) | 2023-08-11 |
Family
ID=74941765
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011452212.5A Active CN112486184B (zh) | 2020-12-10 | 2020-12-10 | 一种扫地机器人及其避障路径确定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112486184B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113867349A (zh) * | 2021-09-28 | 2021-12-31 | 浙江大华技术股份有限公司 | 一种机器人的避障方法、***及智能机器人 |
CN114474064A (zh) * | 2022-03-04 | 2022-05-13 | 美智纵横科技有限责任公司 | 机器人控制方法及其装置、扫地机器人和存储介质 |
CN115235485A (zh) * | 2022-07-08 | 2022-10-25 | 松灵机器人(深圳)有限公司 | 作业地图构建方法、装置、割草机器人以及存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090226113A1 (en) * | 2008-03-07 | 2009-09-10 | Kosei Matsumoto | Environment Map Generating Apparatus, Environment Map Generating Method, and Environment Map Generating Program |
JP2012153324A (ja) * | 2011-01-28 | 2012-08-16 | Daihatsu Motor Co Ltd | 軌道算出装置 |
JP2019202160A (ja) * | 2019-07-04 | 2019-11-28 | みこらった株式会社 | 掃除システム及び掃除システムを構成するロボット掃除装置並びに飛行体装置 |
CN111103897A (zh) * | 2019-12-25 | 2020-05-05 | 浙江工业大学 | 一种障碍环境下多机器人的编队控制方法和*** |
US20200183404A1 (en) * | 2018-12-07 | 2020-06-11 | Jiangsu Midea Cleaning Appliances Co., Ltd. | Distance detection method and device for cleaning robot, and cleaning robot |
-
2020
- 2020-12-10 CN CN202011452212.5A patent/CN112486184B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090226113A1 (en) * | 2008-03-07 | 2009-09-10 | Kosei Matsumoto | Environment Map Generating Apparatus, Environment Map Generating Method, and Environment Map Generating Program |
JP2012153324A (ja) * | 2011-01-28 | 2012-08-16 | Daihatsu Motor Co Ltd | 軌道算出装置 |
US20200183404A1 (en) * | 2018-12-07 | 2020-06-11 | Jiangsu Midea Cleaning Appliances Co., Ltd. | Distance detection method and device for cleaning robot, and cleaning robot |
JP2019202160A (ja) * | 2019-07-04 | 2019-11-28 | みこらった株式会社 | 掃除システム及び掃除システムを構成するロボット掃除装置並びに飛行体装置 |
CN111103897A (zh) * | 2019-12-25 | 2020-05-05 | 浙江工业大学 | 一种障碍环境下多机器人的编队控制方法和*** |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113867349A (zh) * | 2021-09-28 | 2021-12-31 | 浙江大华技术股份有限公司 | 一种机器人的避障方法、***及智能机器人 |
CN113867349B (zh) * | 2021-09-28 | 2024-04-09 | 浙江大华技术股份有限公司 | 一种机器人的避障方法、***及智能机器人 |
CN114474064A (zh) * | 2022-03-04 | 2022-05-13 | 美智纵横科技有限责任公司 | 机器人控制方法及其装置、扫地机器人和存储介质 |
CN114474064B (zh) * | 2022-03-04 | 2024-01-09 | 美智纵横科技有限责任公司 | 机器人控制方法及其装置、扫地机器人和存储介质 |
CN115235485A (zh) * | 2022-07-08 | 2022-10-25 | 松灵机器人(深圳)有限公司 | 作业地图构建方法、装置、割草机器人以及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN112486184B (zh) | 2023-08-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112486184A (zh) | 一种扫地机器人及其避障路径确定方法 | |
CN106780735B (zh) | 一种语义地图构建方法、装置及一种机器人 | |
CN108983781A (zh) | 一种无人车目标搜索***中的环境探测方法 | |
CN114417489B (zh) | 一种基于实景三维模型的建筑基底轮廓精细化提取方法 | |
CN109541634A (zh) | 一种路径规划方法、装置和移动设备 | |
CN108732556B (zh) | 一种基于几何体求交运算的车载激光雷达仿真方法 | |
CN111402414B (zh) | 一种点云地图构建方法、装置、设备和存储介质 | |
CN113269837A (zh) | 一种适用于复杂三维环境的定位导航方法 | |
Prieto et al. | As-is building-structure reconstruction from a probabilistic next best scan approach | |
CN113640822B (zh) | 一种基于非地图元素过滤的高精度地图构建方法 | |
CN102938064B (zh) | 基于LiDAR数据与正射影像的停车场结构提取方法 | |
JP6736931B2 (ja) | 立体物検出方法及び立体物検出装置 | |
CN113189988B (zh) | 一种基于Harris算法与RRT算法复合的自主路径规划方法 | |
CN111721279A (zh) | 一种适用于输电巡检工作的末端路径导航方法 | |
US11734883B2 (en) | Generating mappings of physical spaces from point cloud data | |
CN114445565A (zh) | 数据处理方法、装置、电子设备和计算机可读介质 | |
CN110910501A (zh) | 基于全景地图的网络分析模型构建及路径分析方法 | |
CN112632201A (zh) | 一种交通道路拓扑网构建方法及装置 | |
JP2002092658A (ja) | 3次元デジタル地図作成装置及び3次元デジタル地図作成のプログラムを記憶した記憶媒体 | |
CN112967384A (zh) | 识别建筑测绘构件的点云智能化切分方法 | |
Yoon et al. | Practical implementation of semi-automated as-built BIM creation for complex indoor environments | |
CN108198241A (zh) | 一种三维图像构建的方法和装置 | |
CN115454055B (zh) | 一种面向室内自主导航与作业的多层融合地图表示方法 | |
CN116339302A (zh) | 一种沿边小区域划分清扫方法及区域合并显示方法 | |
Nakagawa et al. | Topological 3D modeling using indoor mobile LiDAR data |
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 |