CN108387234B - 基于激光测距传感器的移动机器人的地图创建方法 - Google Patents
基于激光测距传感器的移动机器人的地图创建方法 Download PDFInfo
- Publication number
- CN108387234B CN108387234B CN201810116061.2A CN201810116061A CN108387234B CN 108387234 B CN108387234 B CN 108387234B CN 201810116061 A CN201810116061 A CN 201810116061A CN 108387234 B CN108387234 B CN 108387234B
- Authority
- CN
- China
- Prior art keywords
- data
- points
- mobile robot
- ranging sensor
- data block
- 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
Images
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
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/40—Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
- A47L11/4011—Regulation of the cleaning machine by electric means; Control systems and remote control systems therefor
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供一种移动机器人基于激光测距传感器的地图创建方法,包括以下步骤:S1:以移动机器人前进方向为参考建立直角坐标系,移动机器人的激光测距传感器扫描工作区域获取激光数据点;S2:根据当前激光数据点与测距传感器之间的距离确定动态阈值Q,并且根据动态阈值Q对激光数据点进行数据分块;S3:在数据分块中提取角点信息;S4:根据角点信息提取线段信息;S5:根据线段信息修改直角坐标系;S6:根据修改的直角坐标系在工作区域内创建地图。与现有技术相比,本发明通过根据当前激光数据点与测距传感器之间的距离确定动态阈值,并根据动态阈值Q对数据值分块,比静态阈值更准确的反应数据点的分布,使分块准确度更高。
Description
技术领域
本发明涉及移动机器人领域,特别是涉及基于激光测距传感器的移动机器人的地图创建方法。
背景技术
目前市面上的移动机器人可在无人参与条件下在特定区域自动完成特定工作,给人们带来了便利,市场前景可观。尤其是带有激光测距传感器的移动机器人可以利用激光测距传感器创建周围环境的地图,进行定位和导航。
激光测距传感器是以机器的前进方向建造地图。如图1所示,当机器的前进方向不与墙面垂直的时候,建造出来的地图是歪的。若所建造的地图为歪的,当后续扫地机器人在清扫规划时,所规划的清扫区域会出现斜方块的情况,使得扫地机器人智能性大大下降,沿边清扫效率降低,清扫效果不佳。
发明内容
本发明的目的之一在于克服背景技术中的缺陷,提供一种基于激光测距传感器的移动机器人的地图创建方法,具体方案如下:
一种基于激光测距传感器的移动机器人的地图创建方法,包括以下步骤:
S1:以移动机器人前进方向为参考建立直角坐标系,移动机器人的激光测距传感器扫描工作区域获取激光数据点;
S2:根据当前激光数据点与测距传感器之间的距离确定动态阈值Q,并且根据动态阈值Q对激光数据点进行数据分块;
S3:在数据分块中提取角点信息;
S4:根据角点信息提取线段信息;
S5:根据线段信息修改直角坐标系;
S6:根据修改的直角坐标系在工作区域内创建地图。
进一步地,可在移动机器人、服务器或其他终端进行所述步骤S2-S6。
进一步地,所述步骤S2包括以下子步骤:
S21:将激光数据点中的第一个点作为第一个数据分块的第一个点;
S22:计算下一点与第一个数据分块上一点的距离,若距离小于设定的动态阈值Q,则判断下一点属于第一个分块;当距离大于设定的动态阈值Q,则将下一点作为新数据分块的第一个点;
S23:重复上述步骤直到对所有激光数据点完成数据分块;
S24:判断第一个点是否属于最后一个数据分块,若属于最后一个数据分块,则将最后一个数据分块和第一个数据分块合并。
进一步地,所述步骤S3在数据分块中提取角点信息包括如下子步骤:
S31:将第一个数据分块作为当前数据分块,计算当前数据分块中数据点的数量;
S32:判断当前数据分块中数据点的数量与M的大小,若当前数据分块数据分块中数据点的数量小于或等于M,进入步骤S33;若当前数据分块数据分块中数据点的数量大于M,进入步骤S34;
S33:将当前数据分块的两端点作为角点;
S34:选择当前数据分块中两端点拟合直线L,计算当前数据分块中的除两端点外的其他数据点到直线L的距离;
S35:判断数据点到直线L的最大距离DL与N的大小,若最大距离DL小于或等于N,则进入步骤S33;若最大距离DL大于N,则进入步骤S36;
S36:以距离直线L距离最远的点为界将当前数据分块数据分块分为两个新的数据分块,进入步骤S31;
S37:通过重复步骤S31-S36,遍历其他数据分块直到获得所有数据分块中的角点信息。
进一步地,所述M的值为3。
进一步地,所述N的值为0.03米。
进一步地,所述步骤S4包括如下子步骤:
S41:计算每个分块中两角点之间的数据点的数量;
S42:判断两角点之间的数据点的数量与P的大小,若两角点之间的数据点的数量小于或者等于P,进入步骤S43;若两角点之间的数据点的数量大于P,进入步骤S44;
S43:判断数据分块中的数据点数量太少,不拟合成线段;
S44:将数据分块中的数据点进行直线拟合获取相应的线段信息。
进一步地,所述P的值为3。
进一步地,所述步骤S5包括如下子步骤:
S51:选择长度最长的K条线段;
S52:计算K条线段之间的相互角度是否满足角度阈值Y;
S53:根据线段长度排序及与其他线段之间的角度关系确定坐标参考线段;
S54:根据坐标参考线段修改直角坐标系。
进一步地,所述K的值为10。
与现有技术相比,本发明技术方案具有以下有益效果:
本发明针对基于激光测距传感器的移动机器人提供一种地图创建方法,以移动机器人前进方向为参考建立直角坐标系,通过对激光数据点进行数据分块,并提取角点信息和线段信息,根据线段信息修改直角坐标系,然后根据修改的直角坐标系在工作区域内创建地图,可以将地图旋转至与墙面垂直的角度,能有效优化后续的清扫规划过程,并且根据当前激光数据点与测距传感器之间的距离确定动态阈值,并根据动态阈值Q对数据值分块,比静态阈值更准确的反应数据点的分布,使分块准确度更高。减少清扫过程中的转弯过程,优化沿边过程的清扫,进而提高清扫过程的智能化和效率。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对实施例中所需要使用的附图作简单的介绍,显而易见地,下面描述中的附图是本发明实施例的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为现有技术中的移动机器人以机器前进方向来创建地图的示意图;
图2为本发明的移动机器人基于激光测距传感器的的地图创建方法流程图;
图3为图2中步骤S2的一个优化方案的流程图;
图4为数据分块的示意图;
图5为图2中步骤S3的一个优化方案的流程图;
图6为图2中步骤S4的一个优化方案的流程图;
图7为图2中步骤S5的一个优化方案的流程图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明中的移动机器人是在指定封闭式区域工作的覆盖式机器人,如在室内环境工作的安防巡逻机器人或扫地机器人、在特定草坪区域工作的割草机器人以及清洁游泳池的清洁机器人等。
本发明中的移动机器人包括电源模块、行走模块、传感器模块、控制模块、其中,电源模块为可充电电池,用于为移动机器人在工作时提供电能;行走模块包括驱动电机和行走轮,用于使移动机器人在工作区域内运动;传感器模块用于接收工作区域的环境信息并反馈至控制模块;控制模块用于根据传感器模块反馈的信息控制移动机器人运动;
本发明的移动机器人还包括激光测距传感器,激光测距传感器安装在移动机器人底部或顶部,用于获取环境的图片信息。
图2为本发明的移动机器人基于激光测距传感器的的地图创建方法流程图。下面详细介绍带有激光测距传感器的移动机器人如何创建地图。
S1:以移动机器人前进方向为参考建立直角坐标系,移动机器人的激光测距传感器扫描获取激光数据点。
即移动机器人开始工作,启动激光测距传感器,以移动机器人前进方向为参考建立直角坐标系,从工作起点对工作环境扫描一圈,获取激光反射数据,取得墙壁和各障碍物相对于当前激光测距传感器的角度和距离。如果是墙壁和较大障碍物存在的地方,所获取的激光数据点会很接近。尤其是障碍物表面为直线表面的话,获取的激光数据点可以拟合成直线。如果是孤立、较小的障碍物,所获取的激光数据点为孤立的数据点。
S2:根据当前激光数据点与测距传感器之间的距离确定动态阈值Q,并且根据动态阈值Q对激光数据点进行数据分块。
移动机器人从激光测距传感器扫描获取到激光数据点后,需要将激光数据点进行分块。分块的具体过程如图3所示,包括如下步骤:
S21:将激光数据点中的第一个点作为第一个数据分块的第一个点。
即激光测距传感器扫描获取到n个激光数据点,分别为x1 x2...xn-1xn,将x1作为数据分块R1的第一个点。
S22:计算下一点与第一个数据分块上一点的距离,若距离小于设定的动态阈值Q,则判断下一点属于第一个分块;当距离大于设定的动态阈值Q,则将下一点作为新数据分块的第一个点。
记激光测距传感器当前位置为S31,计算x2和x1的距离x1x2,若距离x1x2小于设定的阈值Q,则判断x2属于数据分块R1;当大于设定的阈值Q,则将x2作为新的数据分块R2的第一个点。
其中,考虑到激光数据点获取的数据点范围大,若是选择固定的阈值Q的话,得到的分块不能准确反应激光数据点的分布。因此将阈值Q设定为基于数据点与激光测距传感器的距离来确定的动态阈值。
阈值Q可选择的范围如表1所示,
表1
下面通过几个举例说明阈值Q的选择。
假定x1属于数据分块R1,x2距离激光测距传感器S31的距离S31x2为0.3米,x2和x1的距离为0.01,由于0.01在S31x2所对应的动态阈值0.01-0.03的范围之内,因此判断x2和x1属于同一个数据分块R1,x2为数据分块R1的第二个点。
假定x8属于R3,x9距离激光测距传感器S31的距离S31x9为0.52米,x9和x8的距离为0.09,由于0.09不在S31x9所对应的动态阈值0.04-0.07的范围之内,因此判断x9和x8不属于同一个数据分块R3,x9为新的数据分块R4的第一个点。
S23:重复上述步骤直到对所有激光数据点完成数据分块。
即重复步骤S21-S22,直到获得x1 x2...xn-1xn等n个激光数据点的分块信息,n个激光数据点分成K个数据分块,记为R1、R2...Rk。
为了更好的说明分块过程,申请人以图4为范例对分块过程进行详细说明。
记激光测距传感器当前位置为A,依次获取的数据点为B1 B2...B6,各点到激光雷达位置距离为AB1 AB2...AB6,各点与上一点距离为B1B2,B2B3,...,B5B6。首先将B1作为分块R1的第一个点。
然后计算B2与激光测距传感器A的距离AB2,计算B2和B1的距离B1B2。由于B1B2小于B2距离激光传感器A的距离AB2对应的阈值,因此判断B2属于数据分块R1。同理可得,B3和B1、B2属于同一个分块R1。
对于B4而言,计算B4与激光测距传感器A的距离AB4,以及计算B3和B4的距离B3B4。由于B3B4大于B4距离激光传感器A的距离AB4所对应的阈值,因此B3和B4不属于同一数据分块,B4属于分块R2。同理可得,B5、B6和B4属于同一个分块R2。
S24:判断第一个点是否属于最后一个数据分块,若属于最后一个数据分块,则将最后一个数据分块和第一个数据分块合并。
由于激光测距传感器是从工作起点对工作环境扫描一圈,因此有可能第一个点x1属于最后一个数据分块Rk,因此需判断第一个点x1是否属于分块Rk,若x1属于最后一个数据分块Rk,则将最后一个数据分块Rk和第一个数据分块R1合并。
具体地,计算x1距离激光测距传感器A的距离Ax1,以及x1和xn的距离x1xn,判断x1xn是否落入Ax1所对应的阈值范围。若x1xn在Ax1所对应的阈值范围内,则判定x1属于分块Rk,将R1和Rk合并为一个新的分块R',并且将分块R1作为新分块R'的后半部分,此时的数据分块分别为R2、R3...R';若x1xn在Ax1所对应的阈值范围内,则判定R1和Rk不合并,此时的数据分块分别为R1、R2...Rk。
S3:在数据分块中提取角点信息。
如图5所示,在数据分块中提取角点信息包括如下子步骤:
S31:将第一个数据分块作为当前数据分块,计算当前数据分块中数据点的数量。
即根据步骤S2得到的数据分块:R1 R2...Rk-1 Rk或者R2...Rk-1、R'。首先将R1作为当前的数据分块,计算R1中数据点的数量。
S32:判断当前数据分块中数据点的数量与M的大小,若当前数据分块数据分块中数据点的数量小于或等于M,进入步骤S33;若当前数据分块数据分块中数据点的数量大于M,进入步骤S34;
即判断R1数据分块中数据点的数量与设置的M值的大小。若R1数据分块中数据点的数量小于或等于M,则进入步骤S33;若R1数据分块中数据点的数量大于M,进入步骤S34。
本发明实施例中,M的一个优选实施例为3,即判断R1数据分块中数据点的数量与3的大小关系。若R1数据分块中数据点的数量小于或等于3个,则进入步骤S33;若R1数据分块中数据点的数量大于3个,进入步骤S34。
S33:将当前数据分块的两端点作为角点。
当R1数据分块中数据点的数量小于或等于3时,说明该分块中的数据点太少,可能为很小的障碍物或者离散的噪声点。此时,只需选择R1数据分块中的两个端点作为所需的角点。
S34:选择当前数据分块中两端点拟合直线L,计算当前数据分块中的除两端点外的其他数据点到直线L的距离。
由于R1数据分块中数据点的数量大于3,说明R1数据分块中的数据点较多。数据点较多时可能存在数据点偏离,不能直接选择两端点作为角点。因此首先选择R1数据分块中的两端点,以这两个点拟合成直线。然后,计算R1数据分块中其他的点距离这条直线的距离。
S35:判断数据点到直线L的最大距离DL与N的大小,若最大距离DL小于或等于N,则进入步骤S36;若最大距离DL大于N,则进入步骤S37;
即计算出R1数据分块中其他的点距离拟合直线L的距离,判断距离这条直线L的最大距离DL与设定的阈值N的大小。若最大距离DL小于或等于N,则进入步骤S36;若最大距离DL大于N,则进入步骤S37。
本发明实施例中,N的一个优选实施例为0.03米,即判断R1数据分块中数据点距离拟合直线L的最大距离DL与0.03米的大小关系。若R1最大距离DL小于或等于0.03米,说明R1数据分块中的数据点分布在拟合直线L周围。以两端点拟合的直线可以反映数据点的分布,则进入步骤S33,将当前数据分块的两端点作为角点;若最大距离DL大于0.03米,则进入步骤S36。
S36:以距离所述直线距离最远的点为界将当前数据分块数据分块分为两个新的数据分块,进入步骤S31;
当R1数据分块中数据点距离拟合直线L的最大距离DL大于0.03米,说明R1数据分块中存在数据点偏离拟合直线L过多,直线拟合效果差因此以两端点拟合的直线L不能反映数据点的分布。因此,需要以距离所述直线距离最远的点为界将当前数据分块数据分块分为两个新的数据分块,进入步骤S31;
S37:通过重复步骤S31-S36,遍历其他数据分块直到获得所有数据分块中的角点信息。
即移动机器人对其他数据分块重复S31-S36,直到获得所有的数据分块的角点。
S4:根据角点信息提取线段信息。
如图6所示,在数据分块中提取角点信息包括如下子步骤:
S41:计算每个分块中两角点之间的数据点的数量。
即获得所有的数据分块的角点后,计算数据分块中两角点之间的数据点的数量。
S42:判断两角点之间的数据点的数量与P的大小,若两角点之间的数据点的数量小于或者等于P,进入步骤S43;若两角点之间的数据点的数量大于P,进入步骤S44。
即判断所有数据分块中两角点之间的数据点的数量与设定的阈值P的大小关系。若两角点之间的数据点的数量小于或者等于P,进入步骤S43;若两角点之间的数据点的数量大于P,进入步骤S44。
本发明实施例中,P的一个优选实施例为3,即若两角点之间的数据点的数量小于或者等于3个,则进入步骤S43;若两角点之间的数据点的数量大于3个,进入步骤S44。
S43:判断数据分块中的数据点数量太少,不拟合成线段。
即当两角点之间的数据点的数量小于或者等于3个,说明数据分块中的数据点数量太少,可能为很小的障碍物或者离散的噪声点,因此,移动机器人判断数据分块中的数据点数量太少,不拟合成线段。
S44:将数据分块中的数据点进行直线拟合获取相应的线段信息。
即当两角点之间的数据点的数量大于3个,说明数据分块中的数据点数量足够,因此,将数据分块中的数据点进行直线拟合获取相应的线段信息。
下面通过具体的范例来说明如何从角点信息中提取线段信息。
范例1:假定分块R1中有数据点x1,x2,x3,其中x1和x3为角点。由于角点x1和x3中间的数据点只有x2一个数据点,小于设定的值P(P为3),移动机器人判定数据点太少,不拟合成线段。
范例2:假定分块R5中有数据点x8,x9,x10,x11,x12其中x8和x12为角点。由于角点x8和x12中间的数据点有:x9,x10,x11,等于设定的值P(P为3),移动机器人判定数据点太少,不拟合成线段。
范例3:假定分块R10中有数据点x21,x22,...,x25,x26,其中x21和x26为角点。由于角点x21和x26中间的数据点有:x22,x23,x24,x25,大于设定的值P(P为3),则移动机器人判定数据量足够,通过最小二乘法拟合拟合成线段。
S5:根据线段信息修改直角坐标系。
具体地,如图7所示,包括如下子步骤:
S51:选择长度最长的K条线段。
本发明实施例是通过激光测距传感器扫描获得的图片中寻找墙面,以墙面所在的线段为参考建立直角坐标系。其中,激光测距传感器扫描获得的图片中墙面所在的线段长于障碍物所在的线段。因此,步骤S51选择长度最长的K条线段。
本发明实施例中,K的一个优选实施例为10,即只选择长度最长的K条线段来考查。
S52:计算K条线段之间的相互角度是否满足角度阈值Y;
由于实际情况中存在墙面以及与墙面或互相平行或互相垂直的障碍物,因而激光测距传感器扫描得到的地图中一般有墙面等长直线特征,以及与之平行或垂直的障碍物长直线存在。因此,计算K条线段之间的相互角度是否满足角度阈值Y,计算K条线段之间的相互角度是否在Y度以内或者【90-Y,90+Y】之间。
角度阈值Y的一个优选实施例为3度,即计算K条线段之间的相互角度在3度以内或者【87,93】之间。
S53:根据线段长度排序及与其他线段之间的角度关系确定坐标参考线段。
移动机器根据步骤S51中的K线段长度排序,参考步骤S52中的K条线段之间的相互角度是否满足角度阈值Y。即移动机器人首先确定步骤S52中满足角度阈值Y的线段,然后选择满足角度阈值Y的线段之中长度最长的线段,将此线段确定为坐标参考线段。
S54:根据坐标参考线段修改直角坐标系。
根据步骤S53确定了坐标参考线段之后,移动机器人调整激光测距传感器的方向,将其旋转至坐标参考线段所在方向,即能将地图旋转至与实际房间中的墙面平行或垂直的方向。
另外,为了提高移动机器人的地图旋转效果,激光测距传感器扫描取得多张地图,按照本发明前述步骤选择坐标参考线段,将其旋转至坐标参考线段所在方向修改直角坐标系,比较各张地图中的旋转效果,选择旋转效果最佳的一张地图进行旋转,修改直角坐标系。
S6:根据修改的直角坐标系在工作区域内创建地图。
根据步骤S4修改了直角坐标系后,在工作区域内行进,并创建工作区域内的地图。
当然,本发明实施例是在移动机器人上进行所述步骤S2-S6。本发明实施例不限于在移动机器人上,也可以在服务器或其他终端进行步骤S2-S6。
以上所揭露的仅为本发明较佳实施例而已,当然不能以此来限定本发明之权利范围,因此依本发明权利要求所作的等同变化,仍属本发明所涵盖的范围。
Claims (10)
1.一种基于激光测距传感器的移动机器人的地图创建方法,其特征在于,包括以下步骤:
S1:以移动机器人前进方向为参考建立直角坐标系,移动机器人的激光测距传感器扫描工作区域获取激光数据点;
S2:对激光数据点进行数据分块;
S3:在数据分块中提取角点信息;
S4:根据角点信息提取线段信息;
S5:根据线段信息修改直角坐标系;
S6:根据修改的直角坐标系在工作区域内创建地图;
所述步骤S3包括如下子步骤:
S31:将第一个数据分块作为当前数据分块,计算当前数据分块中数据点的数量;
S32:判断当前数据分块中数据点的数量与M的大小,若当前数据分块中数据点的数量小于或等于M,进入步骤S33;若当前数据分块中数据点的数量大于M,进入步骤S34;
S33:将当前数据分块的两端点作为角点;
S34:选择当前数据分块中两端点拟合直线L,计算当前数据分块中的除两端点外的其他数据点到直线L的距离;
S35:判断数据点到直线L的最大距离DL与N的大小,若最大距离DL小于或等于N,则进入步骤S33;若最大距离DL大于N,则进入步骤S36;
S36:以距离所述直线L最远的点为界将当前数据分块分为两个新的数据分块,进入步骤S31;
S37:通过重复步骤S31-S36,遍历其他数据分块直到获得所有数据分块中的角点信息。
2.根据权利要求1所述的基于激光测距传感器的移动机器人的地图创建方法,其特征在于,在移动机器人、服务器或其他终端进行所述步骤S2-S6。
3.根据权利要求1所述的基于激光测距传感器的移动机器人的地图创建方法,其特征在于,所述步骤S2包括以下子步骤:
S21:将激光数据点中的第一个点作为第一个数据分块的第一个点;
S22:计算下一点与第一个数据分块上一点的距离,若距离小于设定的阈值Q,则判断下一点属于第一个分块;当距离大于设定的阈值Q,则将下一点作为新数据分块的第一个点;
S23:重复上述步骤直到对所有激光数据点完成数据分块;
S24:判断第一个点是否属于最后一个数据分块,若属于最后一个数据分块,则将最后一个数据分块和第一个数据分块合并。
4.根据权利要求3所述的基于激光测距传感器的移动机器人的地图创建方法,其特征在于,所述Q为基于数据点与激光测距传感器的距离来确定的动态阈值。
5.根据权利要求1所述的基于激光测距传感器的移动机器人的地图创建方法,其特征在于,所述M的值为3。
6.根据权利要求1所述的基于激光测距传感器的移动机器人的地图创建方法,其特征在于,所述N的值为0.03米。
7.根据权利要求1所述的基于激光测距传感器的移动机器人的地图创建方法,其特征在于,所述步骤S4包括如下子步骤:
S41:计算每个分块中两角点之间的数据点的数量;
S42:判断两角点之间的数据点的数量与P的大小,若两角点之间的数据点的数量小于或者等于P,进入步骤S43;若两角点之间的数据点的数量大于P,进入步骤S44;
S43:判断数据分块中的数据点数量太少,不拟合成直线;
S44:将数据分块中的数据点进行直线拟合获取相应的线段信息。
8.根据权利要求7所述的基于激光测距传感器的移动机器人的地图创建方法,其特征在于,所述P的值为3。
9.根据权利要求1所述的基于激光测距传感器的移动机器人的地图创建方法,其特征在于,所述步骤S5包括如下子步骤:
S51:选择长度最长的K条线段;
S52:计算K条线段之间的相互角度是否满足角度阈值Y;
S53:根据线段长度排序及与其他线段之间的角度关系确定坐标参考线段;
S54:根据坐标参考线段修改直角坐标系。
10.根据权利要求9所述的基于激光测距传感器的移动机器人的地图创建方法,其特征在于,所述K的值为10。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810116061.2A CN108387234B (zh) | 2018-02-06 | 2018-02-06 | 基于激光测距传感器的移动机器人的地图创建方法 |
PCT/CN2019/073145 WO2019154119A1 (zh) | 2018-02-06 | 2019-01-25 | 基于激光测距传感器的移动机器人的地图创建方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810116061.2A CN108387234B (zh) | 2018-02-06 | 2018-02-06 | 基于激光测距传感器的移动机器人的地图创建方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108387234A CN108387234A (zh) | 2018-08-10 |
CN108387234B true CN108387234B (zh) | 2022-04-19 |
Family
ID=63075130
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810116061.2A Active CN108387234B (zh) | 2018-02-06 | 2018-02-06 | 基于激光测距传感器的移动机器人的地图创建方法 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN108387234B (zh) |
WO (1) | WO2019154119A1 (zh) |
Families Citing this family (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108387234B (zh) * | 2018-02-06 | 2022-04-19 | 广州科语机器人有限公司 | 基于激光测距传感器的移动机器人的地图创建方法 |
WO2020041075A1 (en) * | 2018-08-20 | 2020-02-27 | Zodiac Pool Systems Llc | Mapping and tracking methods and systems principally for use in connection with swimming pools and spas |
CN109186463B (zh) * | 2018-09-04 | 2021-12-07 | 浙江梧斯源通信科技股份有限公司 | 应用于可移动机器人的防跌落方法 |
CN110335282B (zh) * | 2018-12-25 | 2023-04-18 | 广州启明星机器人有限公司 | 一种基于栅格的轮廓线段特征提取方法 |
CN109696168A (zh) * | 2019-02-27 | 2019-04-30 | 沈阳建筑大学 | 一种基于激光传感器的移动机器人几何地图创建方法 |
CN110597249B (zh) * | 2019-08-23 | 2022-08-05 | 深圳市优必选科技股份有限公司 | 一种机器人及其回充定位方法和装置 |
CN112747734B (zh) * | 2019-10-31 | 2024-04-30 | 深圳拓邦股份有限公司 | 环境地图方向调整方法、系统及装置 |
CN111595340B (zh) * | 2020-04-20 | 2023-03-21 | 广东博智林机器人有限公司 | 路径确定方法、装置及电子设备 |
CN111595356B (zh) * | 2020-04-27 | 2021-11-09 | 珠海一微半导体股份有限公司 | 一种激光导航机器人的工作区域构建方法 |
CN111947657B (zh) * | 2020-06-12 | 2024-04-19 | 南京邮电大学 | 一种适用于密集排架环境的移动机器人导航方法 |
CN111578949B (zh) * | 2020-07-03 | 2023-07-25 | 筑石科技(湖州)有限公司 | 室内定位方法及装置、存储介质和电子装置 |
CN112247988A (zh) * | 2020-09-29 | 2021-01-22 | 南京理工大学 | 基于激光雷达对移动机器人自主充电的方法 |
CN112515560B (zh) * | 2020-11-06 | 2022-08-05 | 珠海一微半导体股份有限公司 | 通过激光数据获取清扫方向的方法、芯片和机器人 |
CN112773272B (zh) * | 2020-12-29 | 2022-10-18 | 深圳市杉川机器人有限公司 | 移动方向确定方法、装置、扫地机器人和存储介质 |
CN112859836A (zh) * | 2020-12-30 | 2021-05-28 | 广东美的白色家电技术创新中心有限公司 | 一种自主移动设备、校正方法及计算机存储介质 |
CN113268061A (zh) * | 2021-05-14 | 2021-08-17 | 深圳中智永浩机器人有限公司 | 机器人底盘多点导航方法、装置、计算机设备及存储介质 |
CN113238560A (zh) * | 2021-05-24 | 2021-08-10 | 珠海市一微半导体有限公司 | 基于线段信息的机器人旋转地图方法 |
CN114202506A (zh) * | 2021-10-28 | 2022-03-18 | 北京自动化控制设备研究所 | 基于标准廓形约束的激光扫描图像异常处理方法 |
CN114365974B (zh) * | 2022-01-26 | 2023-01-10 | 微思机器人(深圳)有限公司 | 一种室内清洁分区方法、装置和扫地机器人 |
CN115905451B (zh) * | 2023-02-28 | 2023-05-12 | 菲特(天津)检测技术有限公司 | 一种地图聚合系统及聚合方法 |
CN116700262B (zh) * | 2023-06-19 | 2024-03-15 | 国广顺能(上海)能源科技有限公司 | 移动机器人的自动回充控制方法、装置、设备及介质 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8948913B2 (en) * | 2009-10-26 | 2015-02-03 | Electronics And Telecommunications Research Institute | Method and apparatus for navigating robot |
CN103198751B (zh) * | 2013-03-06 | 2015-03-04 | 南京邮电大学 | 一种移动机器人基于激光测距仪的线特征地图创建方法 |
CN103941264B (zh) * | 2014-03-26 | 2017-04-19 | 南京航空航天大学 | 一种室内未知环境下使用激光雷达定位方法 |
CN104501811A (zh) * | 2014-11-24 | 2015-04-08 | 杭州申昊科技股份有限公司 | 一种基于环境直线特征的地图匹配方法 |
CN105975975B (zh) * | 2016-05-20 | 2019-06-21 | 中国科学技术大学 | 一种环境线特征提取方法 |
CN106959695B (zh) * | 2017-04-24 | 2019-08-02 | 广东宝乐机器人股份有限公司 | 移动机器人在工作区域内的角度修正方法及移动机器人 |
CN107133545A (zh) * | 2017-06-08 | 2017-09-05 | 东北大学 | 一种立体条码、识别方法及室内辅助地图构建方法 |
CN107976194B (zh) * | 2017-11-24 | 2021-12-21 | 北京奇虎科技有限公司 | 环境地图的调整方法及装置 |
CN108387234B (zh) * | 2018-02-06 | 2022-04-19 | 广州科语机器人有限公司 | 基于激光测距传感器的移动机器人的地图创建方法 |
-
2018
- 2018-02-06 CN CN201810116061.2A patent/CN108387234B/zh active Active
-
2019
- 2019-01-25 WO PCT/CN2019/073145 patent/WO2019154119A1/zh active Application Filing
Also Published As
Publication number | Publication date |
---|---|
WO2019154119A1 (zh) | 2019-08-15 |
CN108387234A (zh) | 2018-08-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108387234B (zh) | 基于激光测距传感器的移动机器人的地图创建方法 | |
CN105865449B (zh) | 基于激光和视觉的移动机器人的混合定位方法 | |
US11877716B2 (en) | Determining region attribute | |
US11385067B2 (en) | Route planning method for mobile vehicle | |
US10217207B2 (en) | System and method for structural inspection and construction estimation using an unmanned aerial vehicle | |
CN113467456B (zh) | 一种未知环境下用于特定目标搜索的路径规划方法 | |
CN108733061B (zh) | 一种清扫作业的路径修正方法 | |
CN104035444A (zh) | 机器人地图构建存储方法 | |
US20220215622A1 (en) | Automated three-dimensional building model estimation | |
CN109459052B (zh) | 一种扫地机全覆盖路径规划方法 | |
CN111667574B (zh) | 从倾斜摄影模型自动重建建筑物规则立面三维模型的方法 | |
US20230292657A1 (en) | Robotic tool system and control method thereof | |
CN110955262A (zh) | 光伏组件清洁机器人的路径规划与跟踪的控制方法及系统 | |
CN110895334A (zh) | 基于激光雷达和gps融合虚拟墙无人清扫车校准装置及方法 | |
WO2020199580A9 (zh) | 一种机器人回座代码的自动生成方法 | |
CN114035572A (zh) | 一种割草机器人的避障巡回方法及系统 | |
CN112528444A (zh) | 一种输电线路三维设计方法及系统 | |
CN115290097A (zh) | 基于bim的实时精确地图构建方法、终端及存储介质 | |
CN112149911A (zh) | 一种超敏捷卫星同轨多点目标动中成像任务规划方法 | |
Atas et al. | Elevation state-space: Surfel-based navigation in uneven environments for mobile robots | |
CN115719409A (zh) | 点云建图方法、计算机设备及计算机可读存储介质 | |
CN115268461A (zh) | 一种融合算法的移动机器人自主导航方法 | |
CN113358129B (zh) | 基于Voronoi图的避障最短路径规划方法 | |
CN110716554B (zh) | 基于视觉的家庭机器人 | |
CN115718482A (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 | ||
PE01 | Entry into force of the registration of the contract for pledge of patent right |
Denomination of invention: Map creation method of mobile robot based on laser ranging sensor Effective date of registration: 20220525 Granted publication date: 20220419 Pledgee: Bank of China Limited by Share Ltd. Guangzhou Panyu branch Pledgor: GUANGZHOU COAYU ROBOT Co.,Ltd. Registration number: Y2022980006324 |
|
PE01 | Entry into force of the registration of the contract for pledge of patent right | ||
PP01 | Preservation of patent right |
Effective date of registration: 20230320 Granted publication date: 20220419 |
|
PP01 | Preservation of patent right |