基于多个深度相机的三维地图构建方法及扫地机器人与流程

文档序号:22089093发布日期:2020-09-01 21:25阅读:323来源:国知局
基于多个深度相机的三维地图构建方法及扫地机器人与流程

本申请涉及机器人技术领域,具体而言,本申请涉及一种基于多个深度相机的三维地图构建方法及扫地机器人。



背景技术:

扫地机器人作为一种能够自动对待清扫区域进行清扫的智能电器,可以代替人对地面进行清扫,减少了人的家务负担,越来越受到人们的认可。扫地机器人的应用环境空间的地图构建是扫地机器人执行清扫工作的基础,如何构建扫地机器人的应用环境空间的地图成为一个关键问题。

同时定位与建图(simultaneouslocalizationandmapping,slam)技术要解决的问题是:将一个机器人放入未知环境中的未知位置,是否有办法让机器人一边移动一边逐步描绘出与此环境完全一致的地图。目前,扫地机器人的应用环境空间的地图的构建是通过基于激光雷达的slam技术实现的,即仅根据通过扫地机器人的激光雷达得到的激光数据进行建图。然而,现有的仅基于激光雷达的slam建图方法,激光雷达仅能探测2d平面的障碍物信息,探测不到障碍物的垂直方向的信息,构建的地图为二维地图,所提供的环境空间的信息有限,且对于一些特殊的障碍物(如镂空结构的桌椅等),则不能通过激光雷达进行有效探测处理,此外,由于激光雷达必须被配置在具有一定的高度的位置才能有效工作,导致扫地机器人无法做到超薄,使得扫地机器人无法进入垂直距离较小的空间执行工作。因此,现有的仅基于激光雷达的slam建图方法,存在构建的地图提供的信息少且建图准确性低的问题,以及存在扫地机器人无法做到超薄、工作空间受限的问题。



技术实现要素:

本申请提供了一种基于多个深度相机的三维地图构建方法及扫地机器人,用于提升构建的环境空间的地图包含的信息的丰富性以及提升构建的地图的准确性,以及扩大扫地机器人的工作空间范围,本申请采用的技术方案如下:

第一方面,本申请提供了一种基于多个深度相机的三维地图构建方法,该方法包括:

步骤a,基于获取到的两帧相邻深度图通过同时定位与建图slam算法确定扫地机器人在当前位置的位姿信息,任一帧深度图由扫地机器人配置的多个深度相机同步获取到的多帧元深度图融合处理得到,两帧相邻深度图包括扫地机器人在当前位置处获取到的深度图;

步骤b,基于确定的扫地机器人在当前位置的位姿信息与获取到的扫地机器人在当前位置的深度图构建三维子地图;

步骤c,控制扫地机器人移动至符合预定条件的下一位置,执行步骤a与步骤b,并对获取到的各个三维子地图进行拼接处理得到合并三维地图;

循环执行步骤c,直至得到的合并三维地图为环境空间的全局三维地图。

可选地,基于获取到的两帧相邻深度图通过同时定位与建图slam算法确定扫地机器人在当前位置的位姿信息,包括:

分别对两帧相邻深度图进行特征提取;

基于提取到的两帧相邻深度图的特征进行关联特征配对;

基于得到的关联特征信息确定扫地机器人在当前位置的位姿信息。

可选地,多个深度相机的个数的确定方式,包括:

基于深度相机的视场角确定扫地机器人配置的深度相机的个数。

进一步地,该方法还包括:

基于相应的应用需求确定各个深度相机的布置方式;

对扫地机器人的多个深度相机同步获取到的多帧元深度图进行融合处理,包括:

基于各个深度相机的布置方式,来确定对多帧元深度图进行融合处理的融合处理参数;

根据融合处理方式,对扫地机器人的多个深度相机同步获取到的多帧元深度图进行融合处理。

可选地,控制扫地机器人移动至符合预定条件的下一位置,包括:

基于三维子地图或合并三维地图确定扫地机器人的移动信息,移动信息包括移动方向信息与移动距离信息;

基于确定的移动信息控制扫地机器人移动至符合预定条件的下一位置。

进一步地,该方法还包括:

基于全局三维地图规划扫地机器人的工作路径,工作路径包括扫地机器人到达清扫目标区域的路线和/或扫地机器人对清扫目标区域进行清扫的路线。

可选地,全局三维地图包括各个障碍物和/或悬崖的三维信息,基于全局三维地图规划扫地机器人的工作路径,包括:

基于各个障碍物和/或悬崖的三维信息确定通过各个障碍物和/或悬崖的方式;

基于确定的通过各个障碍物的方式规划扫地机器人的工作路径。

第二方面,提供了一种扫地机器人,该扫地机器人包括:多个深度相机与构建装置;

多个深度相机用于同步获取扫地机器人在相应位置处的元深度图;

构建装置包括:

第一确定模块,用于基于获取到的两帧相邻深度图通过同时定位与建图slam算法确定扫地机器人在当前位置的位姿信息,任一帧深度图由多个深度相机同步获取到的多帧元深度图融合处理得到,两帧相邻深度图包括扫地机器人在当前位置处获取到的深度图;

