CN112462758B - 一种建图方法、装置、计算机可读存储介质及机器人 - Google Patents
一种建图方法、装置、计算机可读存储介质及机器人 Download PDFInfo
- Publication number
- CN112462758B CN112462758B CN202011232065.0A CN202011232065A CN112462758B CN 112462758 B CN112462758 B CN 112462758B CN 202011232065 A CN202011232065 A CN 202011232065A CN 112462758 B CN112462758 B CN 112462758B
- Authority
- CN
- China
- Prior art keywords
- grid
- map
- laser
- probability
- key frame
- 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
- 238000000034 method Methods 0.000 title claims abstract description 58
- 230000004927 fusion Effects 0.000 claims abstract description 31
- 238000013507 mapping Methods 0.000 claims abstract description 28
- 238000009434 installation Methods 0.000 claims abstract description 5
- 238000006243 chemical reaction Methods 0.000 claims description 30
- 238000004590 computer program Methods 0.000 claims description 20
- 230000008569 process Effects 0.000 claims description 18
- 238000005259 measurement Methods 0.000 claims description 10
- 238000004364 calculation method Methods 0.000 claims description 6
- 230000009466 transformation Effects 0.000 claims description 6
- 238000010586 diagram Methods 0.000 description 8
- 239000002245 particle Substances 0.000 description 7
- 230000006870 function Effects 0.000 description 6
- 238000012545 processing Methods 0.000 description 6
- 238000001514 detection method Methods 0.000 description 4
- 230000004044 response Effects 0.000 description 4
- 230000008878 coupling Effects 0.000 description 3
- 238000010168 coupling process Methods 0.000 description 3
- 238000005859 coupling reaction Methods 0.000 description 3
- BDEDPKFUFGCVCJ-UHFFFAOYSA-N 3,6-dihydroxy-8,8-dimethyl-1-oxo-3,4,7,9-tetrahydrocyclopenta[h]isochromene-5-carbaldehyde Chemical compound O=C1OC(O)CC(C(C=O)=C2O)=C1C1=C2CC(C)(C)C1 BDEDPKFUFGCVCJ-UHFFFAOYSA-N 0.000 description 2
- 238000004891 communication Methods 0.000 description 2
- 238000010276 construction Methods 0.000 description 2
- 238000001914 filtration Methods 0.000 description 2
- 238000005457 optimization Methods 0.000 description 2
- 238000004422 calculation algorithm Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000013480 data collection Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000009191 jumping Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000000474 nursing effect Effects 0.000 description 1
- 230000003287 optical effect 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 or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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
- 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
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
-
- 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/38—Electronic maps specially adapted for navigation; Updating thereof
- G01C21/3804—Creation or updating of map data
- G01C21/3807—Creation or updating of map data characterised by the type of data
- G01C21/383—Indoor data
-
- 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/38—Electronic maps specially adapted for navigation; Updating thereof
- G01C21/3804—Creation or updating of map data
- G01C21/3833—Creation or updating of map data characterised by the source of data
- G01C21/3837—Data obtained from a single source
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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 or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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 or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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
Abstract
本申请属于机器人技术领域,尤其涉及一种建图方法、装置、计算机可读存储介质及机器人。所述方法应用于机器人中,所述机器人包括第一激光雷达和第二激光雷达,所述第一激光雷达的安装位置高于所述第二激光雷达的安装位置,所述方法包括:获取第一激光关键帧;根据所述第一激光关键帧计算所述机器人的当前位姿;根据所述当前位姿和所述第一激光关键帧更新第一概率地图,得到更新后的第一概率地图;获取第二激光关键帧;根据所述当前位姿和所述第二激光关键帧更新第二概率地图,得到更新后的第二概率地图;根据所述更新后的第一概率地图和所述更新后的第二概率地图生成用于机器人导航的融合栅格地图,极大提高了定位导航的稳定性。
Description
技术领域
本申请属于机器人技术领域,尤其涉及一种建图方法、装置、计算机可读存储介质及机器人。
背景技术
机器人的激光建图与定位技术(Simultaneous Localization And Mapping,SLAM)是机器人根据激光雷达数据创建激光导航地图的重要方法,为后续的激光导航中的实时定位和导航规划起到了重要的作用。但是,在办公室、图书馆、养老院、病房等地方具有非常多的可移动桌椅、病床等物体,这些物体的高度比较矮,一般都不超过1.5米,而这些可移动物体使得定位导航的环境易于变化,从而可能导致机器人的定位导航结果的稳定性较差。
发明内容
有鉴于此,本申请实施例提供了一种建图方法、装置、计算机可读存储介质及机器人,以解决在具有可移动物体的环境中,机器人的定位导航结果的稳定性较差的问题。
本申请实施例的第一方面提供了一种建图方法,应用于机器人中,所述机器人包括第一激光雷达和第二激光雷达,所述第一激光雷达的安装位置高于所述第二激光雷达的安装位置,所述方法包括:
获取第一激光关键帧,所述第一激光关键帧为所述第一激光雷达采集的当前激光关键帧;
根据所述第一激光关键帧计算所述机器人的当前位姿;
根据所述当前位姿和所述第一激光关键帧更新第一概率地图,得到更新后的第一概率地图,所述第一概率地图为与所述第一激光雷达对应的概率地图;
获取第二激光关键帧,所述第二激光关键帧为所述第二激光雷达采集的当前激光关键帧;
根据所述当前位姿和所述第二激光关键帧更新第二概率地图,得到更新后的第二概率地图,所述第二概率地图为与所述第二激光雷达对应的概率地图;
根据所述更新后的第一概率地图和所述更新后的第二概率地图生成用于机器人导航的融合栅格地图。
进一步地,所述根据所述更新后的第一概率地图和所述更新后的第二概率地图生成用于机器人导航的融合栅格地图,包括:
生成与所述更新后的第一概率地图对应的第一栅格地图;
生成与所述更新后的第二概率地图对应的第二栅格地图;
根据预设的相对位姿转换关系将所述第一栅格地图和所述第二栅格地图进行融合,得到所述融合栅格地图,所述相对位姿转换关系为所述第一激光雷达与所述第二激光雷达之间的相对位姿转换关系。
进一步地,所述生成与所述更新后的第一概率地图对应的第一栅格地图,包括:
确定目标栅格在所述更新后的第一概率地图中的占用概率值,所述目标栅格为所述第一栅格地图中的任意一个栅格;
根据所述占用概率值确定所述目标栅格的栅格类型。
进一步地,所述根据所述占用概率值确定所述目标栅格的栅格类型,包括:
若所述占用概率值大于或等于预设的概率阈值,则确定所述目标栅格为黑色栅格;
若所述占用概率值小于所述概率阈值,则确定所述目标栅格为白色栅格;
若所述占用概率值为空,则确定所述目标栅格为灰色栅格。
进一步地,所述相对位姿转换关系的设置过程包括:
分别获取所述第一激光雷达对目标物体的第一测距结果和所述第二激光雷达对所述目标物体的第二测距结果,所述目标物体为沿铅垂线方向竖直放置的物体;
根据所述第一测距结果和所述第二测距结果确定所述相对位姿转换关系。
进一步地,所述根据预设的相对位姿转换关系将所述第一栅格地图和所述第二栅格地图进行融合,得到所述融合栅格地图,包括:
根据预设的相对位姿转换关系对齐所述第一栅格地图和所述第二栅格地图;
对于所述融合栅格地图中的任意一个栅格,若符合第一预设条件,则确定该栅格为黑色栅格;所述第一预设条件为:在所述第一栅格地图中对应的栅格为黑色栅格;
若符合第二预设条件,则确定该栅格为白色栅格;所述第二预设条件为:在所述第一栅格地图中对应的栅格不为黑色栅格,且在所述第二栅格地图中对应的栅格为白色栅格;
若均不符合所述第一预设条件和所述第二预设条件,则确定该栅格为灰色栅格。
进一步地,所述根据所述当前位姿和所述第一激光关键帧更新第一概率地图,得到更新后的第一概率地图,包括:
根据所述当前位姿对所述第一概率地图中与所述第一激光关键帧对应的各个连线栅格的第一计数值和第二计数值分别进行更新,得到更新后的第一计数值和更新后的第二计数值,所述连线栅格为处于被激光打到的栅格和所述第一激光雷达之间的连线上的栅格,所述第一计数值为所述连线栅格被所述第一激光雷达发射的激光打到的次数,所述第二计数值为所述连线栅格处于被激光打到的栅格和所述第一激光雷达之间的连线上的次数;
根据所述更新后的第一计数值和所述更新后的第二计数值分别对各个连线栅格在所述第一概率地图中的占用概率值进行更新,得到所述更新后的第一概率地图。
本申请实施例的第二方面提供了一种建图装置,应用于机器人中,所述机器人包括第一激光雷达和第二激光雷达,所述第一激光雷达的安装位置高于所述第二激光雷达的安装位置,所述建图装置可以包括:
第一数据获取模块,用于获取第一激光关键帧,所述第一激光关键帧为所述第一激光雷达采集的当前激光关键帧;
位姿计算模块,用于根据所述第一激光关键帧计算所述机器人的当前位姿;
第一地图更新模块,用于根据所述当前位姿和所述第一激光关键帧更新第一概率地图,得到更新后的第一概率地图,所述第一概率地图为与所述第一激光雷达对应的概率地图;
第二数据获取模块,用于获取第二激光关键帧,所述第二激光关键帧为所述第二激光雷达采集的当前激光关键帧;
第二地图更新模块,用于根据所述当前位姿和所述第二激光关键帧更新第二概率地图,得到更新后的第二概率地图,所述第二概率地图为与所述第二激光雷达对应的概率地图;
地图融合模块,用于根据所述更新后的第一概率地图和所述更新后的第二概率地图生成用于机器人导航的融合栅格地图。
进一步地,所述地图融合模块可以包括:
第一栅格地图生成子模块,用于生成与所述更新后的第一概率地图对应的第一栅格地图;
第二栅格地图生成子模块,用于生成与所述更新后的第二概率地图对应的第二栅格地图;
地图融合子模块,用于根据预设的相对位姿转换关系将所述第一栅格地图和所述第二栅格地图进行融合,得到所述融合栅格地图,所述相对位姿转换关系为所述第一激光雷达与所述第二激光雷达之间的相对位姿转换关系。
进一步地,所述第一栅格地图生成子模块可以包括:
占用概率值计算单元,用于确定目标栅格在所述更新后的第一概率地图中的占用概率值,所述目标栅格为所述第一栅格地图中的任意一个栅格;
栅格类型确定单元,用于根据所述占用概率值确定所述目标栅格的栅格类型。
进一步地,所述栅格类型确定单元具体用于:
若所述占用概率值大于或等于预设的概率阈值,则确定所述目标栅格为黑色栅格;
若所述占用概率值小于所述概率阈值,则确定所述目标栅格为白色栅格;
若所述占用概率值为空,则确定所述目标栅格为灰色栅格。
进一步地,所述建图装置还可以包括:
测距模块,用于分别获取所述第一激光雷达对目标物体的第一测距结果和所述第二激光雷达对所述目标物体的第二测距结果,所述目标物体为沿铅垂线方向竖直放置的物体;
相对位姿确定模块,用于根据所述第一测距结果和所述第二测距结果确定所述相对位姿转换关系。
进一步地,所述地图融合子模块可以包括:
对齐单元,用于根据预设的相对位姿转换关系对齐所述第一栅格地图和所述第二栅格地图;
黑色栅格确定单元,用于对于所述融合栅格地图中的任意一个栅格,若符合第一预设条件,则确定该栅格为黑色栅格;所述第一预设条件为:在所述第一栅格地图中对应的栅格为黑色栅格;
白色栅格确定单元,用于若符合第二预设条件,则确定该栅格为白色栅格;所述第二预设条件为:在所述第一栅格地图中对应的栅格不为黑色栅格,且在所述第二栅格地图中对应的栅格为白色栅格;
灰色栅格确定单元,用于若均不符合所述第一预设条件和所述第二预设条件,则确定该栅格为灰色栅格。
进一步地,所述第一地图更新模块具体用于:
根据所述当前位姿对所述第一概率地图中与所述第一激光关键帧对应的各个连线栅格的第一计数值和第二计数值分别进行更新,得到更新后的第一计数值和更新后的第二计数值,所述连线栅格为处于被激光打到的栅格和所述第一激光雷达之间的连线上的栅格,所述第一计数值为所述连线栅格被所述第一激光雷达发射的激光打到的次数,所述第二计数值为所述连线栅格处于被激光打到的栅格和所述第一激光雷达之间的连线上的次数;
根据所述更新后的第一计数值和所述更新后的第二计数值分别对各个连线栅格在所述第一概率地图中的占用概率值进行更新,得到所述更新后的第一概率地图。
本申请实施例的第三方面提供了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时实现上述任一种建图方法的步骤。
本申请实施例的第四方面提供了一种机器人,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现上述任一种建图方法的步骤。
本申请实施例的第五方面提供了一种计算机程序产品,当计算机程序产品在机器人上运行时,使得机器人执行上述任一种建图方法的步骤。
本申请实施例与现有技术相比存在的有益效果是:本申请实施例采用了一种双激光雷达同时建图的SLAM架构,即同时使用一个较高位置的第一激光雷达和一个较低位置的第二激光雷达进行建图,由于第一激光雷达的位置较高,受到可移动物体的干扰较小,因此可以提供较为稳定的定位结果,在此基础上,对两个激光雷达的数据进行融合建图,得到一个融合的地图,据此进行导航能过提前绕开环境中的可移动物体,极大提高了定位导航的稳定性。
附图说明
为了更清楚地说明本申请实施例中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其它的附图。
图1为本申请实施例中一种建图方法的一个实施例流程图;
图2为激光打到障碍点过程的示意图;
图3为将第一栅格地图和第二栅格地图进行融合的示意图;
图4为本申请实施例中一种建图装置的一个实施例结构图;
图5为本申请实施例中一种机器人的示意框图。
具体实施方式
为使得本申请的发明目的、特征、优点能够更加的明显和易懂,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,下面所描述的实施例仅仅是本申请一部分实施例,而非全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例,都属于本申请保护的范围。
应当理解,当在本说明书和所附权利要求书中使用时,术语“包括”指示所描述特征、整体、步骤、操作、元素和/或组件的存在,但并不排除一个或多个其它特征、整体、步骤、操作、元素、组件和/或其集合的存在或添加。
还应当理解,在此本申请说明书中所使用的术语仅仅是出于描述特定实施例的目的而并不意在限制本申请。如在本申请说明书和所附权利要求书中所使用的那样,除非上下文清楚地指明其它情况,否则单数形式的“一”、“一个”及“该”意在包括复数形式。
还应当进一步理解,在本申请说明书和所附权利要求书中使用的术语“和/或”是指相关联列出的项中的一个或多个的任何组合以及所有可能组合,并且包括这些组合。
如在本说明书和所附权利要求书中所使用的那样,术语“如果”可以依据上下文被解释为“当...时”或“一旦”或“响应于确定”或“响应于检测到”。类似地,短语“如果确定”或“如果检测到[所描述条件或事件]”可以依据上下文被解释为意指“一旦确定”或“响应于确定”或“一旦检测到[所描述条件或事件]”或“响应于检测到[所描述条件或事件]”。
另外,在本申请的描述中,术语“第一”、“第二”、“第三”等仅用于区分描述,而不能理解为指示或暗示相对重要性。
一般地,在进行激光建图时可以采用以下几种方法:一种是基于粒子滤波的激光建图,该方法通过RBPF(Rao-Blackwellized Particle Filters)等粒子滤波方法进行位姿估计,在构建小场景地图时计算量较小且精度较高,由于基于粒子的方法当面积较大时以及要采用双雷达时会急剧增大其处理需要的资源,同时每个粒子都携带一副地图,因此在构建较大地图及要输入更多雷达数据时,所需的内存和计算量都会急剧增加。因此,粒子的方法不适合对其进行扩展去建较大的地图和进行双雷达建图。
另一种基于关键帧匹配的方法,通过在关键帧之间建立约束,可以很好的进行回环检测与优化,同时这种结构也非常适用于较大面积场景的建图以及多雷达的建图,由于其关键帧和约束的思想,可以将两个雷达数据进行定位时建立足够多的约束关系,使得建出的地图更加准确和清晰无重影。
当前的关键帧方法只在计算时采用了单个雷达的关键帧,如果直接同时输入多个雷达数据时,建出的地图没有进行分层区分处理,这就会使得两个雷达的数据产生混合,同时两个雷达数据作为一个输入用来定位,则会产生两个定位,就会产生定位的跳动问题。
本申请实施例提出了一种可以进行稳定、灵活处理双雷达数据的建图方法,可以应用于安装有双激光雷达(分别记为第一激光雷达和第二激光雷达)的机器人中,其中,所述第一激光雷达的安装位置高于所述第二激光雷达的安装位置。所述第一激光雷达安装在较高的地方,不会扫描到普通的桌椅等可移动物体,所述第二激光雷达安装在低处,可以扫描到这些可移动物体。
请参阅图1,本申请实施例中一种建图方法的一个实施例可以包括:
步骤S101、获取第一激光关键帧。
所述第一激光关键帧为所述第一激光雷达采集的当前激光关键帧。
机器人可以通过激光雷达来探测周边环境,其工作原理是向目标发射探测信号(激光),然后将接收到的从目标反射回来的信号与探测信号进行比较,作适当处理后,就可获得目标的有关信息,从而对目标进行探测、跟踪和识别。一般地,机器人可以按照预先设定的一个数据采集频率来进行激光数据的采集,每隔一定的时间间隔即采集一帧激光数据。具体的数据采集频率可以根据实际情况进行设置,本申请实施例对此不作具体限定。
机器人在开始建图后可以将第一个激光数据帧作为激光关键帧,后续获取新的激光数据帧时,将新的激光数据帧与当前的激光关键帧进行比较,若两者之间的位置差大于预设的位置差阈值或者两者之间的角度差大于预设的角度阈值,则判定新的激光数据帧为新的一个激光关键帧,反之,若两者之间的位置差小于等于所述位置差阈值且两者之间的角度差小于等于所述角度阈值,则判定新的激光数据帧不是新的一个激光关键帧。所述位置差阈值及所述角度阈值的具体取值可以根据实际情况进行设置,本申请实施例对此不作具体限定。可选地,若新的激光数据帧的采集时刻与当前的激光关键帧的采集时刻之间的时间差大于预设的时间阈值,则也可以判定新的激光数据帧为新的一个激光关键帧。所述时间阈值的具体取值可以根据实际情况进行设置,本申请实施例对此不作具体限定。不断重复以上过程,即可依次得到建图过程中的各个激光关键帧。
需要注意的是,本申请中所提及的“当前激光关键帧”,是指机器人当前正在处理的激光关键帧,其指代的是一个动态的对象,而非特指某一激光关键帧,例如,机器人首先处理第一次采集的激光关键帧,将其记为激光关键帧1,则当前激光关键帧即为激光关键帧1,当机器人处理完激光关键帧1之后,继续处理第二次采集的激光关键帧,将其记为激光关键帧2,则当前激光关键帧即为激光关键帧2,当机器人处理完激光关键帧2之后,继续处理第三次采集的激光关键帧,将其记为激光关键帧3,则当前激光关键帧即为激光关键帧3,…,以此类推。
步骤S102、根据所述第一激光关键帧计算所述机器人的当前位姿。
在获取到所述第一激光关键帧之后,可以通过高斯牛顿匹配法进行迭代优化,使得所述第一激光关键帧中包含的激光轮廓点与第一概率地图的轮廓点对齐,并根据对齐的激光轮廓点反算出所述机器人的当前位姿。
其中,所述第一概率地图为与所述第一激光雷达对应的概率地图,即根据所述第一激光雷达采集的各个激光关键帧所构建的概率地图,所述第一概率地图在所述第一激光雷达采集到第一帧激光关键帧时即进行初始构建,之后每采集到一帧激光关键帧即进行地图更新。
步骤S103、根据所述当前位姿和所述第一激光关键帧更新第一概率地图,得到更新后的第一概率地图。
确定所述当前位姿之后,则可以根据所述当前位姿将所述第一激光关键帧中的数据叠加到所述第一概率地图中,对所述第一概率地图中与所述第一激光关键帧对应的各个连线栅格的第一计数值和第二计数值分别进行更新,得到更新后的第一计数值和更新后的第二计数值。
图2所示为激光打到障碍点过程的一个示意图,空心原点为激光雷达,实心原点为障碍物,障碍物所在栅格被×标记,障碍物与激光器之间的连线所在栅格被标记为灰色。此处的连线栅格为处于被激光打到的栅格和所述第一激光雷达之间的连线上的栅格,所述第一计数值为所述连线栅格被所述第一激光雷达发射的激光打到的次数,所述第二计数值为所述连线栅格处于被激光打到的栅格和所述第一激光雷达之间的连线上的次数。
此处将所述第一计数值记为n1,将所述第二计数值记为visit1。容易理解地,当激光打到某一栅格时,该栅格的n1和visit1会同时累加,即执行:n1=n1+1,visit1=visit1+1;当激光未打到该栅格,而该栅格处于被激光打到的栅格和所述第一激光雷达之间的连线时,n1保持不变,visit1累加,即只执行:visit1=visit1+1。
然后,根据所述更新后的第一计数值和所述更新后的第二计数值分别对各个连线栅格在所述第一概率地图中的占用概率值进行更新。
具体地,对于任意一个连线栅格,可以根据下式计算其在所述第一概率地图中的占用概率值:
P(hit1)=n1/visit1
其中,P(hit1)即为该栅格在所述第一概率地图中的占用概率值。
在原有的第一概率地图的基础上,遍历所有的连线栅格,对其占用概率值均进行更新,即可得到所述更新后的第一概率地图。
步骤S104、获取第二激光关键帧。
所述第二激光关键帧为所述第二激光雷达采集的当前激光关键帧。
步骤S105、根据所述当前位姿和所述第二激光关键帧更新第二概率地图,得到更新后的第二概率地图。
所述第二概率地图为与所述第二激光雷达对应的概率地图,即根据所述第二激光雷达采集的各个激光关键帧所构建的概率地图,所述第二概率地图在所述第二激光雷达采集到第一帧激光关键帧时即进行初始构建,之后每采集到一帧激光关键帧即进行地图更新。
确定所述当前位姿之后,则可以根据所述当前位姿将所述第二激光关键帧中的数据叠加到所述第二概率地图中,对所述第二概率地图中与所述第二激光关键帧对应的各个连线栅格的第三计数值和第四计数值分别进行更新,得到更新后的第三计数值和更新后的第四计数值。
此处的连线栅格为处于被激光打到的栅格和所述第二激光雷达之间的连线上的栅格,所述第三计数值为所述连线栅格被所述第二激光雷达发射的激光打到的次数,所述第四计数值为所述连线栅格处于被激光打到的栅格和所述第二激光雷达之间的连线上的次数。
此处将所述第三计数值记为n2,将所述第四计数值记为visit2。容易理解地,当激光打到某一栅格时,该栅格的n2和visit2会同时累加,即执行:n2=n2+1,visit2=visit2+1;当激光未打到该栅格,而该栅格处于被激光打到的栅格和所述第二激光雷达之间的连线时,n2保持不变,visit2累加,即只执行:visit2=visit2+1。
然后,根据所述更新后的第三计数值和所述更新后的第四计数值分别对各个连线栅格在所述第二概率地图中的占用概率值进行更新。
具体地,对于任意一个连线栅格,可以根据下式计算其在所述第二概率地图中的占用概率值:
P(hit2)=n2/visit2
其中,P(hit2)即为该栅格在所述第二概率地图中的占用概率值。
在原有的第二概率地图的基础上,遍历所有的连线栅格,对其占用概率值均进行更新,即可得到所述更新后的第二概率地图。
步骤S106、根据所述更新后的第一概率地图和所述更新后的第二概率地图生成用于机器人导航的融合栅格地图。
首先,生成与所述更新后的第一概率地图对应的第一栅格地图,并生成与所述更新后的第二概率地图对应的第二栅格地图。
以所述第一栅格地图中的任意一个栅格(记为目标栅格)为例,可以确定所述目标栅格在所述更新后的第一概率地图中的占用概率值,并根据所述占用概率值确定所述目标栅格的栅格类型。具体地,若所述占用概率值大于或等于预设的概率阈值,则确定所述目标栅格为黑色栅格;若所述占用概率值小于所述概率阈值,则确定所述目标栅格为白色栅格;若所述占用概率值为空,即visit1=0,则确定所述目标栅格为灰色栅格。照此遍历所述第一栅格地图中的所有栅格,则可以得到所有栅格的栅格类型,由这些黑白灰的栅格组成的地图即为所述第一栅格地图。所述概率阈值的具体取值可以根据实际情况进行设置,本申请实施例对此不作具体限定。所述第二栅格地图的生成过程与所述第一栅格地图的生成过程类似,此处不再赘述。
然后,根据预设的相对位姿转换关系将所述第一栅格地图和所述第二栅格地图进行融合,得到所述融合栅格地图。
所述相对位姿转换关系为所述第一激光雷达与所述第二激光雷达之间的相对位姿转换关系。在所述相对位姿转换关系的设置过程中,可以先通过所述机器人的机械结构确定两个激光雷达之间粗略的相对位姿,再通过两个激光雷达对周围环境的扫描来进行精确的标定,得到两个激光雷达之间的相对位姿转换关系。在本申请实施例中,两个激光雷达是在水平方向安装的,因此可以让两个激光雷达扫描同一个沿铅垂线方向竖直放置的物体(记为目标物体),分别获取所述第一激光雷达对目标物体的第一测距结果和所述第二激光雷达对所述目标物体的第二测距结果,根据所述第一测距结果和所述第二测距结果确定所述相对位姿转换关系。例如,可以计算这两个测距结果之差,得到两个激光雷达之间的水平距离,将其作为所述相对位姿转换关系。
在进行地图融合时,可以首先根据所述相对位姿转换关系对齐所述第一栅格地图和所述第二栅格地图,然后再将两者进行融合,得到所述融合栅格地图。
在本申请实施例的一种具体实现中,对于所述融合栅格地图中的任意一个栅格,若符合第一预设条件,则确定该栅格为黑色栅格;若符合第二预设条件,则确定该栅格为白色栅格;若均不符合所述第一预设条件和所述第二预设条件,则确定该栅格为灰色栅格。其中,所述第一预设条件为:在所述第一栅格地图中对应的栅格为黑色栅格;所述第二预设条件为:在所述第一栅格地图中对应的栅格不为黑色栅格,且在所述第二栅格地图中对应的栅格为白色栅格。照此遍历所述融合栅格地图中的所有栅格,即可确定所述融合栅格地图中的所有栅格的栅格类型,从而得到最终的融合栅格地图。图3所示即为具体融合效果的示例图。需要注意的是,以上仅为一种可能的融合方式,还可以根据实际情况设置其它的融合方式,本申请实施例对此不作具体限定。
综上所述,本申请实施例采用了一种双激光雷达同时建图的SLAM架构,即同时使用一个较高位置的第一激光雷达和一个较低位置的第二激光雷达同时进行建图,由于第一激光雷达的位置较高,受到可移动物体的干扰较小,因此可以提供较为稳定的定位结果,在此基础上,对两个激光雷达的数据进行融合建图,得到一个融合的地图,据此进行导航能过提前绕开环境中的可移动物体,极大提高了定位导航的稳定性。
应理解,上述实施例中各步骤的序号的大小并不意味着执行顺序的先后,各过程的执行顺序应以其功能和内在逻辑确定,而不应对本申请实施例的实施过程构成任何限定。
对应于上文实施例所述的一种建图方法,图4示出了本申请实施例提供的一种建图装置的一个实施例结构图。所述建图装置应用于机器人中,所述机器人包括第一激光雷达和第二激光雷达,所述第一激光雷达的安装位置高于所述第二激光雷达的安装位置,所述建图装置可以包括:
第一数据获取模块401,用于获取第一激光关键帧,所述第一激光关键帧为所述第一激光雷达采集的当前激光关键帧;
位姿计算模块402,用于根据所述第一激光关键帧计算所述机器人的当前位姿;
第一地图更新模块403,用于根据所述当前位姿和所述第一激光关键帧更新第一概率地图,得到更新后的第一概率地图,所述第一概率地图为与所述第一激光雷达对应的概率地图;
第二数据获取模块404,用于获取第二激光关键帧,所述第二激光关键帧为所述第二激光雷达采集的当前激光关键帧;
第二地图更新模块405,用于根据所述当前位姿和所述第二激光关键帧更新第二概率地图,得到更新后的第二概率地图,所述第二概率地图为与所述第二激光雷达对应的概率地图;
地图融合模块406,用于根据所述更新后的第一概率地图和所述更新后的第二概率地图生成用于机器人导航的融合栅格地图。
进一步地,所述地图融合模块可以包括:
第一栅格地图生成子模块,用于生成与所述更新后的第一概率地图对应的第一栅格地图;
第二栅格地图生成子模块,用于生成与所述更新后的第二概率地图对应的第二栅格地图;
地图融合子模块,用于根据预设的相对位姿转换关系将所述第一栅格地图和所述第二栅格地图进行融合,得到所述融合栅格地图,所述相对位姿转换关系为所述第一激光雷达与所述第二激光雷达之间的相对位姿转换关系。
进一步地,所述第一栅格地图生成子模块可以包括:
占用概率值计算单元,用于确定目标栅格在所述更新后的第一概率地图中的占用概率值,所述目标栅格为所述第一栅格地图中的任意一个栅格;
栅格类型确定单元,用于根据所述占用概率值确定所述目标栅格的栅格类型。
进一步地,所述栅格类型确定单元具体用于:
若所述占用概率值大于或等于预设的概率阈值,则确定所述目标栅格为黑色栅格;
若所述占用概率值小于所述概率阈值,则确定所述目标栅格为白色栅格;
若所述占用概率值为空,则确定所述目标栅格为灰色栅格。
进一步地,所述建图装置还可以包括:
测距模块,用于分别获取所述第一激光雷达对目标物体的第一测距结果和所述第二激光雷达对所述目标物体的第二测距结果,所述目标物体为沿铅垂线方向竖直放置的物体;
相对位姿确定模块,用于根据所述第一测距结果和所述第二测距结果确定所述相对位姿转换关系。
进一步地,所述地图融合子模块可以包括:
对齐单元,用于根据预设的相对位姿转换关系对齐所述第一栅格地图和所述第二栅格地图;
黑色栅格确定单元,用于对于所述融合栅格地图中的任意一个栅格,若符合第一预设条件,则确定该栅格为黑色栅格;所述第一预设条件为:在所述第一栅格地图中对应的栅格为黑色栅格;
白色栅格确定单元,用于若符合第二预设条件,则确定该栅格为白色栅格;所述第二预设条件为:在所述第一栅格地图中对应的栅格不为黑色栅格,且在所述第二栅格地图中对应的栅格为白色栅格;
灰色栅格确定单元,用于若均不符合所述第一预设条件和所述第二预设条件,则确定该栅格为灰色栅格。
进一步地,所述第一地图更新模块具体用于:
根据所述当前位姿对所述第一概率地图中与所述第一激光关键帧对应的各个连线栅格的第一计数值和第二计数值分别进行更新,得到更新后的第一计数值和更新后的第二计数值,所述连线栅格为处于被激光打到的栅格和所述第一激光雷达之间的连线上的栅格,所述第一计数值为所述连线栅格被所述第一激光雷达发射的激光打到的次数,所述第二计数值为所述连线栅格处于被激光打到的栅格和所述第一激光雷达之间的连线上的次数;
根据所述更新后的第一计数值和所述更新后的第二计数值分别对各个连线栅格在所述第一概率地图中的占用概率值进行更新,得到所述更新后的第一概率地图。
所属领域的技术人员可以清楚地了解到,为描述的方便和简洁,上述描述的装置,模块和单元的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。
在上述实施例中,对各个实施例的描述都各有侧重,某个实施例中没有详述或记载的部分,可以参见其它实施例的相关描述。
图5示出了本申请实施例提供的一种机器人的示意框图,为了便于说明,仅示出了与本申请实施例相关的部分。
如图5所示,该实施例的机器人5包括:处理器50、存储器51以及存储在所述存储器51中并可在所述处理器50上运行的计算机程序52。所述处理器50执行所述计算机程序52时实现上述各个建图方法实施例中的步骤,例如图1所示的步骤S101至步骤S106。或者,所述处理器50执行所述计算机程序52时实现上述各装置实施例中各模块/单元的功能,例如图4所示模块401至模块406的功能。
示例性的,所述计算机程序52可以被分割成一个或多个模块/单元,所述一个或者多个模块/单元被存储在所述存储器51中,并由所述处理器50执行,以完成本申请。所述一个或多个模块/单元可以是能够完成特定功能的一系列计算机程序指令段,该指令段用于描述所述计算机程序52在所述机器人5中的执行过程。
本领域技术人员可以理解,图5仅仅是机器人5的示例,并不构成对机器人5的限定,可以包括比图示更多或更少的部件,或者组合某些部件,或者不同的部件,例如所述机器人5还可以包括输入输出设备、网络接入设备、总线等。
所述处理器50可以是中央处理单元(Central Processing Unit,CPU),还可以是其它通用处理器、数字信号处理器(Digital Signal Processor,DSP)、专用集成电路(Application Specific Integrated Circuit,ASIC)、现场可编程门阵列(Field-Programmable Gate Array,FPGA)或者其它可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。
所述存储器51可以是所述机器人5的内部存储单元,例如机器人5的硬盘或内存。所述存储器51也可以是所述机器人5的外部存储设备,例如所述机器人5上配备的插接式硬盘,智能存储卡(Smart Media Card,SMC),安全数字(Secure Digital,SD)卡,闪存卡(Flash Card)等。进一步地,所述存储器51还可以既包括所述机器人5的内部存储单元也包括外部存储设备。所述存储器51用于存储所述计算机程序以及所述机器人5所需的其它程序和数据。所述存储器51还可以用于暂时地存储已经输出或者将要输出的数据。
所属领域的技术人员可以清楚地了解到,为了描述的方便和简洁,仅以上述各功能单元、模块的划分进行举例说明,实际应用中,可以根据需要而将上述功能分配由不同的功能单元、模块完成,即将所述装置的内部结构划分成不同的功能单元或模块,以完成以上描述的全部或者部分功能。实施例中的各功能单元、模块可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中,上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。另外,各功能单元、模块的具体名称也只是为了便于相互区分,并不用于限制本申请的保护范围。上述系统中单元、模块的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。
在上述实施例中,对各个实施例的描述都各有侧重,某个实施例中没有详述或记载的部分,可以参见其它实施例的相关描述。
本领域普通技术人员可以意识到,结合本文中所公开的实施例描述的各示例的单元及算法步骤,能够以电子硬件、或者计算机软件和电子硬件的结合来实现。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本申请的范围。
在本申请所提供的实施例中,应该理解到,所揭露的装置/机器人和方法,可以通过其它的方式实现。例如,以上所描述的装置/机器人实施例仅仅是示意性的,例如,所述模块或单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通讯连接可以是通过一些接口,装置或单元的间接耦合或通讯连接,可以是电性,机械或其它的形式。
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
另外,在本申请各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。
所述集成的模块/单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读存储介质中。基于这样的理解,本申请实现上述实施例方法中的全部或部分流程,也可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一计算机可读存储介质中,该计算机程序在被处理器执行时,可实现上述各个方法实施例的步骤。其中,所述计算机程序包括计算机程序代码,所述计算机程序代码可以为源代码形式、对象代码形式、可执行文件或某些中间形式等。所述计算机可读存储介质可以包括:能够携带所述计算机程序代码的任何实体或装置、记录介质、U盘、移动硬盘、磁碟、光盘、计算机存储器、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、电载波信号、电信信号以及软件分发介质等。需要说明的是,所述计算机可读存储介质包含的内容可以根据司法管辖区内立法和专利实践的要求进行适当的增减,例如在某些司法管辖区,根据立法和专利实践,计算机可读存储介质不包括电载波信号和电信信号。
以上所述实施例仅用以说明本申请的技术方案,而非对其限制;尽管参照前述实施例对本申请进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本申请各实施例技术方案的精神和范围,均应包含在本申请的保护范围之内。
Claims (8)
1.一种建图方法,其特征在于,应用于机器人中,所述机器人包括第一激光雷达和第二激光雷达,所述第一激光雷达的安装位置高于所述第二激光雷达的安装位置,所述第一激光雷达安装在较高的地方,不会扫描到普通的桌椅可移动物体,所述第二激光雷达安装在低处,能扫描到这些可移动物体,所述方法包括:
获取第一激光关键帧,所述第一激光关键帧为所述第一激光雷达采集的当前激光关键帧;
根据所述第一激光关键帧计算所述机器人的当前位姿;
根据所述当前位姿和所述第一激光关键帧更新第一概率地图,得到更新后的第一概率地图,所述第一概率地图为与所述第一激光雷达对应的概率地图;
获取第二激光关键帧,所述第二激光关键帧为所述第二激光雷达采集的当前激光关键帧;
根据所述当前位姿和所述第二激光关键帧更新第二概率地图,得到更新后的第二概率地图,所述第二概率地图为与所述第二激光雷达对应的概率地图;
生成与所述更新后的第一概率地图对应的第一栅格地图;
生成与所述更新后的第二概率地图对应的第二栅格地图;
根据预设的相对位姿转换关系将所述第一栅格地图和所述第二栅格地图进行融合,得到所述融合栅格地图,所述相对位姿转换关系为所述第一激光雷达与所述第二激光雷达之间的相对位姿转换关系;
所述根据预设的相对位姿转换关系将所述第一栅格地图和所述第二栅格地图进行融合,得到所述融合栅格地图,包括:
根据预设的相对位姿转换关系对齐所述第一栅格地图和所述第二栅格地图;
对于所述融合栅格地图中的任意一个栅格,若符合第一预设条件,则确定该栅格为黑色栅格;所述第一预设条件为:在所述第一栅格地图中对应的栅格为黑色栅格;
若符合第二预设条件,则确定该栅格为白色栅格;所述第二预设条件为:在所述第一栅格地图中对应的栅格不为黑色栅格,且在所述第二栅格地图中对应的栅格为白色栅格;
若均不符合所述第一预设条件和所述第二预设条件,则确定该栅格为灰色栅格。
2.根据权利要求1所述的建图方法,其特征在于,所述生成与所述更新后的第一概率地图对应的第一栅格地图,包括:
确定目标栅格在所述更新后的第一概率地图中的占用概率值,所述目标栅格为所述第一栅格地图中的任意一个栅格;
根据所述占用概率值确定所述目标栅格的栅格类型。
3.根据权利要求2所述的建图方法,其特征在于,所述根据所述占用概率值确定所述目标栅格的栅格类型,包括:
若所述占用概率值大于或等于预设的概率阈值,则确定所述目标栅格为黑色栅格;
若所述占用概率值小于所述概率阈值,则确定所述目标栅格为白色栅格;
若所述占用概率值为空,则确定所述目标栅格为灰色栅格。
4.根据权利要求1所述的建图方法,其特征在于,所述相对位姿转换关系的设置过程包括:
分别获取所述第一激光雷达对目标物体的第一测距结果和所述第二激光雷达对所述目标物体的第二测距结果,所述目标物体为沿铅垂线方向竖直放置的物体;
根据所述第一测距结果和所述第二测距结果确定所述相对位姿转换关系。
5.根据权利要求1至4中任一项所述的建图方法,其特征在于,所述根据所述当前位姿和所述第一激光关键帧更新第一概率地图,得到更新后的第一概率地图,包括:
根据所述当前位姿对所述第一概率地图中与所述第一激光关键帧对应的各个连线栅格的第一计数值和第二计数值分别进行更新,得到更新后的第一计数值和更新后的第二计数值,所述连线栅格为处于被激光打到的栅格和所述第一激光雷达之间的连线上的栅格,所述第一计数值为所述连线栅格被所述第一激光雷达发射的激光打到的次数,所述第二计数值为所述连线栅格处于被激光打到的栅格和所述第一激光雷达之间的连线上的次数;
根据所述更新后的第一计数值和所述更新后的第二计数值分别对各个连线栅格在所述第一概率地图中的占用概率值进行更新,得到所述更新后的第一概率地图。
6.一种建图装置,其特征在于,应用于机器人中,所述机器人包括第一激光雷达和第二激光雷达,所述第一激光雷达的安装位置高于所述第二激光雷达的安装位置,所述第一激光雷达安装在较高的地方,不会扫描到普通的桌椅可移动物体,所述第二激光雷达安装在低处,能扫描到这些可移动物体,所述装置包括:
第一数据获取模块,用于获取第一激光关键帧,所述第一激光关键帧为所述第一激光雷达采集的当前激光关键帧;
位姿计算模块,用于根据所述第一激光关键帧计算所述机器人的当前位姿;
第一地图更新模块,用于根据所述当前位姿和所述第一激光关键帧更新第一概率地图,得到更新后的第一概率地图,所述第一概率地图为与所述第一激光雷达对应的概率地图;
第二数据获取模块,用于获取第二激光关键帧,所述第二激光关键帧为所述第二激光雷达采集的当前激光关键帧;
第二地图更新模块,用于根据所述当前位姿和所述第二激光关键帧更新第二概率地图,得到更新后的第二概率地图,所述第二概率地图为与所述第二激光雷达对应的概率地图;
地图融合模块,用于根据所述更新后的第一概率地图和所述更新后的第二概率地图生成用于机器人导航的融合栅格地图;
所述地图融合模块包括:
第一栅格地图生成子模块,用于生成与所述更新后的第一概率地图对应的第一栅格地图;
第二栅格地图生成子模块,用于生成与所述更新后的第二概率地图对应的第二栅格地图;
地图融合子模块,用于根据预设的相对位姿转换关系将所述第一栅格地图和所述第二栅格地图进行融合,得到所述融合栅格地图,所述相对位姿转换关系为所述第一激光雷达与所述第二激光雷达之间的相对位姿转换关系;
所述地图融合子模块包括:
对齐单元,用于根据预设的相对位姿转换关系对齐所述第一栅格地图和所述第二栅格地图;
黑色栅格确定单元,用于对于所述融合栅格地图中的任意一个栅格,若符合第一预设条件,则确定该栅格为黑色栅格;所述第一预设条件为:在所述第一栅格地图中对应的栅格为黑色栅格;
白色栅格确定单元,用于若符合第二预设条件,则确定该栅格为白色栅格;所述第二预设条件为:在所述第一栅格地图中对应的栅格不为黑色栅格,且在所述第二栅格地图中对应的栅格为白色栅格;
灰色栅格确定单元,用于若均不符合所述第一预设条件和所述第二预设条件,则确定该栅格为灰色栅格。
7.一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现如权利要求1至5中任一项所述的建图方法的步骤。
8.一种机器人,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现如权利要求1至5中任一项所述的建图方法的步骤。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011232065.0A CN112462758B (zh) | 2020-11-06 | 2020-11-06 | 一种建图方法、装置、计算机可读存储介质及机器人 |
PCT/CN2020/139872 WO2022095257A1 (zh) | 2020-11-06 | 2020-12-28 | 一种建图方法、装置、计算机可读存储介质及机器人 |
US18/143,596 US20230273620A1 (en) | 2020-11-06 | 2023-05-04 | Mapping method, computer-readable storage medium, and robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011232065.0A CN112462758B (zh) | 2020-11-06 | 2020-11-06 | 一种建图方法、装置、计算机可读存储介质及机器人 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112462758A CN112462758A (zh) | 2021-03-09 |
CN112462758B true CN112462758B (zh) | 2022-05-06 |
Family
ID=74825876
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011232065.0A Active CN112462758B (zh) | 2020-11-06 | 2020-11-06 | 一种建图方法、装置、计算机可读存储介质及机器人 |
Country Status (3)
Country | Link |
---|---|
US (1) | US20230273620A1 (zh) |
CN (1) | CN112462758B (zh) |
WO (1) | WO2022095257A1 (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112986912B (zh) * | 2021-03-19 | 2023-06-16 | 北京小狗吸尘器集团股份有限公司 | 基于结构光传感器的扫地机重定位方法、装置和电子设备 |
CN113311827B (zh) * | 2021-05-08 | 2022-07-12 | 东南大学 | 一种提高存储效率的机器人室内地图及其生成方法 |
CN113390427B (zh) * | 2021-06-09 | 2023-03-24 | 深圳市优必选科技股份有限公司 | 机器人建图方法、装置、机器人及计算机可读存储介质 |
CN115979248B (zh) * | 2023-03-17 | 2023-08-18 | 上海仙工智能科技有限公司 | 基于定位位姿为约束的地图更新方法及系统、存储介质 |
Citations (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105204510A (zh) * | 2015-10-09 | 2015-12-30 | 福州华鹰重工机械有限公司 | 一种用于精确定位的概率地图的生成方法及装置 |
CN107239076A (zh) * | 2017-06-28 | 2017-10-10 | 仲训昱 | 基于虚拟扫描与测距匹配的agv激光slam方法 |
CN107505940A (zh) * | 2017-08-08 | 2017-12-22 | 速感科技(北京)有限公司 | 自动引导车辆上的双激光雷达控制方法、系统及定位方法 |
CN207965645U (zh) * | 2017-12-25 | 2018-10-12 | 北京工业大学 | 一种机器人自主导航系统 |
CN108663681A (zh) * | 2018-05-16 | 2018-10-16 | 华南理工大学 | 基于双目摄像头与二维激光雷达的移动机器人导航方法 |
CN109541630A (zh) * | 2018-11-22 | 2019-03-29 | 武汉科技大学 | 一种适用于建筑物室内平面2d slam测绘的方法 |
CN110174894A (zh) * | 2019-05-27 | 2019-08-27 | 小狗电器互联网科技(北京)股份有限公司 | 机器人及其重定位方法 |
CN110376605A (zh) * | 2018-09-18 | 2019-10-25 | 北京京东尚科信息技术有限公司 | 地图构建方法、导航方法和装置 |
CN110398751A (zh) * | 2019-09-11 | 2019-11-01 | 北京云迹科技有限公司 | 基于激光雷达生成地图的系统及方法 |
CN110658530A (zh) * | 2019-08-01 | 2020-01-07 | 北京联合大学 | 一种基于双激光雷达数据融合的地图构建方法、系统及地图 |
CN110726409A (zh) * | 2019-09-09 | 2020-01-24 | 杭州电子科技大学 | 一种基于激光slam和视觉slam地图融合方法 |
CN111024100A (zh) * | 2019-12-20 | 2020-04-17 | 深圳市优必选科技股份有限公司 | 一种导航地图更新方法、装置、可读存储介质及机器人 |
CN111121754A (zh) * | 2019-12-31 | 2020-05-08 | 深圳市优必选科技股份有限公司 | 移动机器人定位导航方法、装置、移动机器人及存储介质 |
CN111257909A (zh) * | 2020-03-05 | 2020-06-09 | 安徽意欧斯物流机器人有限公司 | 一种多2d激光雷达融合建图与定位方法及系统 |
CN111578932A (zh) * | 2020-05-28 | 2020-08-25 | 长沙中联重科环境产业有限公司 | 一种基于多线激光雷达的建图方法、装置、介质及设备 |
CN111656136A (zh) * | 2018-11-09 | 2020-09-11 | 北京嘀嘀无限科技发展有限公司 | 使用激光雷达的车辆定位系统 |
CN111665826A (zh) * | 2019-03-06 | 2020-09-15 | 北京奇虎科技有限公司 | 基于激光雷达与单目相机的深度图获取方法及扫地机器人 |
KR102169283B1 (ko) * | 2019-12-30 | 2020-10-23 | (주)원익로보틱스 | 자율주행 로봇을 이용한 지도 업데이트 방법 및 시스템 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8825391B1 (en) * | 2011-08-04 | 2014-09-02 | Google Inc. | Building elevation maps from laser data |
CN105573318B (zh) * | 2015-12-15 | 2018-06-12 | 中国北方车辆研究所 | 基于概率分析的环境构建方法 |
CN106371103A (zh) * | 2016-10-21 | 2017-02-01 | 复旦大学 | 基于表决融合的多激光传感器数据融合方法 |
CN108170145A (zh) * | 2017-12-28 | 2018-06-15 | 浙江捷尚人工智能研究发展有限公司 | 基于激光雷达的机器人避障系统及其应用方法 |
CN108608466A (zh) * | 2018-02-26 | 2018-10-02 | 北京克路德人工智能科技有限公司 | 一种双目相机和激光雷达联合的机器人定位方法 |
US11188089B2 (en) * | 2018-06-21 | 2021-11-30 | Ford Global Technologies, Llc | Localization for autonomous vehicles using gaussian mixture models |
CN109814572B (zh) * | 2019-02-20 | 2022-02-01 | 广州市山丘智能科技有限公司 | 移动机器人定位建图方法、装置、移动机器人和存储介质 |
CN111461245B (zh) * | 2020-04-09 | 2022-11-04 | 武汉大学 | 一种融合点云和图像的轮式机器人语义建图方法及系统 |
CN111652179B (zh) * | 2020-06-15 | 2024-01-09 | 东风汽车股份有限公司 | 基于点线特征融合激光的语义高精地图构建与定位方法 |
-
2020
- 2020-11-06 CN CN202011232065.0A patent/CN112462758B/zh active Active
- 2020-12-28 WO PCT/CN2020/139872 patent/WO2022095257A1/zh active Application Filing
-
2023
- 2023-05-04 US US18/143,596 patent/US20230273620A1/en active Pending
Patent Citations (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105204510A (zh) * | 2015-10-09 | 2015-12-30 | 福州华鹰重工机械有限公司 | 一种用于精确定位的概率地图的生成方法及装置 |
CN107239076A (zh) * | 2017-06-28 | 2017-10-10 | 仲训昱 | 基于虚拟扫描与测距匹配的agv激光slam方法 |
CN107505940A (zh) * | 2017-08-08 | 2017-12-22 | 速感科技(北京)有限公司 | 自动引导车辆上的双激光雷达控制方法、系统及定位方法 |
CN207965645U (zh) * | 2017-12-25 | 2018-10-12 | 北京工业大学 | 一种机器人自主导航系统 |
CN108663681A (zh) * | 2018-05-16 | 2018-10-16 | 华南理工大学 | 基于双目摄像头与二维激光雷达的移动机器人导航方法 |
CN110376605A (zh) * | 2018-09-18 | 2019-10-25 | 北京京东尚科信息技术有限公司 | 地图构建方法、导航方法和装置 |
CN111656136A (zh) * | 2018-11-09 | 2020-09-11 | 北京嘀嘀无限科技发展有限公司 | 使用激光雷达的车辆定位系统 |
CN109541630A (zh) * | 2018-11-22 | 2019-03-29 | 武汉科技大学 | 一种适用于建筑物室内平面2d slam测绘的方法 |
CN111665826A (zh) * | 2019-03-06 | 2020-09-15 | 北京奇虎科技有限公司 | 基于激光雷达与单目相机的深度图获取方法及扫地机器人 |
CN110174894A (zh) * | 2019-05-27 | 2019-08-27 | 小狗电器互联网科技(北京)股份有限公司 | 机器人及其重定位方法 |
CN110658530A (zh) * | 2019-08-01 | 2020-01-07 | 北京联合大学 | 一种基于双激光雷达数据融合的地图构建方法、系统及地图 |
CN110726409A (zh) * | 2019-09-09 | 2020-01-24 | 杭州电子科技大学 | 一种基于激光slam和视觉slam地图融合方法 |
CN110398751A (zh) * | 2019-09-11 | 2019-11-01 | 北京云迹科技有限公司 | 基于激光雷达生成地图的系统及方法 |
CN111024100A (zh) * | 2019-12-20 | 2020-04-17 | 深圳市优必选科技股份有限公司 | 一种导航地图更新方法、装置、可读存储介质及机器人 |
KR102169283B1 (ko) * | 2019-12-30 | 2020-10-23 | (주)원익로보틱스 | 자율주행 로봇을 이용한 지도 업데이트 방법 및 시스템 |
CN111121754A (zh) * | 2019-12-31 | 2020-05-08 | 深圳市优必选科技股份有限公司 | 移动机器人定位导航方法、装置、移动机器人及存储介质 |
CN111257909A (zh) * | 2020-03-05 | 2020-06-09 | 安徽意欧斯物流机器人有限公司 | 一种多2d激光雷达融合建图与定位方法及系统 |
CN111578932A (zh) * | 2020-05-28 | 2020-08-25 | 长沙中联重科环境产业有限公司 | 一种基于多线激光雷达的建图方法、装置、介质及设备 |
Non-Patent Citations (2)
Title |
---|
High Resolution Maps From Wide Angle Sonar;Moravec H等;《Proceedings of the 1985 IEEE International Conference on Robotics and Automation》;19851231;第116-121页 * |
基于匹配和优化的激光雷达室内SLAM算法及其应用研究;陈映冰;《中国优秀硕士学位论文全文数据库 信息科技辑》;20190715(第07(2019)期);第I136-387页 * |
Also Published As
Publication number | Publication date |
---|---|
US20230273620A1 (en) | 2023-08-31 |
CN112462758A (zh) | 2021-03-09 |
WO2022095257A1 (zh) | 2022-05-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112462758B (zh) | 一种建图方法、装置、计算机可读存储介质及机器人 | |
CN109737974B (zh) | 一种3d导航语义地图更新方法、装置及设备 | |
US20210190513A1 (en) | Navigation map updating method and apparatus and robot using the same | |
CN111291708B (zh) | 融合深度相机的变电站巡检机器人障碍物检测识别方法 | |
CN109190573B (zh) | 应用于无人驾驶车辆的地面检测方法、电子设备、车辆 | |
CN111912417A (zh) | 地图构建方法、装置、设备及存储介质 | |
CN111795687B (zh) | 一种机器人地图更新方法、装置、可读存储介质及机器人 | |
CN112100298A (zh) | 一种建图方法、装置、计算机可读存储介质及机器人 | |
CN111198378B (zh) | 基于边界的自主探索方法和装置 | |
US20220067012A1 (en) | Methods, systems and apparatus to improve spatial-temporal data management | |
CN113916130A (zh) | 一种基于最小二乘法的建筑物位置测量方法 | |
CN113475976A (zh) | 机器人可通行区域确定方法、装置、存储介质及机器人 | |
CN110315538B (zh) | 一种在电子地图上显示障碍物的方法、装置及机器人 | |
CN113390427B (zh) | 机器人建图方法、装置、机器人及计算机可读存储介质 | |
CN113459088B (zh) | 地图调整方法、电子设备及存储介质 | |
CN111369688B (zh) | 一种结构化场景表达的认知导航方法及系统 | |
CN105301577A (zh) | 一种激光强度校准方法及装置 | |
CN115375870A (zh) | 回环检测优化方法、电子设备及计算机可读存储装置 | |
CN111376249B (zh) | 移动设备定位系统、方法、装置及移动设备 | |
CN115690364A (zh) | Ar模型的获取方法、电子设备和可读存储介质 | |
CN113762310A (zh) | 一种点云数据分类方法、装置、计算机存储介质及系统 | |
CN111665522A (zh) | 过滤激光扫描图中静止物体的方法、介质、终端和装置 | |
CN114170348A (zh) | 二维栅格地图评价方法和系统 | |
CN111947670B (zh) | 机器人建图方法、装置、智能设备和存储介质 | |
Richman et al. | Remote Sensing, LIDAR, automated data capture and the VEPS project |
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 |