CN108888188B - 扫地机器人位置校准方法及系统 - Google Patents
扫地机器人位置校准方法及系统 Download PDFInfo
- Publication number
- CN108888188B CN108888188B CN201810613920.9A CN201810613920A CN108888188B CN 108888188 B CN108888188 B CN 108888188B CN 201810613920 A CN201810613920 A CN 201810613920A CN 108888188 B CN108888188 B CN 108888188B
- Authority
- CN
- China
- Prior art keywords
- angle
- image
- ceiling
- line
- sweeping robot
- 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
-
- 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/24—Floor-sweeping machines, motor-driven
-
- 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
-
- 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/4002—Installations of electric equipment
Landscapes
- Image Analysis (AREA)
- Manipulator (AREA)
Abstract
本发明涉及扫地机器人技术领域,特别涉及一种扫地机器人位置校准方法及系统。所述方法包括:在扫地机器人工作过程中,获取第一图像和第二图像,所述第一图像为第一时刻拍摄的天花板图像,所述第二图像为第二时刻拍摄的天花板图像;获取第一角度、第二角度以及第三角度,所述第一角度为所述第一图像中的第一直线与边界线之间的角度,所述第二角度为所述第二图像中的所述第一直线与所述边界线之间的角度,所述第三角度为所述扫地机器人从所述第一时刻至所述第二时刻旋转的角度;将所述第二角度与所述第一角度的角度差与所述第三角度比较,校准所述扫地机器人位置信息。旨在解决现有的扫地机器人出现定位不准确的问题。
Description
技术领域
本发明涉及扫地机器人技术领域,特别涉及一种扫地机器人位置校准方法及系统。
背景技术
扫地机器人,又称自动打扫机、智能吸尘、机器人吸尘器等,是智能家用电器的一种,能凭借一定的人工智能,自动在房间内完成地板清理工作。一般采用刷扫和真空方式,将地面杂物先吸纳进入自身的垃圾收纳盒,从而完成地面清理的功能。一般来说,将完成清扫、吸尘、擦地工作的机器人,也统一归为扫地机器人。
随着扫地机器人应用的普及,市场上出现了很多种类的扫地机器人,然而由于家庭环境复杂性的提升或者其它因素,扫地机器人无可避免地会出现定位不准确的现象。
发明内容
针对现有技术不足,本发明提出一种扫地机器人位置校准方法及系统,通过第一图像、第二图像中的第一直线与边界线之间角度得到第一角度和第二角度,获取扫地机器人从第一时刻至第二时刻旋转的角度为第三角度,根据第一角度与第二角度的角度差与第三角度比较,校准扫地机器人位置信息,旨在解决现有的扫地机器人出现定位不准确的问题。
本发明提出的技术方案是:
一种扫地机器人位置校准方法,所述方法包括:
在扫地机器人工作过程中,获取第一图像和第二图像,所述第一图像为第一时刻拍摄的天花板图像,所述第二图像为第二时刻拍摄的天花板图像;
获取第一角度、第二角度以及第三角度,所述第一角度为所述第一图像中的第一直线与边界线之间的角度,所述第二角度为所述第二图像中的所述第一直线与所述边界线之间的角度,所述第三角度为所述扫地机器人从所述第一时刻至所述第二时刻旋转的角度;
将所述第二角度与所述第一角度的角度差与所述第三角度比较,校准所述扫地机器人位置信息。
进一步地,在所述获取第一角度的步骤中,包括:
检测所述第一图像的天花板线条;
若所述天花板线条为多个,则从所述天花板线条中选取一个目标天花板线条;
获取目标天花板线条与边界线之间的第一角度。
进一步地,在所述获取第二角度的步骤中,包括:
检测所述第二图像的天花板线条;
判断所述第二图像的天花板线条中是否存在与所述目标天花板线条匹配的天花板线条;
若存在,则获取所匹配的天花板线条与边界线之间的第二角度。
进一步地,在所述将所述第二角度与所述第一角度的角度差与所述第三角度比较,校准所述扫地机器人位置信息的步骤中,包括:
将所述第二角度与所述第一角度的角度差与所述第三角度比较,获得偏差角度;
若所述偏差角度小于或者等于预设阈值,则待所述扫地机器人完成工作任务之后,执行校准所述扫地机器人位置信息;
若所述偏差角度大于预设阈值,则暂停所述扫地机器人当前工作,执行校准所述扫地机器人位置信息。
进一步地,在所述获取第一角度、第二角度以及第三角度的步骤之前,所述方法包括:
判断所述第一图像和所述第二图像中是否均存在符合预设条件的天花板线条;
若均存在,则执行所述获取第一角度、第二角度以及第三角度的步骤。
本发明还提供一种扫地机器人位置校准系统,所述系统包括:
图像获取模块,用于在扫地机器人工作过程中,获取第一图像和第二图像,所述第一图像为第一时刻拍摄的天花板图像,所述第二图像为第二时刻拍摄的天花板图像;
角度获取模块,用于获取第一角度、第二角度以及第三角度,所述第一角度为所述第一图像中的第一直线与边界线之间的角度,所述第二角度为所述第二图像中的所述第一直线与所述边界线之间的角度,所述第三角度为所述扫地机器人从所述第一时刻至所述第二时刻旋转的角度;
校准模块,用于将所述第二角度与所述第一角度的角度差与所述第三角度比较,校准所述扫地机器人位置信息。
进一步地,所述角度获取模块包括:
第一检测模块,用于检测所述第一图像的天花板线条;
第一选取模块,用于若所述天花板线条为多个,则从所述天花板线条中选取一个目标天花板线条;
第一角度获取模块,用于获取目标天花板线条与边界线之间的第一角度。
进一步地,所述角度获取模块包括:
第二检测模块,用于检测所述第二图像的天花板线条;
第二判断模块,用于判断所述第二图像的天花板线条中是否存在与所述目标天花板线条匹配的天花板线条;
第二角度获取模块,用于若存在,则获取所匹配的天花板线条与边界线之间的第二角度。
进一步地,所述校准模块包括:
偏差角度获取模块,用于将所述第二角度与所述第一角度的角度差与所述第三角度比较,获得偏差角度;
第一执行模块,用于若所述偏差角度小于或者等于预设阈值,则待所述扫地机器人完成工作任务之后,执行校准所述扫地机器人位置信息;
第二执行模块,用于若所述偏差角度大于预设阈值,则暂停所述扫地机器人当前工作,执行校准所述扫地机器人位置信息。
进一步地,所述系统包括:
判断模块,用于判断所述第一图像和所述第二图像中是否均存在符合预设条件的天花板线条;若均存在,则执行所述角度获取模块获取第一角度、第二角度以及第三角度的步骤。
根据上述的技术方案,本发明有益效果:通过第一图像、第二图像中的第一直线与边界线之间角度得到第一角度和第二角度,获取扫地机器人从第一时刻至第二时刻旋转的角度为第三角度,根据第一角度与第二角度的角度差与第三角度比较,校准扫地机器人位置信息,旨在解决现有的扫地机器人出现定位不准确的问题。
附图说明
图1是应用本发明实施例提供的扫地机器人位置校准方法的流程图;
图2是应用本发明实施例提供的扫地机器人位置校准系统的功能模块图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
如图1所示,本发明实施例提出扫地机器人位置校准方法,所述方法包括以下步骤:
步骤S101、在扫地机器人工作过程中,获取第一图像和第二图像,第一图像为第一时刻拍摄的天花板图像,第二图像为第二时刻拍摄的天花板图像。
摄像头与扫地机器人电连接,摄像头设于扫地机器人上,其摄像口朝上,用于拍摄天花板。在扫地机器人工作过程中,在第一时刻使用摄像头拍摄天花板,从而获取第一图像,在第二时刻使用摄像头拍摄天花板,从而获取第二图像。其中天花板的构造为规则分布的线条。例如,水平线条、或者垂直线条、或者纵横交错的线条。
具体地,摄像头正对天花板设于扫地机器人上。
在本实施例中,通过广角摄像头拍摄天花板。
在本实施例中,第二图像中的拍摄到天花板范围与第一图像中的拍摄到天花板范围相同,都是整个天花板的图像。
步骤S102、获取第一角度、第二角度以及第三角度,第一角度为第一图像中的第一直线与边界线之间的角度,第二角度为第二图像中的第一直线与边界线之间的角度,第三角度为扫地机器人从第一时刻至第二时刻旋转的角度。
在获取第一图像之后,根据第一图像,获取第一角度,第一角度是第一图像中第一直线与边界线之间的角度。
在获取第二图像之后,根据第二图像,获取第二角度,第二角度是第二图像中第一直线与边界线之间的角度。
扫地机器人自身旋转的角度都会有记录,从扫地机器人系统中获取从第一时刻至第二时刻旋转的角度,从第一时刻至第二时刻旋转的角度为第三角度。
在所述获取第一角度的步骤中,包括:
检测第一图像的天花板线条;
若天花板线条为多个,则从天花板线条中选取一个目标天花板线条;
获取目标天花板线条与边界线之间的第一角度。
在本实施例中,采用霍夫变换技术检测第一图像的线条,在检测出第一图像的天花板线条为多个时,从天花板线条中选取一个目标天花板线条,以目标天花板线条为对象,计算目标天花板线条与边界线之间的角度,目标天花板线条与边界线之间的角度为第一角度,从而获取第一角度。
在所述获取第二角度的步骤中,包括:
检测第二图像的天花板线条;
判断第二图像的天花板线条中是否存在与目标天花板线条匹配的天花板线条;
若存在,则获取所匹配的天花板线条与边界线之间的第二角度。
在本实施例中,采用霍夫变换技术检测第二图像的天花板线条,在检测出天花板线条之后,基于单应矩阵的直线匹配技术判断第二图像的天花板线条中是否存在与目标天花板线条匹配的天花板线条,与目标天花板线条匹配的天花板线条可以是目标天花板线条,还可以是与目标天花板线条平行的天花板线条。在判断存在之后,选取与目标天花板线条匹配的天花板线条,然后计算已选取与目标天花板线条匹配的天花板线条与边界线之间的角度,已选取与目标天花板线条匹配的天花板线条与边界线之间的角度为第二角度,从而获取第二角度。
在一些实施例中,采用霍夫变换技术检测第二图像的天花板线条,在检测出天花板线条之后,角度直方图法先计算第一图像与第二图像之间转动的角度,根据转动的角度,判断第二图像的天花板线条中是否存在与目标天花板线条匹配的天花板线条,与目标天花板线条匹配的天花板线条可以是目标天花板线条,还可以是与目标天花板线条平行的天花板线条。在判断存在之后,选取与目标天花板线条匹配的天花板线条,然后计算已选取与目标天花板线条匹配的天花板线条与边界线之间的角度,已选取与目标天花板线条匹配的天花板线条与边界线之间的角度为第二角度,从而获取第二角度。
角度直方图法分为如下两步:
1.边缘梯度方向的提取。
与Sobel、Roberts、Laplace等边缘提取算子相比,Canny算子提取的边缘具有较好的稳健性和精确性,经常被用于边缘提取。因此,本文用Canny算子提取图像的边缘,得出边缘点的位置、强度和梯度方向。设图像的灰度函数为f(x,y),对于数字图像,图像的微分用差分替代,因此坐标为(x,y)的边缘点u的强度M(u)和梯度方向A(u)的计算公式如下:
M(u)=[(fx(x,y))2+(fy(x,y))2]1/2
A(u)=arctan[(fy(x,y))/(fx(x,y))]
式中,fx(x,y)=f(x+1,y)-f(x-1,y),fy(x,y)=f(x,y+1)-f(x,y-1)
2.角度直方图表决法。
使式中Δθi,j的变化范围是0°~359°,统计Δθ的直方图H(Δθ)。如果f1中边缘点是对应点,则这两点之间的梯度方向差Δθm,n一定是两图像间旋转角度的近似值。所有由对应边缘点对计算出的角度将会聚集在图像旋转角度的真实值附近,而非对应边缘点的角度差是随机的,所以H(Δθ)将在真实值附近形成峰值。因此,不用事先确定f1和f2中边缘点的对应关系,通过上述的表决过程即可估计出两图像间的旋转角度 是H(Δθ)最大峰值所对应的角度,可用下式表示:
步骤S103、将第二角度与第一角度的角度差与第三角度比较,校准扫地机器人位置信息。
计算第二角度与第一角度的角度差,之后将角度差与第三角度进行比较,根据比较结果校准扫地机器人位置信息。
在本实施例中,在步骤S103中,包括:
将第二角度与第一角度的角度差与第三角度比较,获得偏差角度;
若偏差角度小于或者等于预设阈值,则待扫地机器人完成工作任务之后,执行校准扫地机器人位置信息;
若偏差角度大于预设阈值,则暂停扫地机器人当前工作,执行校准扫地机器人位置信息。
计算第二角度与第一角度的角度差,之后将角度差与第三角度进行比较,获得偏差角度,将偏差角度与预设阈值进行比较,若偏差角度小于或者等于预设阈值,则待扫地机器人完成工作任务之后,执行校准扫地机器人位置信息;若偏差角度大于预设阈值,则暂停扫地机器人当前工作,执行校准扫地机器人位置信息。
在一些实施例中,在步骤S103中,包括:
将第二角度与第一角度的角度差与第三角度比较,获得偏差角度;
若偏差角度小于或者等于预设阈值,则不需要执行校准扫地机器人位置信息;
若偏差角度大于预设阈值,则需要执行校准扫地机器人位置信息。
计算第二角度与第一角度的角度差,之后将角度差与第三角度进行比较,获得偏差角度,将偏差角度与预设阈值进行比较,若偏差角度小于或者等于预设阈值,则不需要执行校准扫地机器人位置信息;若偏差角度大于预设阈值,则需要执行校准扫地机器人位置信息。
在步骤S102之前,所述方法包括:
判断所述第一图像和所述第二图像中是否均存在符合预设条件的天花板线条;
若均存在,则执行所述获取第一角度、第二角度以及第三角度的步骤。
在获取第一角度、第二角度以及第三角度之前,需要先判断第一图像和第二图像中是否存在符合预设条件的天花板线条,即判断天花板的构造是否包含规则分布的线条,例如水平线条或垂直线条。若天花板的构造包含规则分布的线条,扫地机器人才会依据规则分布的线条确定第一角度和第二角度,否则,考虑到计算第一角度和第二角度的误差会过大,扫地机器人不会执行获取第一角度和第二角度的动作。
在一些实施例中,扫地机器人在开始工作前,会先判断天花板的构造是否包含规则分布的线条,比如通过内置摄像头对天花板进行拍摄,判定天花板构造是否包含规则分布的线条。在确定天花板的构造包含规则分布的线条后,再执行步骤S101。
综上所述,通过第一图像、第二图像中的第一直线与边界线之间角度得到第一角度和第二角度,获取扫地机器人从第一时刻至第二时刻旋转的角度为第三角度,根据第一角度与第二角度的角度差与第三角度比较,校准扫地机器人位置信息,旨在解决现有的扫地机器人出现定位不准确的问题。
如图2所示,本发明实施例提出扫地机器人位置校准系统1,系统1包括图像获取模块11、角度获取模块12和校准模块13。
图像获取模块11,用于在扫地机器人工作过程中,获取第一图像和第二图像,第一图像为第一时刻拍摄的天花板图像,第二图像为第二时刻拍摄的天花板图像。
摄像头与扫地机器人电连接,摄像头设于扫地机器人上,其摄像口朝上,用于拍摄天花板。在扫地机器人工作过程中,在第一时刻使用摄像头拍摄天花板,从而获取第一图像,在第二时刻使用摄像头拍摄天花板,从而获取第二图像。其中天花板的构造为规则分布的线条。例如,水平线条、或者垂直线条、或者纵横交错的线条。
具体地,摄像头正对天花板设于扫地机器人上。
在本实施例中,通过广角摄像头拍摄天花板。
在本实施例中,第二图像中的拍摄到天花板范围与第一图像中的拍摄到天花板范围相同,都是整个天花板的图像。
角度获取模块12,用于获取第一角度、第二角度以及第三角度,第一角度为第一图像中的第一直线与边界线之间的角度,第二角度为第二图像中的第一直线与边界线之间的角度,第三角度为扫地机器人从第一时刻至第二时刻旋转的角度。
在获取第一图像之后,根据第一图像,获取第一角度,第一角度是第一图像中第一直线与边界线之间的角度。
在获取第二图像之后,根据第二图像,获取第二角度,第二角度是第二图像中第一直线与边界线之间的角度。
扫地机器人自身旋转的角度都会有记录,从扫地机器人系统中获取从第一时刻至第二时刻旋转的角度,从第一时刻至第二时刻旋转的角度为第三角度。
角度获取模块12包括:
第一检测模块,用于检测第一图像的天花板线条;
第一选取模块,用于若天花板线条为多个,则从天花板线条中选取一个目标天花板线条;
第一角度获取模块,用于获取目标天花板线条与边界线之间的第一角度。
在本实施例中,采用霍夫变换技术检测第一图像的线条,在检测出第一图像的天花板线条为多个时,从天花板线条中选取一个目标天花板线条,以目标天花板线条为对象,计算目标天花板线条与边界线之间的角度,目标天花板线条与边界线之间的角度为第一角度,从而获取第一角度。
角度获取模块12包括:
第二检测模块,用于检测第二图像的天花板线条;
第二判断模块,用于判断第二图像的天花板线条中是否存在与目标天花板线条匹配的天花板线条;
第二角度获取模块,用于若存在,则获取所匹配的天花板线条与边界线之间的第二角度。
在本实施例中,采用霍夫变换技术检测第二图像的天花板线条,在检测出天花板线条之后,基于单应矩阵的直线匹配技术判断第二图像的天花板线条中是否存在与目标天花板线条匹配的天花板线条,与目标天花板线条匹配的天花板线条可以是目标天花板线条,还可以是与目标天花板线条平行的天花板线条。在判断存在之后,选取与目标天花板线条匹配的天花板线条,然后计算已选取与目标天花板线条匹配的天花板线条与边界线之间的角度,已选取与目标天花板线条匹配的天花板线条与边界线之间的角度为第二角度,从而获取第二角度。
在一些实施例中,采用霍夫变换技术检测第二图像的天花板线条,在检测出天花板线条之后,角度直方图法先计算第一图像与第二图像之间转动的角度,根据转动的角度,判断第二图像的天花板线条中是否存在与目标天花板线条匹配的天花板线条,与目标天花板线条匹配的天花板线条可以是目标天花板线条,还可以是与目标天花板线条平行的天花板线条。在判断存在之后,选取与目标天花板线条匹配的天花板线条,然后计算已选取与目标天花板线条匹配的天花板线条与边界线之间的角度,已选取与目标天花板线条匹配的天花板线条与边界线之间的角度为第二角度,从而获取第二角度。
角度直方图法分为如下两步:
1.边缘梯度方向的提取。
与Sobel、Roberts、Laplace等边缘提取算子相比,Canny算子提取的边缘具有较好的稳健性和精确性,经常被用于边缘提取。因此,本文用Canny算子提取图像的边缘,得出边缘点的位置、强度和梯度方向。设图像的灰度函数为f(x,y),对于数字图像,图像的微分用差分替代,因此坐标为(x,y)的边缘点u的强度M(u)和梯度方向A(u)的计算公式如下:
M(u)=[(fx(x,y))2+(fy(x,y))2]1/2
A(u)=arctan[(fy(x,y))/(fx(x,y))]
式中,fx(x,y)=f(x+1,y)-f(x-1,y),fy(x,y)=f(x,y+1)-f(x,y-1)
2.角度直方图表决法。
使式中Δθi,j的变化范围是0°~359°,统计Δθ的直方图H(Δθ)。如果f1中边缘点是对应点,则这两点之间的梯度方向差Δθm,n一定是两图像间旋转角度的近似值。所有由对应边缘点对计算出的角度将会聚集在图像旋转角度的真实值附近,而非对应边缘点的角度差是随机的,所以H(Δθ)将在真实值附近形成峰值。因此,不用事先确定f1和f2中边缘点的对应关系,通过上述的表决过程即可估计出两图像间的旋转角度 是H(Δθ)最大峰值所对应的角度,可用下式表示:
校准模块13,用于将第二角度与第一角度的角度差与第三角度比较,校准扫地机器人位置信息。
计算第二角度与第一角度的角度差,之后将角度差与第三角度进行比较,根据比较结果校准扫地机器人位置信息。
在本实施例中,校准模块13包括:
偏差角度获取模块,用于将第二角度与第一角度的角度差与第三角度比较,获得偏差角度;
第一执行模块,用于若偏差角度小于或者等于预设阈值,则待扫地机器人完成工作任务之后,执行校准扫地机器人位置信息;
第二执行模块,用于若偏差角度大于预设阈值,则暂停扫地机器人当前工作,执行校准扫地机器人位置信息。
计算第二角度与第一角度的角度差,之后将角度差与第三角度进行比较,获得偏差角度,将偏差角度与预设阈值进行比较,若偏差角度小于或者等于预设阈值,则待扫地机器人完成工作任务之后,执行校准扫地机器人位置信息;若偏差角度大于预设阈值,则暂停扫地机器人当前工作,执行校准扫地机器人位置信息。
在一些实施例中,校准模块13包括:
第一偏差角度获取模块,用于将第二角度与第一角度的角度差与第三角度比较,获得偏差角度;
第二执行模块,用于若偏差角度小于或者等于预设阈值,则不需要执行校准扫地机器人位置信息;以及若偏差角度大于预设阈值,则需要执行校准扫地机器人位置信息。
计算第二角度与第一角度的角度差,之后将角度差与第三角度进行比较,获得偏差角度,将偏差角度与预设阈值进行比较,若偏差角度小于或者等于预设阈值,则不需要执行校准扫地机器人位置信息;若偏差角度大于预设阈值,则需要执行校准扫地机器人位置信息。
系统1还包括:
判断模块,用于判断第一图像和第二图像中是否均存在符合预设条件的天花板线条;
若均存在,则执行上述角度获取模块获取第一角度、第二角度以及第三角度的步骤。
在获取第一角度、第二角度以及第三角度之前,需要先判断第一图像和第二图像中是否存在符合预设条件的天花板线条,即判断天花板的构造是否包含规则分布的线条,例如水平线条或垂直线条。若天花板的构造包含规则分布的线条,扫地机器人才会依据规则分布的线条确定第一角度和第二角度,否则,考虑到计算第一角度和第二角度的误差会过大,扫地机器人不会执行获取第一角度和第二角度的动作。
在一些实施例中,扫地机器人在开始工作前,会先判断天花板的构造是否包含规则分布的线条,比如通过内置摄像头对天花板进行拍摄,判定天花板构造是否包含规则分布的线条。在确定天花板的构造包含规则分布的线条后,再执行图像获取模块11的动作。
综上所述,通过第一图像、第二图像中的第一直线与边界线之间角度得到第一角度和第二角度,获取扫地机器人从第一时刻至第二时刻旋转的角度为第三角度,根据第一角度与第二角度的角度差与第三角度比较,校准扫地机器人位置信息,旨在解决现有的扫地机器人出现定位不准确的问题。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (6)
1.一种扫地机器人位置校准方法,其特征在于,所述方法包括:
在扫地机器人工作过程中,获取第一图像和第二图像,所述第一图像为第一时刻拍摄的天花板图像,所述第二图像为第二时刻拍摄的天花板图像;
获取第一角度、第二角度以及第三角度,所述第一角度为所述第一图像中的第一直线与边界线之间的角度,所述第二角度为所述第二图像中的所述第一直线与所述边界线之间的角度,所述第三角度为所述扫地机器人从所述第一时刻至所述第二时刻旋转的角度;
将所述第二角度与所述第一角度的角度差与所述第三角度比较,校准所述扫地机器人位置信息;
在所述获取第一角度的步骤中,包括:
检测所述第一图像的天花板线条;
若所述天花板线条为多个,则从所述天花板线条中选取一个目标天花板线条;
获取目标天花板线条与边界线之间的第一角度;
在所述获取第二角度的步骤中,包括:
检测所述第二图像的天花板线条;
判断所述第二图像的天花板线条中是否存在与所述目标天花板线条匹配的天花板线条;
若存在,则获取所匹配的天花板线条与边界线之间的第二角度;
其中,所述匹配的天花板线条为所述目标天花板线条或者与所述目标天花板线条平行的线条;
所述第二角度与所述第一角度的角度差计算方式为:
设图像的灰度函数为f(x,y),对于数字图像,图像的微分用差分替代,因此坐标为(x,y)的边缘点u的强度M(u)和梯度方向A(u)的计算公式如下:
M(u)=[(fx(x,y))2+(fy(x,y))2]1/2
A(u)=arctan[(fy(x,y))/(fx(x,y))]
式中,
fx(x,y)=f(x+1,y)-f(x-1,y),fy(x,y)=f(x,y+1)-f(x,y-1)
2.根据权利要求1所述的扫地机器人位置校准方法,其特征在于,在所述将所述第二角度与所述第一角度的角度差与所述第三角度比较,校准所述扫地机器人位置信息的步骤中,包括:
将所述第二角度与所述第一角度的角度差与所述第三角度比较,获得偏差角度;
若所述偏差角度小于或者等于预设阈值,则待所述扫地机器人完成工作任务之后,执行校准所述扫地机器人位置信息;
若所述偏差角度大于预设阈值,则暂停所述扫地机器人当前工作,执行校准所述扫地机器人位置信息。
3.根据权利要求1-2任一项所述的扫地机器人位置校准方法,其特征在于,在所述获取第一角度、第二角度以及第三角度的步骤之前,所述方法包括:
判断所述第一图像和所述第二图像中是否均存在符合预设条件的天花板线条;
若均存在,则执行所述获取第一角度、第二角度以及第三角度的步骤。
4.一种扫地机器人位置校准系统,其特征在于,所述系统包括:
图像获取模块,用于在扫地机器人工作过程中,获取第一图像和第二图像,所述第一图像为第一时刻拍摄的天花板图像,所述第二图像为第二时刻拍摄的天花板图像;
角度获取模块,用于获取第一角度、第二角度以及第三角度,所述第一角度为所述第一图像中的第一直线与边界线之间的角度,所述第二角度为所述第二图像中的所述第一直线与所述边界线之间的角度,所述第三角度为所述扫地机器人从所述第一时刻至所述第二时刻旋转的角度;
校准模块,用于将所述第二角度与所述第一角度的角度差与所述第三角度比较,校准所述扫地机器人位置信息;
所述角度获取模块包括:
第一检测模块,用于检测所述第一图像的天花板线条;
第一选取模块,用于若所述天花板线条为多个,则从所述天花板线条中选取一个目标天花板线条;
第一角度获取模块,用于获取目标天花板线条与边界线之间的第一角度;
所述角度获取模块包括:
第二检测模块,用于检测所述第二图像的天花板线条;
第二判断模块,用于判断所述第二图像的天花板线条中是否存在与所述目标天花板线条匹配的天花板线条;
第二角度获取模块,用于若存在,则获取所匹配的天花板线条与边界线之间的第二角度;
其中,所述匹配的天花板线条为所述目标天花板线条或者与所述目标天花板线条平行的线条;
所述第二角度与所述第一角度的角度差计算方式为:
设图像的灰度函数为f(x,y),对于数字图像,图像的微分用差分替代,因此坐标为(x,y)的边缘点u的强度M(u)和梯度方向A(u)的计算公式如下:
M(u)=[(fx(x,y))2+(fy(x,y))2]1/2
A(u)=arctan[(fy(x,y))/(fx(x,y))]
式中,
fx(x,y)=f(x+1,y)-f(x-1,y),fy(x,y)=f(x,y+1)-f(x,y-1)
5.根据权利要求4所述的扫地机器人位置校准系统,其特征在于,所述校准模块包括:
偏差角度获取模块,用于将所述第二角度与所述第一角度的角度差与所述第三角度比较,获得偏差角度;
第一执行模块,用于若所述偏差角度小于或者等于预设阈值,则待所述扫地机器人完成工作任务之后,执行校准所述扫地机器人位置信息;
第二执行模块,用于若所述偏差角度大于预设阈值,则暂停所述扫地机器人当前工作,执行校准所述扫地机器人位置信息。
6.根据权利要求4-5任一项所述的扫地机器人位置校准系统,其特征在于,所述系统包括:
判断模块,用于判断所述第一图像和所述第二图像中是否均存在符合预设条件的天花板线条;若均存在,则执行所述角度获取模块获取第一角度、第二角度以及第三角度的步骤。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810613920.9A CN108888188B (zh) | 2018-06-14 | 2018-06-14 | 扫地机器人位置校准方法及系统 |
PCT/CN2018/093455 WO2019237434A1 (zh) | 2018-06-14 | 2018-06-28 | 扫地机器人位置校准方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810613920.9A CN108888188B (zh) | 2018-06-14 | 2018-06-14 | 扫地机器人位置校准方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108888188A CN108888188A (zh) | 2018-11-27 |
CN108888188B true CN108888188B (zh) | 2020-09-01 |
Family
ID=64344809
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810613920.9A Active CN108888188B (zh) | 2018-06-14 | 2018-06-14 | 扫地机器人位置校准方法及系统 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN108888188B (zh) |
WO (1) | WO2019237434A1 (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112773272B (zh) * | 2020-12-29 | 2022-10-18 | 深圳市杉川机器人有限公司 | 移动方向确定方法、装置、扫地机器人和存储介质 |
CN112859836B (zh) * | 2020-12-30 | 2024-09-10 | 广东美的白色家电技术创新中心有限公司 | 一种自主移动设备、校正方法及计算机存储介质 |
CN113375549B (zh) * | 2021-03-31 | 2022-07-29 | 华为技术有限公司 | 定位引导的方法、系统和装置 |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR940006567B1 (ko) * | 1992-01-06 | 1994-07-22 | 삼성전자 주식회사 | 관성을 이용한 네비게이션 시스템이 부착된 이동로보트 |
KR100483548B1 (ko) * | 2002-07-26 | 2005-04-15 | 삼성광주전자 주식회사 | 로봇 청소기와 그 시스템 및 제어 방법 |
KR20050108923A (ko) * | 2004-05-14 | 2005-11-17 | 삼성광주전자 주식회사 | 모빌로봇, 모빌로봇 시스템, 및 그 경로보정방법 |
KR100600487B1 (ko) * | 2004-10-12 | 2006-07-13 | 삼성광주전자 주식회사 | 로봇 청소기의 좌표보정방법 및 이를 이용한 로봇 청소기시스템 |
KR101153221B1 (ko) * | 2009-07-24 | 2012-06-05 | 전북대학교산학협력단 | 천정의 반복 무늬와 화소이동벡터를 이용한 로봇의 위치 및 방향 계산 |
CN103886107B (zh) * | 2014-04-14 | 2017-10-03 | 张文强 | 基于天花板图像信息的机器人定位与地图构建系统 |
CN107037807B (zh) * | 2016-02-04 | 2020-05-19 | 科沃斯机器人股份有限公司 | 自移动机器人位姿校准系统和方法 |
CN106338287A (zh) * | 2016-08-24 | 2017-01-18 | 杭州国辰牵星科技有限公司 | 基于天花板的室内移动机器人视觉定位方法 |
CN107389088B (zh) * | 2017-05-27 | 2020-11-17 | 纵目科技(上海)股份有限公司 | 车载惯性导航的误差修正方法、装置、介质及设备 |
CN107941217B (zh) * | 2017-09-30 | 2020-05-22 | 杭州迦智科技有限公司 | 一种机器人定位方法、电子设备、存储介质、装置 |
-
2018
- 2018-06-14 CN CN201810613920.9A patent/CN108888188B/zh active Active
- 2018-06-28 WO PCT/CN2018/093455 patent/WO2019237434A1/zh active Application Filing
Also Published As
Publication number | Publication date |
---|---|
CN108888188A (zh) | 2018-11-27 |
WO2019237434A1 (zh) | 2019-12-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108888188B (zh) | 扫地机器人位置校准方法及系统 | |
CN108921865B (zh) | 一种抗干扰的亚像素直线拟合方法 | |
CN115641329B (zh) | 一种锂电池隔膜缺陷检测方法及系统 | |
CN104506857A (zh) | 一种摄像头位置偏离检测方法及设备 | |
US8755562B2 (en) | Estimation apparatus, control method thereof, and program | |
Zhang et al. | Line-based multi-label energy optimization for fisheye image rectification and calibration | |
US20140233804A1 (en) | Method and apparatus for finding stick-up height of a pipe or finding a joint between two pipes in a drilling environment | |
CN111027484B (zh) | 基于三维成像的隧道钢拱识别方法 | |
CN106709500B (zh) | 一种图像特征匹配的方法 | |
CN103400379A (zh) | 一种基于图像的覆冰检测和厚度估计方法 | |
CN109815822B (zh) | 基于广义Hough变换的巡检图零部件目标识别方法 | |
US20110150279A1 (en) | Image processing apparatus, processing method therefor, and non-transitory computer-readable storage medium | |
CN111251336A (zh) | 一种基于视觉定位的双臂协同智能装配系统 | |
KR20080032856A (ko) | 조선소 소조립 용접부재 위치 인식 방법 | |
US11171459B2 (en) | Method and system for alignment of wire contact with wire contact insertion holes of a connector | |
CN113513991B (zh) | 一种电池极片毛刺高度检测方法及装置 | |
CN108961221A (zh) | 一种航空插头现场静态图像检测算法 | |
CN104102069A (zh) | 一种成像系统的对焦方法及装置、成像系统 | |
CN111192326A (zh) | 一种用于视觉识别电动汽车直流充电插口的方法及系统 | |
CN115239661A (zh) | 基于图像处理的机械零件毛刺检测方法及系统 | |
US11374374B2 (en) | Method and system for alignment and insertion of wire contact with wire contact insertion holes of a connector | |
CN111160305A (zh) | 一种变压器套管异常监测方法及计算机可读介质 | |
CN113658279B (zh) | 相机内参和外参估算方法、装置、计算机设备及存储介质 | |
KR101333459B1 (ko) | 차선 인식 방법 및 장치 | |
CN117197245A (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 | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20190906 Address after: Room 402, 4th floor, Kanghe Sheng Building, New Energy Innovation Industrial Park, No. 1 Chuangsheng Road, Nanshan District, Shenzhen City, Guangdong Province, 518000 Applicant after: Shenzhen Infinite Power Development Co., Ltd. Address before: 518000 Block 503,602, Garden City Digital Building B, 1079 Nanhai Avenue, Shekou, Nanshan District, Shenzhen City, Guangdong Province Applicant before: SHENZHEN WOTE WODE CO., LTD. |
|
TA01 | Transfer of patent application right | ||
GR01 | Patent grant | ||
GR01 | Patent grant |