构建模块,用于基于第一确定模块确定的扫地机器人在当前位置的位姿信息与获取到的扫地机器人在当前位置的深度图构建三维子地图;

控制模块,用于控制扫地机器人移动至符合预定条件的下一位置,执行第一确定模块与构建模块的执行过程,并对获取到的各个三维子地图进行拼接处理得到合并三维地图;

循环模块,用于循环执行控制模块的执行过程,直至得到的合并三维地图为环境空间的全局三维地图。

可选地,第一确定模块包括提取单元、配对单元以及第一确定单元;

提取单元,用于分别对两帧相邻深度图进行特征提取;

配对单元,用于基于提取单元提取到的两帧相邻深度图的特征进行关联特征配对;

第一确定单元,用于基于配对单元配对得到的关联特征信息确定扫地机器人在当前位置的位姿信息。

可选地,多个深度相机的个数的确定方式,包括:

基于深度相机的视场角确定扫地机器人配置的深度相机的个数。

进一步地,构建装置还包括第二确定模块;

第二确定模块,用于基于相应的应用需求确定各个深度相机的布置方式;

第一确定模块具体用于基于各个深度相机的布置方式,来确定对多帧元深度图进行融合处理的融合处理参数,以及用于根据融合处理方式,对扫地机器人的多个深度相机同步获取到的多帧元深度图进行融合处理。

可选地,控制模块包括第二确定单元以及控制单元;

第二确定单元,用于基于三维子地图或合并三维地图确定扫地机器人的移动信息,移动信息包括移动方向信息与移动距离信息;

控制单元,用于基于第二确定单元确定的移动信息控制扫地机器人移动至符合预定条件的下一位置。

进一步地,控制装置还包括规划模块;

规划模块,用于基于全局三维地图规划扫地机器人的工作路径,工作路径包括扫地机器人到达清扫目标区域的路线和/或扫地机器人对清扫目标区域进行清扫的路线。

可选地,全局三维地图包括各个障碍物和/或悬崖的三维信息,规划模块包括第三确定单元以及规划单元;

第三确定单元,用于基于各个障碍物和/或悬崖的三维信息确定通过各个障碍物和/或悬崖的方式;

规划单元,用于基于第三确定单元确定的通过各个障碍物的方式规划扫地机器人的工作路径。

第三方面,本申请提供了一种电子设备,该电子设备包括:

一个或多个处理器;

存储器;

一个或多个应用程序,其中一个或多个应用程序被存储在存储器中并被配置为由一个或多个处理器执行,一个或多个程序配置用于:执行第一方面的任一实施方式中所示的基于多个深度相机的三维地图构建方法。

第四方面,本申请提供了一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现本申请的第一方面的任一实施方式中所示的基于多个深度相机的三维地图构建方法。

本申请提供了一种基于多个深度相机的三维地图构建方法及扫地机器人,与现有技术基于激光雷达构建环境空间的二维地图相比,本申请通过步骤a,基于获取到的两帧相邻深度图通过同时定位与建图slam算法确定扫地机器人在当前位置的位姿信息,任一帧深度图由扫地机器人配置的多个深度相机同步获取到的多帧元深度图融合处理得到,两帧相邻深度图包括扫地机器人在当前位置处获取到的深度图,步骤b,基于确定的扫地机器人在当前位置的位姿信息与获取到的扫地机器人在当前位置的深度图构建三维子地图,步骤c,控制扫地机器人移动至符合预定条件的下一位置,执行步骤a与步骤b,并对获取到的各个三维子地图进行拼接处理得到合并三维地图,继而循环执行步骤c,直至得到的合并三维地图为环境空间的全局三维地图。即本申请基于通过深度相机获取的深度图构建环境空间的三维地图,较构建的二维地图相比三维地图包含了障碍物在垂直方向的信息,因此三维地图较现有的基于激光雷达构建的二维地图包含了更多的环境空间的信息;与此同时,通过深度相机,能够探测到镂空结构的桌椅等通过激光雷达不能探测到的障碍物的信息,从而提升了构建的环境空间的地图的准确性;此外,深度相机不需要像激光雷达一样被配置在一定的高度也能有效工作,从而扫地机器人可以做到超薄,扩展了扫地机器人的有效工作空间;进一步地,通过配置多个深度相机,能够避免由于单个深度相机视场角较小,获取的相邻两帧深度图包含的重叠区域较少甚至无重叠区域,无法有效进行深度图的关联特征配对,造成确定扫地机器人的位姿失败的问题,以及扩展了扫地机器人同一时刻或位置的探测区域,提升了构建环境地图的效率。

本申请附加的方面和优点将在下面的描述中部分给出,这些将从下面的描述中变得明显,或通过本申请的实践了解到。

附图说明

为了更清楚地说明本申请实施例中的技术方案,下面将对本申请实施例描述中所需要使用的附图作简单地介绍。

图1为本申请实施例提供的一种基于多个深度相机的三维地图构建方法的流程示意图;

图2为本申请实施例提供的一种扫地机器人的结构示意图;

图3为本申请实施例提供的另一种扫地机器人的结构示意图;

图4为本申请实施例提供的一种电子设备的结构示意图。

具体实施方式

下面详细描述本申请的实施例,实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,仅用于解释本申请,而不能解释为对本发明的限制。

本技术领域技术人员可以理解,除非特意声明,这里使用的单数形式“一”、“一个”和“该”也可包括复数形式。应该进一步理解的是,本申请的说明书中使用的措辞“包括”是指存在特征、整数、步骤、操作、元件和/或组件,但是并不排除存在或添加一个或多个其他特征、整数、步骤、操作、元件、组件和/或它们的组。应该理解,当我们称元件被“连接”或“耦接”到另一元件时,它可以直接连接或耦接到其他元件,或者也可以存在中间元件。此外,这里使用的“连接”或“耦接”可以包括无线连接或无线耦接。这里使用的措辞“和/或”包括一个或更多个相关联的列出项的全部或任一单元和全部组合。

下面以具体地实施例对本申请的技术方案以及本申请的技术方案如何解决上述技术问题进行详细说明。下面这几个具体的实施例可以相互结合,对于相同或相似的概念或过程可能在某些实施例中不再赘述。下面将结合附图,对本申请的实施例进行描述。

本申请的一个实施例提供了一种基于多个深度相机的三维地图构建方法,如图1所示,该方法包括:

步骤s101,基于获取到的两帧相邻深度图通过同时定位与建图slam算法确定扫地机器人在当前位置的位姿信息,任一帧深度图由扫地机器人配置的多个深度相机同步获取到的多帧元深度图融合处理得到,两帧相邻深度图包括扫地机器人在当前位置处获取到的深度图;

具体地,扫地机器人配置有多个深度相机,可以对某一时刻或位置多个深度相机同步获取到的多帧元深度图进行相应的融合处理得到某一时刻或位置的一帧深度图,其中该深度相机可以是基于tof的深度相机、rgb双目深度相机、结构光深度相机以及双目结构光深度相机中的任一种,此处不做限定。

其中,同时定位与建图(simultaneouslocalizationandmapping,slam)问题可以描述为:将一个机器人放入未知环境中的未知位置,是否有办法让机器人一边移动一边逐步描绘出此环境完全一致的地图。其中,slam算法可以包含多方面的算法,如定位相关的算法、建图相关算法、路径规划相关算法等;其中,定位相关算法中可以包括相应的点云匹配算法,点云匹配是通过计算得到完美的坐标变换,将处于不同视角下的点云数据经过旋转平移等刚性变换统一整合到指定坐标系之下的过程。换而言之,进行配准的两个点云,它们彼此之间可以通过旋转平移等这种位置变换完全重合,因此这两个点云属于刚性变换即形状大小是完全一样的,只是坐标位置不一样而已,点云配准就是求出两个点云之间的坐标位置变换关系。

具体地,可以通过slam算法中的相应点云匹配算法对获取到的两帧深度图进行相应的匹配处理,得到扫地机器人在当前位置的位姿信息。

步骤s102,基于确定的扫地机器人在当前位置的位姿信息与获取到的扫地机器人在当前位置的深度图构建三维子地图;

具体地,深度图中的各个像素点对应探测到的环境空间中障碍物的一个点,可以根据确定的扫地机器人在当前位置的位姿信息,确定获取到的扫地机器人在当前位置的深度图中各个像素点在世界坐标体系中的对应位置,从而构建出扫地机器人在当前位置处的三维子地图。

步骤s103,控制扫地机器人移动至符合预定条件的下一位置,执行步骤s101与步骤s102,并对获取到的各个三维子地图进行拼接处理得到合并三维地图;

其中,当扫地机器人被放置于一个未知的环境中时,尚未有环境空间的地图,其初始符合预定条件的位置可以是随机确定的,可以是移动一定阈值距离到达的位置或移动一定阈值时间所到达的位置;待扫地机器人构建了相应的三维子地图或合并三维地图后,扫地机器人的后续符合预定条件位置可以根据构建的三维子地图或合并三维地图来确定的。

具体地,可以将构建的当前位置的三维子地图,与之前构建的各个三维子地图进行融合处理,得到合并三维地图;也可以将当前位置构建的三维子地图与之前融合处理得到的合并三维地图进行融合处理得到当前合并三维地图。其中,融合处理可以是对待融合处理的三维子地图进行拼接,其中,拼接过程中可以对重叠的地图部分进行删除。

步骤s104,循环执行步骤s103,直至得到的合并三维地图为环境空间的全局三维地图。

对于本申请实施例,循环执行步骤s103,直至得到的合并三维地图为环境空间的全局三维地图。其中,判断成功构建全局三维地图的方法:可以是基于相应的三维子地图或合并三维子地图,没有相应的符合预定条件的位置,也可以是在当前位置构建的三维子地图与之前构建的合并三维子地图或三维子地图完全重叠,还可以是基于前述两种方法的结合来综合判定是否成功构建全局三维地图。

本申请实施例提供了一种基于多个深度相机的三维地图构建方法,与现有技术基于激光雷达构建环境空间的二维地图相比,本申请实施例通过步骤a,基于获取到的两帧相邻深度图通过同时定位与建图slam算法确定扫地机器人在当前位置的位姿信息,任一帧深度图由扫地机器人配置的多个深度相机同步获取到的多帧元深度图融合处理得到,两帧相邻深度图包括扫地机器人在当前位置处获取到的深度图,步骤b,基于确定的扫地机器人在当前位置的位姿信息与获取到的扫地机器人在当前位置的深度图构建三维子地图,步骤c,控制扫地机器人移动至符合预定条件的下一位置,执行步骤a与步骤b,并对获取到的各个三维子地图进行拼接处理得到合并三维地图,继而循环执行步骤c,直至得到的合并三维地图为环境空间的全局三维地图。即本申请基于通过深度相机获取的深度图构建环境空间的三维地图,较构建的二维地图相比三维地图包含了障碍物在垂直方向的信息,因此三维地图较现有的基于激光雷达构建的二维地图包含了更多的环境空间的信息;与此同时,通过深度相机,能够探测到镂空结构的桌椅等通过激光雷达不能探测到的障碍物的信息,从而提升了构建的环境空间的地图的准确性;此外,深度相机不需要像激光雷达一样被配置在一定的高度也能有效工作,从而扫地机器人可以做到超薄,扩展了扫地机器人的有效工作空间;进一步地,通过配置多个深度相机,能够避免由于单个深度相机视场角较小,获取的相邻两帧深度图包含的重叠区域较少甚至无重叠区域,无法有效进行深度图的关联特征配对,造成确定扫地机器人的位姿失败的问题,以及扩展了扫地机器人同一时刻或位置的探测区域,提升了构建环境地图的效率。

本申请实施例提供了一种可能的实现方式,具体地,步骤s101包括:

步骤s1011(图中未示出),分别对两帧相邻深度图进行特征提取;

具体地,通过相应的特征提取方法,如基于模型的特征提取方法,分别对两帧相邻深度图进行特征提取,其中,边缘、角、点、区域等都可以作为特征来表示深度图中的元素。

步骤s1012(图中未示出),基于提取到的两帧相邻深度图的特征进行关联特征配对;

具体地,可以利用点到点的欧式距离或其他距离,进行两帧相邻深度图的特征的关联特征配对。

步骤s1013(图中未示出),基于得到的关联特征信息确定扫地机器人在当前位置的位姿信息。

具体地,可以根据得到的关联特征信息,得到两帧相邻深度图的整体匹配参数的旋转矩阵和平移矩阵,并计算两帧相邻深度图采样周期内的运动增量,从而确定扫地机器人的位姿信息。

对于本申请实施例,通过对两帧相邻深度图的特征进行关联特征配对,并基于得到的关联特征信息确定扫地机器人在当前位置的位姿信息,解决了扫地机器人在当前位置的位姿信息的确定问题。

本申请实施例提供了一种可能的实现方式,其中,步骤s101中多个深度相机的个数的确定方式,包括:

步骤s1014(图中未示出),基于深度相机的视场角确定扫地机器人配置的深度相机的个数。

其中,视场角在光学工程中又称视场,视场角的大小决定了光学仪器的视野范围,在光学仪器中,以光学仪器的镜头为顶点,以被测目标的物像可通过镜头的最大范围的两条边缘构成的夹角,称为视场角,其中,视场角包括水平视场角和垂直视场角。

具体地,可以依据不同的应用需求,根据视场角确定扫地机器人配置的深度相机的个数,如,需要将扫地机器人的视野扩展达到一定范围(如水平视场角达到100度),而单个深度相机的水平视场角为60度,可以配置两个水平视场角为60度的深度相机;又如,需要扫地机器人配置的深度相机具有360度环视的效果,可以根据360度与深度相机的视场角的比值确定配置的视场角的个数;其中,该多个深度相机也可以是由具有不同视场角的深度相机的组合。

其中,也可以是从扫地机器人配置完成的多个深度相机中,基于配置完成的各个深度相机的视场角确定出相应的深度相机进行元深度图的获取。

对于本申请实施例,根据深度相机的视场角确定配置的深度相机的个数,解决了扫地机器人配置的深度相机的个数的确定问题,从而能够根据不同的应用需求确定相应个数的深度相机,满足了用户的个性化需求。

本申请实施例提供了一种可能的实现方式,进一步地,该方法还包括:

步骤s105(图中未示出),基于相应的应用需求确定各个深度相机的布置方式;

具体地,如果是为了扩大扫地机器人在垂直方向的视野,该多个深度相机可以在垂直方向上布置;如果是为了扩大扫地机器人在水平方向的视野,该多个深度相机可以在同一水平面上布置,其中,如果是配置两个深度相机,将扫地机器人的视野扩展达到一定范围,可以在扫地机器人执行深度图获取工作的一侧按照一定的位置关系配置该两个深度相机,其中,该一定的位置关系用于使两个深度相机获取的深度图具有一定的重合区域,以进行各个深度相机获取的元深度图的融合,其中,如果是配置多个深度相机,将扫地机机器人的视野扩展至环视的效果,该多个深度相机可以采用均布的方式。

步骤s101中的对扫地机器人的多个深度相机同步获取到的多帧元深度图进行融合处理,包括:

步骤s1015(图中未示出),基于各个深度相机的布置方式,来确定对多帧元深度图进行融合处理的融合处理参数;

步骤s1016(图中未示出),根据融合处理方式,对扫地机器人的多个深度相机同步获取到的多帧元深度图进行融合处理。

具体地,可以根据深度相机的布置方式确定各个深度相机之间的位置关系(如相邻两个深度相机之间的距离),并根据各个深度相机之间的位置关系确定相应的融合处理参数,以及基于确定的融合处理参数对多个深度相机同步获取到的多帧元深度图进行相应融合处理,其中,该融合处理为拼接处理,在拼接过程中可以进行重叠区域的删除。

对于本申请实施例,解决了扫地机器人配置的各个深度相机的布置方式的确定问题,以及如何对多个深度相机同步获取到的多帧元深度图进行融合处理的问题。

本申请实施例提供了一种可能的实现方式,具体地,步骤s103包括:

步骤s1031(图中未示出),基于三维子地图或合并三维地图确定扫地机器人的移动信息,移动信息包括移动方向信息与移动距离信息;

步骤s1032(图中未示出),基于确定的移动信息控制扫地机器人移动至符合预定条件的下一位置。

其中,该符合预定条件的下一位置可以是根据构建的三维子地图或合并三维地图与扫地机器人配置的深度相机的有效探测范围确定的,如深度相机的有效探测范围是3m,可以确定扫地机器人当前方向2米的位置为符合预定条件的下一位置。

其中,也可以基于构建的三维子地图或合并三维地图,在相应的扫地机器人可到达但尚未到达的区域中确定的相应位置,如从当前已构建的地图中当前位置2米处存在相应的扫地机器人可通行的拐角,可在拐角区域确定相应的符合预定条件的下一位置。

具体地,可以根据构建的三维子地图或合并三维地图确定扫地机器人的移动信息,并基于该移动信息控制扫地机器人移动至符合预定条件的下一位置。

对于本申请实施例,解决了扫地机器人如何到达符合预定条件的下一位置,为构建该符合预定条件的下一位置处的三维子地图提供了基础。

本申请实施例提供了一种可能的实现方式,进一步地,该方法还包括:

步骤s106(图中未示出),基于全局三维地图规划扫地机器人的工作路径,工作路径包括扫地机器人到达清扫目标区域的路线和/或扫地机器人对清扫目标区域进行清扫的路线。

具体地,可以根据接收到的清扫指令,可以根据构建的环境空间的全局三维地图规划扫地机器人的工作路径,其中,该工作路径可以包括扫地机器人到达清扫区域的路线和/或扫地机器人对清扫目标区域如何进行清扫的路线。

对于本申请实施例,基于构建的全局三维地图,规划扫地机器人的工作路径,解决了扫地机器人行进的导航问题。

本申请实施例提供了一种可能的实现方式,具体地,全局三维地图包括各个障碍物和/或悬崖的三维信息,步骤s106包括:

步骤s1061(图中未示出),基于各个障碍物和/或悬崖的三维信息确定通过各个障碍物和/或悬崖的方式;

具体地,可以基于各个障碍物的三维信息确定通过各个障碍物的方式,如当根据某一障碍物的三维信息(如障碍物的高度为3厘米)确定可直接越过该障碍物时,确定通过该障碍物的方式为越过障碍物,当根据某一障碍物的语义信息(如障碍物的高度为10厘米)确定无法直接越过该障碍物时,可确定通过该障碍物的方式为绕过障碍物。

具体地,可以基于各个悬崖的三维信息确定通过各个悬崖的方式,如可根据悬崖的深度与宽度信息确定通过悬崖的方式为越过悬崖或回避悬崖。

步骤s1062(图中未示出),基于确定的通过各个障碍物的方式规划扫地机器人的工作路径。

具体地,可以根据确定的通过各个障碍物和/或悬崖的方式规划扫地机器人的工作规划,如当通过障碍物的方式为越过障碍物时,不需对相应的行进路径进行调整,当通过障碍物的方式为绕过障碍物时,制定相应的绕过路线,对行进路径进行调整。

对于本申请实施例,根据通过各个障碍物和/或悬崖的方式规划扫地机器人的工作路径,解决了如何规划扫地机器人的行进路径的问题。

本申请实施例还提供了一种扫地机器人,如图2所示,该扫地机器人20可以包括:多个深度相机201以及构建装置202;

多个深度相机201,用于同步获取扫地机器人在相应位置处的元深度图;

构建装置202包括:

第一确定模块2021,用于基于获取到的两帧相邻深度图通过同时定位与建图slam算法确定扫地机器人在当前位置的位姿信息,任一帧深度图由多个深度相机同步获取到的多帧元深度图融合处理得到,两帧相邻深度图包括扫地机器人在当前位置处获取到的深度图;

构建模块2022,用于基于第一确定模块2021确定的扫地机器人在当前位置的位姿信息与获取到的扫地机器人在当前位置的深度图构建三维子地图;

控制模块2023,用于控制扫地机器人移动至符合预定条件的下一位置,执行第一确定模块2021与构建模块2022的执行过程,并对获取到的各个三维子地图进行拼接处理得到合并三维地图;

循环模块2024,用于循环执行控制模块2023的执行过程,直至得到的合并三维地图为环境空间的全局三维地图。

本申请实施例提供了一种扫地机器人,与现有技术基于激光雷达构建环境空间的二维地图相比,本申请通过步骤a,基于获取到的两帧相邻深度图通过同时定位与建图slam算法确定扫地机器人在当前位置的位姿信息,任一帧深度图由扫地机器人配置的多个深度相机同步获取到的多帧元深度图融合处理得到,两帧相邻深度图包括扫地机器人在当前位置处获取到的深度图,步骤b,基于确定的扫地机器人在当前位置的位姿信息与获取到的扫地机器人在当前位置的深度图构建三维子地图,步骤c,控制扫地机器人移动至符合预定条件的下一位置,执行步骤a与步骤b,并对获取到的各个三维子地图进行拼接处理得到合并三维地图,继而循环执行步骤c,直至得到的合并三维地图为环境空间的全局三维地图。即本申请基于通过深度相机获取的深度图构建环境空间的三维地图,较构建的二维地图相比三维地图包含了障碍物在垂直方向的信息,因此三维地图较现有的基于激光雷达构建的二维地图包含了更多的环境空间的信息;与此同时,通过深度相机,能够探测到镂空结构的桌椅等通过激光雷达不能探测到的障碍物的信息,从而提升了构建的环境空间的地图的准确性;此外,深度相机不需要像激光雷达一样被配置在一定的高度也能有效工作,从而扫地机器人可以做到超薄,扩展了扫地机器人的有效工作空间;进一步地,通过配置多个深度相机,能够避免由于单个深度相机视场角较小,获取的相邻两帧深度图包含的重叠区域较少甚至无重叠区域,无法有效进行深度图的关联特征配对,造成确定扫地机器人的位姿失败的问题,以及扩展了扫地机器人同一时刻或位置的探测区域,提升了构建环境地图的效率。

本实施例的扫地机器人可执行本申请上述实施例中提供的一种基于多个深度相机的三维地图构建方法,其实现原理相类似,此处不再赘述。

本申请实施例提供了另一种扫地机器人,如图3所示,本实施例的扫地机器人30包括:多个深度相机301以及构建装置302;

多个深度相机301,用于同步获取扫地机器人在相应位置处的元深度图;

其中,图3中的多个深度相机301与图2中的多个深度相机201的功能相同或者相似。

构建装置302包括:

第一确定模块3021,用于基于获取到的两帧相邻深度图通过同时定位与建图slam算法确定扫地机器人在当前位置的位姿信息,任一帧深度图由多个深度相机同步获取到的多帧元深度图融合处理得到,两帧相邻深度图包括扫地机器人在当前位置处获取到的深度图;

其中,图3中的第一确定模块3021与图2中的第一确定模块2021的功能相同或者相似。

构建模块3022,用于基于第一确定模块3021确定的扫地机器人在当前位置的位姿信息与获取到的扫地机器人在当前位置的深度图构建三维子地图;

其中,图3中的构建模块3022与图2中的构建模块2022的功能相同或者相似。

控制模块3023,用于控制扫地机器人移动至符合预定条件的下一位置,执行第一确定模块3021与构建模块3022的执行过程,并对获取到的各个三维子地图进行拼接处理得到合并三维地图;

其中,图3中的控制模块3023与图2中的控制模块2023的功能相同或者相似。

循环模块3024,用于循环执行控制模块3023的执行过程,直至得到的合并三维地图为环境空间的全局三维地图。

其中,图3中的循环模块3024与图2中的循环模块2024的功能相同或者相似。

本申请实施例提供了一种可能的实现方式,具体地,第一确定模块3021包括提取单元30211、配对单元30212以及第一确定单元30213;

提取单元30211,用于分别对两帧相邻深度图进行特征提取;

配对单元30212,用于基于提取单元30211提取到的两帧相邻深度图的特征进行关联特征配对;

第一确定单元30213,用于基于配对单元30212配对得到的关联特征信息确定扫地机器人在当前位置的位姿信息。

对于本申请实施例,通过对两帧相邻深度图的特征进行关联特征配对,并基于得到的关联特征信息确定扫地机器人在当前位置的位姿信息,解决了扫地机器人在当前位置的位姿信息的确定问题。

本申请实施例提供了一种可能的实现方式,多个深度相机的个数的确定方式,包括:

基于深度相机的视场角确定扫地机器人配置的深度相机的个数。

对于本申请实施例,根据深度相机的视场角确定配置的深度相机的个数,解决了扫地机器人配置的深度相机的个数的确定问题,从而能够根据不同的应用需求确定相应个数的深度相机,满足了用户的个性化需求。

本申请实施例提供了一种可能的实现方式,进一步地,构建装置还包括第二确定模块3025;

第二确定模块3025,用于基于相应的应用需求确定各个深度相机的布置方式;

第一确定模块3021具体用于基于各个深度相机的布置方式,来确定对多帧元深度图进行融合处理的融合处理参数,以及用于根据融合处理方式,对扫地机器人的多个深度相机同步获取到的多帧元深度图进行融合处理。

对于本申请实施例,解决了扫地机器人配置的各个深度相机的布置方式的确定问题,以及如何对多个深度相机同步获取到的多帧元深度图进行融合处理的问题。

本申请实施例提供了一种可能的实现方式,具体地,控制模块3023包括第二确定单元30231以及控制单元30232;

第二确定单元30231,用于基于三维子地图或合并三维地图确定扫地机器人的移动信息,移动信息包括移动方向信息与移动距离信息;

控制单元30232,用于基于第二确定单元30231确定的移动信息控制扫地机器人移动至符合预定条件的下一位置。

对于本申请实施例,解决了扫地机器人如何到达符合预定条件的下一位置,为构建该符合预定条件的下一位置处的三维子地图提供了基础。

本申请实施例提供了一种可能的实现方式,进一步地,构建装置还包括规划模块3026;

规划模块3026,用于基于全局三维地图规划扫地机器人的工作路径,工作路径包括扫地机器人到达清扫目标区域的路线和/或扫地机器人对清扫目标区域进行清扫的路线。

对于本申请实施例,基于构建的全局三维地图,规划扫地机器人的工作路径,解决了扫地机器人行进的导航问题。

本申请实施例提供了一种可能的实现方式,具体地,全局三维地图包括各个障碍物和/或悬崖的三维信息,规划模块3026包括第三确定单元30261以及规划单元30262;

第三确定单元30261,用于基于各个障碍物和/或悬崖的三维信息确定通过各个障碍物和/或悬崖的方式;

规划单元30262,用于基于第三确定单元30261确定的通过各个障碍物的方式规划扫地机器人的工作路径。对于本申请实施例,根据通过各个障碍物和/或悬崖的方式规划扫地机器人的工作路径,解决了如何规划扫地机器人的行进路径的问题。

对于本申请实施例,根据通过各个障碍物和/或悬崖的方式规划扫地机器人的工作路径,解决了如何规划扫地机器人的行进路径的问题。

本申请实施例提供了一种扫地机器人,与现有技术基于激光雷达构建环境空间的二维地图相比,本申请实施例通过步骤a,基于获取到的两帧相邻深度图通过同时定位与建图slam算法确定扫地机器人在当前位置的位姿信息,任一帧深度图由扫地机器人配置的多个深度相机同步获取到的多帧元深度图融合处理得到,两帧相邻深度图包括扫地机器人在当前位置处获取到的深度图,步骤b,基于确定的扫地机器人在当前位置的位姿信息与获取到的扫地机器人在当前位置的深度图构建三维子地图,步骤c,控制扫地机器人移动至符合预定条件的下一位置,执行步骤a与步骤b,并对获取到的各个三维子地图进行拼接处理得到合并三维地图,继而循环执行步骤c,直至得到的合并三维地图为环境空间的全局三维地图。即本申请基于通过深度相机获取的深度图构建环境空间的三维地图,较构建的二维地图相比三维地图包含了障碍物在垂直方向的信息,因此三维地图较现有的基于激光雷达构建的二维地图包含了更多的环境空间的信息;与此同时,通过深度相机,能够探测到镂空结构的桌椅等通过激光雷达不能探测到的障碍物的信息,从而提升了构建的环境空间的地图的准确性;此外,深度相机不需要像激光雷达一样被配置在一定的高度也能有效工作,从而扫地机器人可以做到超薄,扩展了扫地机器人的有效工作空间;进一步地,通过配置多个深度相机,能够避免由于单个深度相机视场角较小,获取的相邻两帧深度图包含的重叠区域较少甚至无重叠区域,无法有效进行深度图的关联特征配对,造成确定扫地机器人的位姿失败的问题,以及扩展了扫地机器人同一时刻或位置的探测区域,提升了构建环境地图的效率。

本申请实施例提供的扫地机器人适用于上述方法实施例,在此不再赘述。

本申请实施例提供了一种电子设备,如图4所示,图4所示的电子设备40包括:处理器4001和存储器4003。其中,处理器4001和存储器4003相连,如通过总线4002相连。进一步地,电子设备40还可以包括收发器4004。需要说明的是,实际应用中收发器4004不限于一个,该电子设备400的结构并不构成对本申请实施例的限定。

其中,处理器4001应用于本申请实施例中,用于实现图2或图3所示的多个深度相机以及构建装置的功能。收发器4004包括接收机和发射机。

处理器4001可以是cpu,通用处理器,dsp,asic,fpga或者其他可编程逻辑器件、晶体管逻辑器件、硬件部件或者其任意组合。其可以实现或执行结合本申请公开内容所描述的各种示例性的逻辑方框,模块和电路。处理器4001也可以是实现计算功能的组合,例如包含一个或多个微处理器组合,dsp和微处理器的组合等。

总线4002可包括一通路,在上述组件之间传送信息。总线4002可以是pci总线或eisa总线等。总线4002可以分为地址总线、数据总线、控制总线等。为便于表示,图4中仅用一条粗线表示,但并不表示仅有一根总线或一种类型的总线。

存储器4003可以是rom或可存储静态信息和指令的其他类型的静态存储设备,ram或者可存储信息和指令的其他类型的动态存储设备,也可以是eeprom、cd-rom或其他光盘存储、光碟存储(包括压缩光碟、激光碟、光碟、数字通用光碟、蓝光光碟等)、磁盘存储介质或者其他磁存储设备、或者能够用于携带或存储具有指令或数据结构形式的期望的程序代码并能够由计算机存取的任何其他介质,但不限于此。

存储器4003用于存储执行本申请方案的应用程序代码,并由处理器4001来控制执行。处理器4001用于执行存储器4003中存储的应用程序代码,以实现图2或图3所示实施例提供的扫地机器人的功能。

本申请实施例提供了一种电子设备适用于上述方法实施例。在此不再赘述。

本申请实施例提供了一种电子设备,与现有技术基于激光雷达构建环境空间的二维地图相比,本申请实施例通过步骤a,基于获取到的两帧相邻深度图通过同时定位与建图slam算法确定扫地机器人在当前位置的位姿信息,任一帧深度图由扫地机器人配置的多个深度相机同步获取到的多帧元深度图融合处理得到,两帧相邻深度图包括扫地机器人在当前位置处获取到的深度图,步骤b,基于确定的扫地机器人在当前位置的位姿信息与获取到的扫地机器人在当前位置的深度图构建三维子地图,步骤c,控制扫地机器人移动至符合预定条件的下一位置,执行步骤a与步骤b,并对获取到的各个三维子地图进行拼接处理得到合并三维地图,继而循环执行步骤c,直至得到的合并三维地图为环境空间的全局三维地图。即本申请基于通过深度相机获取的深度图构建环境空间的三维地图,较构建的二维地图相比三维地图包含了障碍物在垂直方向的信息,因此三维地图较现有的基于激光雷达构建的二维地图包含了更多的环境空间的信息;与此同时,通过深度相机,能够探测到镂空结构的桌椅等通过激光雷达不能探测到的障碍物的信息,从而提升了构建的环境空间的地图的准确性;此外,深度相机不需要像激光雷达一样被配置在一定的高度也能有效工作,从而扫地机器人可以做到超薄,扩展了扫地机器人的有效工作空间;进一步地,通过配置多个深度相机,能够避免由于单个深度相机视场角较小,获取的相邻两帧深度图包含的重叠区域较少甚至无重叠区域,无法有效进行深度图的关联特征配对,造成确定扫地机器人的位姿失败的问题,以及扩展了扫地机器人同一时刻或位置的探测区域,提升了构建环境地图的效率。

本申请实施例提供了一种计算机可读存储介质,该计算机可读存储介质上存储有计算机程序,该程序被处理器执行时实现上述实施例中所示的方法。

本申请实施例提供了一种计算机可读存储介质,与现有技术基于激光雷达构建环境空间的二维地图相比,本申请实施例通过步骤a,基于获取到的两帧相邻深度图通过同时定位与建图slam算法确定扫地机器人在当前位置的位姿信息,任一帧深度图由扫地机器人配置的多个深度相机同步获取到的多帧元深度图融合处理得到,两帧相邻深度图包括扫地机器人在当前位置处获取到的深度图,步骤b,基于确定的扫地机器人在当前位置的位姿信息与获取到的扫地机器人在当前位置的深度图构建三维子地图,步骤c,控制扫地机器人移动至符合预定条件的下一位置,执行步骤a与步骤b,并对获取到的各个三维子地图进行拼接处理得到合并三维地图,继而循环执行步骤c,直至得到的合并三维地图为环境空间的全局三维地图。即本申请基于通过深度相机获取的深度图构建环境空间的三维地图,较构建的二维地图相比三维地图包含了障碍物在垂直方向的信息,因此三维地图较现有的基于激光雷达构建的二维地图包含了更多的环境空间的信息;与此同时,通过深度相机,能够探测到镂空结构的桌椅等通过激光雷达不能探测到的障碍物的信息,从而提升了构建的环境空间的地图的准确性;此外,深度相机不需要像激光雷达一样被配置在一定的高度也能有效工作,从而扫地机器人可以做到超薄,扩展了扫地机器人的有效工作空间;进一步地,通过配置多个深度相机,能够避免由于单个深度相机视场角较小,获取的相邻两帧深度图包含的重叠区域较少甚至无重叠区域,无法有效进行深度图的关联特征配对,造成确定扫地机器人的位姿失败的问题,以及扩展了扫地机器人同一时刻或位置的探测区域,提升了构建环境地图的效率。

本申请实施例提供了一种计算机可读存储介质适用于上述方法实施例。在此不再赘述。

应该理解的是,虽然附图的流程图中的各个步骤按照箭头的指示依次显示,但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明,这些步骤的执行并没有严格的顺序限制,其可以以其他的顺序执行。而且,附图的流程图中的至少一部分步骤可以包括多个子步骤或者多个阶段,这些子步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,其执行顺序也不必然是依次进行,而是可以与其他步骤或者其他步骤的子步骤或者阶段的至少一部分轮流或者交替地执行。

以上仅是本申请的部分实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本申请原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本申请的保护范围。

当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1