CN113589306A - 定位方法、装置、电子设备及存储介质 - Google Patents
定位方法、装置、电子设备及存储介质 Download PDFInfo
- Publication number
- CN113589306A CN113589306A CN202010362075.XA CN202010362075A CN113589306A CN 113589306 A CN113589306 A CN 113589306A CN 202010362075 A CN202010362075 A CN 202010362075A CN 113589306 A CN113589306 A CN 113589306A
- Authority
- CN
- China
- Prior art keywords
- pose
- point cloud
- layer
- cloud information
- target
- 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
Images
Classifications
-
- 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/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
-
- 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/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial 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/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- 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/86—Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
-
- 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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/497—Means for monitoring or calibrating
Abstract
本申请实施例提供了定位方法、装置、电子设备及存储介质,应用于定位技术领域,根据机器人的雷达采集的点云信息,得到目标点云信息,根据目标点云信息,在金字塔图中,逐层进行位姿匹配,并将目标层中位姿匹配评分满足预设条件的单位区域对应的位姿,确定为目标位姿;对目标位姿进行校正,得到雷达当前的位姿信息,并根据雷达当前的位姿信息,确定机器人的定位信息。在本申请实施例中,通过雷达采集的点云信息进行定位,相比于通过可见光图像进行定位,受光照强度的影响小,能够减少光照对定位精度的影响。并且采用金字塔图的方式进行位姿匹配,不用针对每个位姿都进行暴力搜索,能够提高匹配的效率,节约计算时间。
Description
技术领域
本申请涉及定位技术领域,特别是涉及定位方法、装置、电子设备及存储介质。
背景技术
在室内机器人领域,通常使用地图作为先验信息来实现自主定位和导航。而使用地图,首先需要知道机器人自身在地图上的位姿和姿态,这就需要使用重定位技术。重定位技术根据是否有先验信息,又可分为局部重定位和全局重定位。
现有的室内全局重定位技术中,需要采集可见光图像,依靠计算机视觉技术提取可见光图像中的特征点,然后通过视觉词袋模型,搜索地图中的相似环境来实现全局重定位,但是采用上述方法,在光照程度变化大时,特征点提取受影响,定位精度受光照影响大。
发明内容
本申请实施例的目的在于提供一种定位方法、装置、电子设备及存储介质,以实现减少光照对定位精度的影响。具体技术方案如下:
第一方面,本申请实施例提供了一种定位方法,所述方法包括:
根据机器人的雷达采集的点云信息,得到目标点云信息,其中,所述目标点云信息表示所述雷达的当前位姿;
获取预先生成的金字塔图,其中,所述金字塔图包括N个层,每层均包括多个单位区域,第i层中的一个单位区域对应第i+1层中的多个单位区域,且第i层中单位区域的概率为其对应的第i+1层中的单位区域的概率中的最大值,所述金字塔图的第N层中的单位区域对应定位场景的占用概率栅格地图的栅格区域,所述金字塔图的第N层中的单位区域的概率为该单位区域对应的栅格区域可能被物体占据的概率,i=1,…,N-1,N为大于1的正整数;
根据所述目标点云信息,在所述金字塔图中,逐层进行位姿匹配,并将目标层中位姿匹配评分满足预设条件的单位区域对应的位姿,确定为目标位姿;
对所述目标位姿进行校正,得到所述雷达当前的位姿信息,并根据所述雷达当前的位姿信息,确定所述机器人的定位信息。
在一种可能的实施方式中,所述根据机器人的雷达采集的点云信息,得到目标点云信息,包括:
获取所述机器人的雷达采集的多帧点云信息,基于所述机器人的里程计数据,将所述多帧点云信息合成一帧数据,得到目标点云信息。
在一种可能的实施方式中,所述获取所述机器人的雷达采集的多帧点云信息,基于所述机器人的里程计数据,将所述多帧点云信息合成一帧数据,得到目标点云信息,包括:
获取所述机器人的雷达在多个位置采集的多帧点云信息,获取所述机器人在所述多帧点云信息对应的各位置之间行驶对应的里程计信息,得到第一里程计信息;
根据所述第一里程计信息,将所述多帧点云信息转换到所述雷达当前位姿的坐标系下,得到目标点云信息。
在一种可能的实施方式中,根据如下方式生成金字塔图:
获取所述雷达在多个位姿下采集的点云信息,得到多帧样本点云信息;
生成所述多帧样本点云信息对应的占用概率栅格地图,其中,所述占用概率栅格地图包括多个栅格区域,各所述栅格区域对应的概率表示该栅格区域被物体占据的概率;
根据所述占用概率栅格地图中栅格区域的数量、及预设层级间单位区域数量比例,计算金字塔图层数;
根据所述占用概率栅格地图、预设层级间单位区域数量比例及所述金字塔图层数,生成金字塔图。
在一种可能的实施方式中,所述根据所述目标点云信息,在所述金字塔图中,逐层进行位姿匹配,并将目标层中位姿匹配评分满足预设条件的单位区域对应的位姿,确定为目标位姿,包括:
获取预设目标层数m以及指定角度上的旋转点云信息,其中,m为正整数,且m≤N;
根据所述目标点云信息及所述指定角度上的旋转点云信息,在所述金字塔图中,按照从第一层到第m层的顺序,逐层进行位姿匹配,并将第m层中位姿匹配评分最高的单位区域对应的位确定为目标位姿。
在一种可能的实施方式中,所述根据所述目标点云信息及所述指定角度上的旋转点云信息,在所述金字塔图中,按照从第一层到第m层的顺序,逐层进行位姿匹配,并将第m层中位姿匹配评分最高的单位区域对应的位姿确定为目标位姿,包括:
根据所述目标点云信息及所述指定角度上的旋转点云信息,在所述金字塔图中,对第一层中的各单位区域逐个进行位姿匹配,得到位姿匹配评分满足预设条件的单位区域;
按照从第二层到第m层的顺序,逐层在其上层位姿匹配评分满足预设条件的单位区域所对应的当前层单位区域中进行位姿匹配,将第m层中位姿匹配评分最高的单位区域对应的位姿确定为目标位姿。
在一种可能的实施方式中,所述对所述目标位姿进行校正,得到所述雷达的位姿,包括:
根据所述目标位姿及多帧样本点云信息,计算所述目标位姿处的点云信息,作为参考点云信息,其中,所述样本点云信息为所述雷达预先在多个位置处采集的点云信息;
对所述参考点云信息及所述目标点云信息中表示同一位置的点进行迭代,计算出所述参考点云信息与所述目标点云信息之间的位姿变换矩阵;
根据所述位姿变换矩阵对所述目标位姿进行变换,得到校正后的雷达的位姿。
在一种可能的实施方式中,根据所述雷达当前的位姿信息,确定所述机器人的定位信息,包括:
获取所述雷达在多个位置的位姿,及获取所述机器人在各位姿对应的位置之间运动的第二里程计信息;
根据所述第二里程计信息,将所述雷达在多个位置的位姿转换到所述雷达当前位姿的坐标系下,得到各参考位姿;
根据所述各参考位姿及所述校正后的雷达的位姿,确定所述雷达的目标位姿;
根据所述雷达的目标位姿,确定所述机器人的定位信息。
第二方面,本申请实施例提供了一种定位装置,所述装置包括:
点云信息获取模块,用于根据机器人的雷达采集的点云信息,得到目标点云信息,其中,所述目标点云信息表示所述雷达的当前位姿;
金字塔图获取模块,用于获取预先生成的金字塔图,其中,所述金字塔图包括N个层,每层均包括多个单位区域,第i层中的一个单位区域对应第i+1层中的多个单位区域,且第i层中单位区域的概率为其对应的第i+1层中的单位区域的概率中的最大值,所述金字塔图的第N层中的单位区域对应定位场景的占用概率栅格地图的栅格区域,所述金字塔图的第N层中的单位区域的概率为该单位区域对应的栅格区域可能被物体占据的概率,i=1,…,N-1,N为大于1的正整数;
目标位姿匹配模块,用于根据所述目标点云信息,在所述金字塔图中,逐层进行位姿匹配,并将目标层中位姿匹配评分满足预设条件的单位区域对应的位姿,确定为目标位姿;
雷达位姿校正模块,用于对所述目标位姿进行校正,得到所述雷达当前的位姿信息;
定位信息确定模块,用于根据所述雷达当前的位姿信息,确定所述机器人的定位信息。
在一种可能的实施方式中,所述点云信息获取模块,具体用于:获取所述机器人的雷达采集的多帧点云信息,基于所述机器人的里程计数据,将所述多帧点云信息合成一帧数据,得到目标点云信息。
在一种可能的实施方式中,所述点云信息获取模块,具体用于:获取所述机器人的雷达在多个位置采集的多帧点云信息,获取所述机器人在所述多帧点云信息对应的各位置之间行驶对应的里程计信息,得到第一里程计信息;根据所述第一里程计信息,将所述多帧点云信息转换到所述雷达当前位姿的坐标系下,得到目标点云信息。
在一种可能的实施方式中,所述装置还包括:金字塔图生成模块,用于:获取所述雷达在多个位姿下采集的点云信息,得到多帧样本点云信息;生成所述多帧样本点云信息对应的占用概率栅格地图,其中,所述占用概率栅格地图包括多个栅格区域,各所述栅格区域对应的概率表示该栅格区域被物体占据的概率;根据所述占用概率栅格地图中栅格区域的数量、及预设层级间单位区域数量比例,计算金字塔图层数;根据所述占用概率栅格地图、预设层级间单位区域数量比例及所述金字塔图层数,生成金字塔图。
在一种可能的实施方式中,所述目标位姿匹配模块,包括:
目标层数获取子模块,用于获取预设目标层数m以及指定角度上的旋转点云信息,其中,m为正整数,且m≤N;
位姿匹配评分计算子模块,用于根据所述目标点云信息及所述指定角度上的旋转点云信息,在所述金字塔图中,按照从第一层到第m层的顺序,逐层进行位姿匹配,将第m层中位姿匹配评分最高的单位区域对应的位姿确定为目标位姿。
在一种可能的实施方式中,所述位姿匹配评分计算子模块,具体用于:根据所述目标点云信息及所述指定角度上的旋转点云信息,在所述金字塔图中,对第一层中的各单位区域逐个进行位姿匹配,得到位姿匹配评分满足预设条件的单位区域;按照从第二层到第m层的顺序,逐层在其上层位姿匹配评分满足预设条件的单位区域所对应的当前层单位区域中进行位姿匹配,并将第m层中位姿匹配评分最高的单位区域对应的位姿确定为目标位姿。
在一种可能的实施方式中,所述雷达位姿校正模块,具体用于:根据所述目标位姿及多帧样本点云信息,计算所述目标位姿处的点云信息,作为参考点云信息,其中,所述样本点云信息为所述雷达预先在多个位置处采集的点云信息;对所述参考点云信息及所述目标点云信息中表示同一位置的点进行迭代,计算出所述参考点云信息与所述目标点云信息之间的位姿变换矩阵;根据所述位姿变换矩阵对所述目标位姿进行变换,得到校正后的雷达的位姿。
在一种可能的实施方式中,所述定位信息确定模块,具体用于:获取所述雷达在多个位置的位姿,及获取所述机器人在各位姿对应的位置之间运动的第二里程计信息;根据所述第二里程计信息,将所述雷达在多个位置的位姿转换到所述雷达当前位姿的坐标系下,得到各参考位姿;根据所述各参考位姿及所述校正后的雷达的位姿,确定所述雷达的目标位姿;根据所述雷达的目标位姿,确定所述机器人的定位信息。
第三方面,本申请实施例提供了一种电子设备,包括处理器及存储器;
所述存储器,用于存放计算机程序;
所述处理器,用于执行所述存储器上所存放的程序时,实现上述第一方面任一所述的定位方法。
第四方面,本申请实施例提供了一种计算机可读存储介质,所述计算机可读存储介质内存储有计算机程序,所述计算机程序被处理器执行时实现上述第一方面任一所述的定位方法。
本申请实施例提供的定位方法、装置、电子设备及存储介质,根据机器人的雷达采集的点云信息,得到目标点云信息,其中,目标点云信息表示雷达的当前位姿;获取预先生成的金字塔图,其中,金字塔图包括N个层,每层均包括多个单位区域,第i层中的一个单位区域对应第i+1层中的多个单位区域,且第i层中单位区域的概率为其对应的第i+1层中的单位区域的概率中的最大值,金字塔图的第N层中的单位区域对应定位场景的占用概率栅格地图的栅格区域,金字塔图的第N层中的单位区域的概率为该单位区域对应的栅格区域可能被物体占据的概率,i=1,…,N-1,N为大于1的正整数;根据目标点云信息,在金字塔图中,逐层进行位姿匹配,并将目标层中位姿匹配评分满足预设条件的单位区域对应的位姿,确定为目标位姿;对目标位姿进行校正,得到雷达当前的位姿信息,并根据雷达当前的位姿信息,确定机器人的定位信息。在本申请实施例中,通过雷达采集的点云信息进行定位,相比于通过可见光图像进行定位,受光照强度的影响小,能够减少光照对定位精度的影响。并且采用金字塔图的方式进行位姿匹配,不用针对每个位姿都进行暴力搜索,能够提高匹配的效率,节约计算时间。当然,实施本申请的任一产品或方法并不一定需要同时达到以上所述的所有优点。
附图说明
为了更清楚地说明本申请实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本申请实施例的定位方法的第一种示意图;
图2为本申请实施例的金字塔图的一种示意图;
图3为本申请实施例的定位方法的第二种示意图;
图4为本申请实施例的金字塔图生成方法的一种示意图;
图5为本申请实施例的位姿匹配的第一种示意图;
图6为本申请实施例的位姿匹配的第二种示意图;
图7为本申请实施例的位姿校正的一种示意图;
图8为本申请实施例的定位信息校正的一种示意图;
图9为本申请实施例的定位方法的第三种示意图;
图10为本申请实施例的定位装置的一种示意图;
图11为本申请实施例的电子设备的一种示意图。
具体实施方式
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
为了减少光照对定位精度的影响,本申请实施例提供了一种定位方法,该方法包括:
根据机器人的雷达采集的点云信息,得到目标点云信息,其中,目标点云信息表示雷达的当前位姿;
获取预先生成的金字塔图,其中,金字塔图包括N个层,每层均包括多个单位区域,第i层中的一个单位区域对应第i+1层中的多个单位区域,且第i层中单位区域的概率为其对应的第i+1层中的单位区域的概率中的最大值,金字塔图的第N层中的单位区域对应定位场景的占用概率栅格地图的栅格区域,金字塔图的第N层中的单位区域的概率为该单位区域对应的栅格区域可能被物体占据的概率,i=1,…,N-1,N为大于1的正整数;
根据目标点云信息,在金字塔图中,逐层进行位姿匹配,并将目标层中位姿匹配评分满足预设条件的单位区域对应的位姿,确定为目标位姿;
对目标位姿进行校正,得到雷达当前的位姿信息,并根据雷达当前的位姿信息,确定机器人的定位信息。
在本申请实施例中,通过雷达采集的点云信息进行定位,相比于通过可见光图像进行定位,受光照强度的影响小,能够减少光照对定位精度的影响。并且采用金字塔图的方式进行位姿匹配,不用针对每个位姿都进行暴力搜索,能够提高匹配的效率,节约计算时间。并对目标位姿的进行进一步的校正,从而进一步提高定位的精度。
下面进行具体说明:
本申请实施例提供了一种定位方法,参见图1,该方法包括:
S11,根据机器人的雷达采集的点云信息,得到目标点云信息,其中,目标点云信息表示雷达的当前位姿。
本申请实施例的定位方法可以应用于全局重定位场景,尤其是适用于室内全局重定位场景。
本申请实施例的定位方法可以通过电子设备实现,具体的,该电子设备可以为搭载有雷达及里程计的具备移动功能的机器人。此处的雷达可以为二维激光雷达等,里程计是一种测量行程的装置,能够测量机器人的行驶方向及行驶路程。本申请实施例的中的机器人可以为服务机器人,服务机器人能够实现接待、引领、导览等功能;也可以为扫地机器人或宠物机器人等。
在一种可能的实施方式中,可以直接将雷达采集的当前帧点云信息,作为目标点云信息。但是为了增加准确度,在一种可能的实施方式中,上述根据机器人的雷达采集的点云信息,得到目标点云信息,包括:获取机器人的雷达采集的多帧点云信息,基于机器人的里程计数据,将多帧点云信息合成一帧数据,得到目标点云信息。
其中,此处的里程计可以为轮式里程计或IMU(Inertial measurement unit,惯性测量单元)等,也可以采用激光匹配等方式获得里程计信息。将多帧激光点云信息合成一帧数据,得到目标激光点云信息,增加了目标激光点云信息中的信息量,从而降低匹配错误的情形,增加了定位准确度。
S12,获取预先生成的金字塔图,其中,金字塔图包括N个层,每层均包括多个单位区域,第i层中的一个单位区域对应第i+1层中的多个单位区域,且第i层中单位区域的概率为其对应的第i+1层中的单位区域的概率中的最大值,金字塔图的第N层中的单位区域对应定位场景的占用概率栅格地图的栅格区域,金字塔图的第N层中的单位区域的概率为该单位区域对应的栅格区域可能被物体占据的概率,i=1,…,N-1,N为大于1的正整数。
预先生成的金字塔图包括多个层,从上到下依次为第1层至第N层。金字塔图的最上层可以包括一个或多个单位区域(也称为像素),金字塔图中除最上层外的其他层中均包括多个单位区域(也称为像素)。任意相邻的两个层中,上层中的一个单位区域对应下层中的多个单位区域,一般情况下,上层中的一个单位区域对应的下层中的多个单位区域成正方形排布,具体的排布与占用概率栅格地图的实际形状有关。例如图2所示,相邻的两个层中,上层中的1个单位区域对应下层中的4个单位区域。又如,相邻的两个层中,上层中的1个单位区域对应下层中的9个单位区域,等等。本发明实施例中不对上层中的一个单位区域对应的下层中的单位区域的具体数量进行限定。其中,相邻的两个层中,上层中的1个单位区域对应下层中的4个单位区域,采用这种方式的定位精度更高。但是因为单位区域数量的限制,例如虚线框中所示,也会存在一个上层中的1个单位区域对应下层中的1个单位的情况。
一般情况下,金字塔图的第N层中的单位区域与占用概率栅格地图中的栅格区域是一一对应的。栅格区域是占用概率栅格地图中的基本区域单位,占用概率栅格地图包括多个栅格区域。占用概率栅格地图对应机器人当前所在场景的地图,将当前定位场景的地图划分为多个栅格区域,得到占用概率栅格地图。每个栅格区域的大小可以自定义设定,栅格区域的大小与实际要求的定位精度相关,要求的定位精度越高栅格区域设定的越小。每个栅格区域均对应相应的概率,针对任一栅格区域,该栅格区域对应的概率表示该栅格区域被物体占据的概率,即该栅格中存在物体的概率。机器人当前所在场景即机器人实际运动区域的场景,例如,机器人为服务机器人时,机器人当前所在场景可以为公司、厂房、酒店或商场等;机器人为扫地机器人时,机器人当前所在场景可以为客厅或卧室等。可以预先利用雷达在机器人当前所在场景中的多个位姿下采集的各样本点云信息,构建机器人当前所在场景的占用概率栅格地图。
金字塔图的第N层(即金字塔图的最底层)中的单位区域的概率为该单位区域对应的栅格区域可能被物体占据的概率。除第N层外,在金字塔图的其他层中,上层中单位区域的概率为其对应的各下层单位区域的概率中的最大值,即第i层中单位区域的概率为其对应的第i+1层中的单位区域的概率中的最大值,其中i∈[1,……,N-1]。例如,上层单位区域A对应下层单位区域1、下层单位区域2、下层单位区域3及下层单位区域4。下层单位区域1的概率为a、下层单位区域2的概率为b、下层单位区域3的概率为c及下层单位区域4的概率为d,且a>b>c>d,则单位区域A的概率为a、b、c、d中最大的,即单位区域A的概率为a。
S13,根据目标点云信息,在金字塔图中,逐层进行位姿匹配,并将目标层中位姿匹配评分满足预设条件的单位区域对应的位姿,确定为目标位姿。
目标层为需要计算到的层数,可以为一个预设值。具体的,目标层与要求的定位精度相关,定位精度越高,目标层的层数越大。目标层也可以按照栅格区域的大小确定,栅格区域越大,目标层的层数越大。可以利用预设分支定界算法,在金字塔图中按照从上到下的顺序,匹配目标点云信息与相应单位区域对应的点云信息,从而得到各单位区域的位姿匹配评分。在匹配的目标层的单位区域中,选取位姿匹配评分满足预设条件的单位区域,例如位姿匹配评分最高的单位区域,将该单位区域对应的位姿确定为目标位姿。又如,将位姿匹配评分高于设定阈值的单位区域对应的位姿,确定为目标位姿。再如,将位姿匹配评分高于设定阈值且评分最高的单位区域对应的位姿,确定为目标位姿。
S14,对目标位姿进行校正,得到雷达当前的位姿信息,并根据雷达当前的位姿信息,确定机器人的定位信息。
通过预设校正方法,对目标位姿进行校正,得到雷达当前的位姿信息,从而根据雷达当前的位姿信息,可以得到搭载该雷达的机器人的定位信息。预设校正方法可以根据实际情况进行选取,例如,在雷达位姿不变的情况下获取多帧点云信息,并计算各帧点云信息对应的位姿,对各位姿取平均值或计算各位姿的加权平均等,从而得到校正后的激光雷达的位姿。其中,在计算各位姿的加权平均的过程中,各位姿的权重系数可以按照实际情况自定义设置,例如,位姿的权重系数与该位置对应的位姿匹配评分正相关,该位置对应的位姿匹配评分越高,则该位姿的权重系数越大;例如,可以将各位姿的协方差作为各自的权重系数等。
在本申请实施例中,通过雷达采集的点云信息进行定位,相比于通过可见光图像进行定位,受光照强度的影响小,能够减少光照对定位精度的影响。并且采用金字塔图的方式进行位姿匹配,不用针对每个位姿都进行暴力搜索,能够提高匹配的效率,节约计算时间。并对目标位姿进行校正,从而进一步提高定位的精度。
在一种可能的实施方式中,参见图3,上述S11,根据机器人的雷达采集的点云信息,得到目标点云信息,包括:
S111,获取机器人的雷达在多个位置采集的多帧点云信息,获取机器人在多帧点云信息对应的各位置之间行驶对应的里程计信息,得到第一里程计信息。
S112,根据第一里程计信息,将多帧点云信息转换到雷达当前位姿的坐标系下,得到目标点云信息。
例如,机器人在位置A、位置B及位置C各自采集了一帧点云信息,其中位置C为机器人的当前位置。机器人搭载的里程计记录了机器人由位置A运动到位置B的运动方向及行驶路程,并记录了由位置B运动到位置C的运动方向及行驶路程。则根据由位置A运动到位置B的运动方向及行驶路程,可以得到由位置A到位置B的向量a,向量a为将点云信息由位置A坐标系转换到位置B坐标系的转换向量;根据由位置B运动到位置C的运动方向及行驶路程,可以得到由位置B到位置C的向量b,向量b为将点云信息由位置B坐标系转换到位置C坐标系的转换向量。利用向量b将在位置B采集的点云信息转换到位置C的坐标系下,利用向量a及向量b将在位置A采集的点云信息转换到位置C的坐标系下,此时三帧点云信息均转换到位置C的坐标系下,将位置C的坐标系下的三帧点云信息进行合成,例如,将对应点取平均值等,得到目标点云信息。
在本申请实施例中,利用多帧点云信息合成目标点云信息,能够降低单帧点云信息的偶然性,增加目标点云信息的代表性,从而增加定位精度。
在一种可能的实施方式中,参见图4,生成的金字塔图的步骤包括:
S21,获取雷达在多个位姿采集的激光点云信息,得到多帧样本点云信息。
S22,生成上述多帧样本点云信息对应的占用概率栅格地图,其中,上述占用概率栅格地图包括多个栅格区域,各栅格区域对应的概率表示该栅格区域被物体占据的概率。
针对不同的场景,金字塔图的生成规则均相同,但是针对不同的定位场景,其占用概率栅格地图一般是不同的。利用雷达在当前定位场景的多个位姿采集的各样本点云信息,构建当前定位场景的占用概率栅格地图。占用概率栅格地图包括多个栅格区域,每个栅格区域的大小可以自定义设定。每个栅格区域均对应相应的概率,针对任一栅格区域,该栅格区域对应的概率表示该栅格区域被占据的概率,即该栅格中有物体占据的概率。栅格区域对应的概率可以根据该栅格区域被占据的帧数计算,其具体计算方法可以参见相关技术中栅格区域占用概率的计算方法,此处不再赘述。
S23,根据上述占用概率栅格地图中栅格区域的数量及预设层级间单位区域数量比例,计算金字塔图层数。
预设层级间单位区域数量比例表示金字塔图中相邻层间单位区域数量的比例,例如,预设层级间单位区域数量比例为M,则金字塔图中相邻层之间上层中的一个单位区域对应下层中的M个单位区域。一般情况下预设层级间单位区域数量比例可以设置为4。金字塔图层数与占用概率栅格地图中栅格区域的总数量有关。占用概率栅格地图中栅格区域的总数量为S,金字塔层数K满足4K-1<S。具体的,在预设层级间单位区域数量比例为4时,根据占用概率栅格地图中栅格区域的总数量S,利用公式K<1+log4S,得到最大的整数K,即为金字塔图层数。
S24,根据上述占用概率栅格地图、预设层级间单位区域数量比例及上述金字塔图层数,生成金字塔图。
例如,占用概率栅格地图中栅格区域的总数量为S,预设层级间单位区域数量比例为4,金字塔图层数为K,从最下层开始,将一个栅格区域作为一个单位区域,生成包括S个单位区域的最下层。然后生成最下层相邻的上层,得到个单位区域,其中,最下层的4个单位区域对应本层的一个单位区域,表示向上取整。依次类推,直至生成金字塔图的最上层。例如,图2所示,预设层级间单位区域数量比例为4,第三层(最下层)包括20个单位区域,第二层包括5个单位区域,第一层(最上层)包括2个单位区域。
在本申请实施例中,给出了金字塔图的生成方法,可以生成机器人所在的实际场景对应的金字塔图,为后续计算定位信息提供前提。
在一种可能的实施方式中,参见图5,根据上述目标点云信息,在上述金字塔图中,逐层进行位姿匹配,并将目标层中位姿匹配评分满足预设条件的单位区域对应的位姿,确定为目标位姿,包括:
S131,获取预设目标层数m以及指定角度上的旋转点云信息,其中,m为正整数,且m≤N。
预设目标层数为需要计算到的层数,用m表示。预设目标层数可以根据要求的定位精度确定,精度越高,预设目标层数越大。例如可以默认预设目标层数为最底层,即m=N。
雷达预先在多个位置处采集多帧点云信息作为样本点云信息。根据样本点云信息预先生成整个定位场景的点云图,根据定位场景的点云图,获取指定角度上的旋转点云信息。指定角度为雷达的当前角度,或根据先验信息和角度误差范围计算的角度。其中,若能够获取到雷达的当前角度,即指定角度为雷达的当前角度,则根据直接当前角度上的旋转点云信息。若无法获取到雷达的当前角度,则需要根据先验信息和角度误差范围,决定角度的旋转角度范围,即指定角度为该旋转角度范围,然后获取该旋转范围内各角度上的旋转点云信息。
S132,根据上述目标点云信息及上述指定角度上的旋转点云信息,在上述金字塔图中,按照从第一层到第m层的顺序,逐层进行位姿匹配,并将第m层中位姿匹配评分最高的单位区域对应的位姿确定为目标位姿。
使用预设分支定界算法,在从金字塔图中按照层数从第一层到第m层的顺序,进行位姿匹配,例如CSM(Correlative Scan Matching,相关性扫描匹配),忽略评分低的分支,在评分最高的分支中继续匹配,将第m层中匹配评分最高的位姿,作为目标位姿。
在本申请实施例中,通过预设目标层数,可以设置计算的哪一层,能够节约计算资源。并且利用分支定界法进行位姿匹配,不用针对每个位姿都进行暴力搜索,能够提高匹配的效率,节约计算时间。
在一种可能的实施方式中,参见图6,上述S132,根据上述目标点云信息及上述指定角度上的旋转点云信息,在上述金字塔图中,按照从第一层到第m层的顺序,逐层进行位姿匹配,并将第m层中位姿匹配评分最高的单位区域对应的位姿确定为目标位姿,包括:
S1321,根据上述目标点云信息及上述指定角度上的旋转点云信息,在上述金字塔图中,对第一层中的各单位区域逐个进行位姿匹配,得到位姿匹配评分满足预设条件的单位区域。
位姿匹配评分满足预设条件的单位区域一般为位姿匹配评分最高的单位区域,还可以为位姿匹配评分大于预设评分阈值的单位区域,或大于预设评分阈值的单位区域中位姿匹配评分最高的单位区域等。金字塔图的第一层中各单位区域均需要进行位姿匹配,从而得到第一层中满足预设条件的单位区域。
S1322,按照从第二层到第m层的顺序,逐层在其上层位姿匹配评分满足预设条件的单位区域所对应的当前层单位区域中进行位姿匹配,并将第m层中位姿匹配评分最高的单位区域对应的位姿确定为目标位姿。
针对第二层到第m层中的任一层,确定其上层满足预设条件的单位区域在本层中所对应的单位区域,仅在这些单位区域中进行位置匹配。在第m层中选取位姿匹配评分最高的单位区域对应的位姿,作为目标位姿。
在本申请实施例中,不用针对每个位姿都进行暴力搜索,能够提高匹配的效率,节约计算时间。
在一种可能的实施方式中,参见图7,上述对目标位姿进行校正,得到雷达当前的位姿信息,包括:
S141,根据目标位姿及多帧样本点云信息,计算目标位姿处的点云信息,作为参考点云信息,其中,样本点云信息为雷达预先在多个位置处采集的点云信息。
S142,对参考点云信息及目标点云信息中表示同一位置的点进行迭代,计算出参考点云信息与目标点云信息之间的位姿变换矩阵。
例如,目标点云信息可以表示为X={x1,…,xn},参考点云信息可以表示为P={p1,…,pn},位姿变换矩阵可以表示为R及t两部分,其中,R表示位姿变换矩阵的旋转矩阵,t表示姿变换矩阵的平移向量。
位姿变换矩阵需要使得损失E(R,t)最小,其中:
xi为X中的第i个点,pi为P中的第i个点。
当知道参考点云信息与目标点云信息中各点的真实对应关系的情况下,可以用最小二乘法获得R和t的解,从而得到位姿变换矩阵。
但是一般情况下,并不知道参考点云信息与目标点云信息中各点的真实对应关系,此时将参考点云信息及目标点云信息中最接近的点视为同一位置的点,选取多组表示同一位置的点进行迭代,直至E(R,t)收敛或达到预设迭代次数,得到此时的R和t的解,从而得到位姿变换矩阵。
当然此处也可以采用相关技术中的其他位姿变换矩阵的计算方法,来获得位姿变换矩阵,本申请实施例中不做具体限定。
S143,根据位姿变换矩阵对目标位姿进行变换,得到校正后的雷达的位姿。
根据目标位姿及多帧样本点云信息,计算目标位姿处的激光点云信息,作为参考点云信息。根据参考点云信息及目标点云信息,通过ICP(Iterative Closest Point,迭代最近点算法),计算出参考点云信息相对于目标点云信息的位姿变换矩阵,根据位姿变换矩阵及目标位姿,计算得到校正后的雷达的位姿,其中,校正后的雷达的位姿即为雷达当前的位姿信息。
在本申请实施例中对雷达的位姿进行校正,能够获得更加准确的雷达位姿,从而提高定位准确度。
在一种可能的实施方式中,参见图8,上述根据雷达当前的位姿信息,确定机器人的定位信息,包括:
S144,获取雷达在多个位置的位姿,及获取机器人在各位姿对应的位置之间运动的第二里程计信息。
获取雷达在多个位置的位姿,以及机器人在各位姿对应的位置之间运动的第二里程计信息,其中,第二里程计信息包括机器人在各位姿对应的位置之间运动过程的行驶方向及行驶距离。
S145,根据第二里程计信息,将雷达在多个位置的位姿转换到雷达当前位姿的坐标系下,得到各参考位姿。
例如,机器人在位置A、位置B及位置C处时,雷达分别对应位姿1、位姿2及位姿3,其中,位置C为当前位置。机器人搭载的里程计记录了机器人由位置A运动到位置B的运动方向及行驶距离,并记录了由位置B运动到位置C的运动方向及行驶距离。则根据由位置A运动到位置B的运动方向及行驶距离,可以得到由位置A到位置B的向量a;根据由位置B运动到位置C的运动方向及行驶距离,可以得到由位置B到位置C的向量b。利用向量b将在位姿2转换到位置C的坐标系下,得到参考位姿2;利用向量a及向量b将在位姿1采集的点云信息转换到位置C的坐标系下,得到参考位姿1。
S146,根据各参考位姿及校正后的雷达的位姿,确定雷达的目标位姿。
可以将各参考位姿与校正后的雷达的位姿进行比较,验证其是否准确。例如,可以采用加权平均的方式求取各参考位姿与校正后的雷达的位姿的均值,得到雷达的目标位姿。
S147,根据雷达的目标位姿,确定机器人的定位信息。
机器人搭载有雷达,根据雷达在机器人中安装的位置,可以基于雷达的位姿得到机器人的定位信息。例如,机器人在占用概率栅格地图中的哪个或哪几个栅格区域中。
在本申请实施例中,利用多帧激光点云信息校正激光雷达的位姿,可以提高激光雷达的定位准确率。
在一种可能的实施方式中,参见图9,本申请实施例的定位方法包括:生成金字塔地图,相关性扫描匹配及迭代最近点算法匹配。其中,在生成金字塔地图时,要获取多帧样本激光点云信息,并生成室内的占用概率栅格地图,然后计算金字塔图层数,从而生成金字塔图,并存储金字塔图及占用概率栅格地图。相关性扫描匹配根据激光点云信息计算目标深度层数等搜索参数,生成在旋转点云信息,使用分支定界法在金字塔图中从上到下进行相关性扫描匹配,得到匹配评分最高的位姿,即目标位姿。迭代最近点算法匹配包括ICP算法匹配及多帧激光点云信息校验,最终得到激光雷达的位姿。
本申请实施例还提供了定位装置,参见图10,该装置包括:
点云信息获取模块201,用于根据机器人的雷达采集的点云信息,得到目标点云信息,其中,上述目标点云信息表示上述雷达的当前位姿;
金字塔图获取模块202,用于获取预先生成的金字塔图,其中,上述金字塔图包括N个层,每层均包括多个单位区域,第i层中的一个单位区域对应第i+1层中的多个单位区域,且第i层中单位区域的概率为其对应的第i+1层中的单位区域的概率中的最大值,上述金字塔图的第N层中的单位区域对应定位场景的占用概率栅格地图的栅格区域,上述金字塔图的第N层中的单位区域的概率为该单位区域对应的栅格区域可能被物体占据的概率,i=1,…,N-1,N为大于1的正整数;
目标位姿匹配模块203,用于根据上述目标点云信息,在上述金字塔图中,逐层进行位姿匹配,并将目标层中位姿匹配评分满足预设条件的单位区域对应的位姿,确定为目标位姿;
雷达位姿校正模块204,用于对上述目标位姿进行校正,得到上述雷达当前的位姿信息;
定位信息确定模块205,用于根据上述雷达当前的位姿信息,确定上述机器人的定位信息。
在一种可能的实施方式中,上述点云信息获取模块201,具体用于:获取上述机器人的雷达采集的多帧点云信息,基于上述机器人的里程计数据,将上述多帧点云信息合成一帧数据,得到目标点云信息。
在一种可能的实施方式中,上述点云信息获取模块201,具体用于:获取上述机器人的雷达在多个位置采集的多帧点云信息,获取上述机器人在上述多帧点云信息对应的各位置之间行驶对应的里程计信息,得到第一里程计信息;根据上述第一里程计信息,将上述多帧点云信息转换到上述雷达当前位姿的坐标系下,得到目标点云信息。
在一种可能的实施方式中,上述装置还包括:金字塔图生成模块,用于:获取上述雷达在多个位姿下采集的点云信息,得到多帧样本点云信息;生成所述多帧样本点云信息对应的占用概率栅格地图,其中,上述占用概率栅格地图包括多个栅格区域,各上述栅格区域对应的概率表示该栅格区域被物体占据的概率;根据上述占用概率栅格地图中栅格区域的数量、及预设层级间单位区域数量比例,计算金字塔图层数;根据上述占用概率栅格地图、预设层级间单位区域数量比例及上述金字塔图层数,生成金字塔图。
在一种可能的实施方式中,上述目标位姿匹配模块203,包括:
目标层数获取子模块,用于获取预设目标层数m以及指定角度上的旋转点云信息,其中,m为正整数,且m≤N;
位姿匹配评分计算子模块,用于根据上述目标点云信息及上述指定角度上的旋转点云信息,在上述金字塔图中,按照从第一层到第m层的顺序,逐层进行位姿匹配,并将第m层中位姿匹配评分最高的单位区域对应的位姿确定为目标位姿。
在一种可能的实施方式中,上述位姿匹配评分计算子模块,用于,具体用于:根据上述目标点云信息及上述指定角度上的旋转点云信息,在上述金字塔图中,对第一层中的各单位区域逐个进行位姿匹配,得到位姿匹配评分满足预设条件的单位区域;按照从第二层到第m层的顺序,逐层在其上层位姿匹配评分满足预设条件的单位区域所对应的当前层单位区域中进行位姿匹配,并将第m层中位姿匹配评分最高的单位区域对应的位姿,作为目标位姿。
在一种可能的实施方式中,上述雷达位姿校正模块204,具体用于:根据上述目标位姿及多帧样本点云信息,计算上述目标位姿处的点云信息,作为参考点云信息,其中,上述样本点云信息为上述雷达预先在多个位置处采集的点云信息;对上述参考点云信息及上述目标点云信息中表示同一位置的点进行迭代,计算出上述参考点云信息与上述目标点云信息之间的位姿变换矩阵;根据上述位姿变换矩阵对上述目标位姿进行变换,得到校正后的雷达的位姿。
在一种可能的实施方式中,上述定位信息确定模块205,具体用于:获取上述雷达在多个位置的位姿,及获取上述机器人在各位姿对应的位置之间运动的第二里程计信息;根据上述第二里程计信息,将上述雷达在多个位置的位姿转换到上述雷达当前位姿的坐标系下,得到各参考位姿;根据上述各参考位姿及上述校正后的雷达的位姿,确定上述雷达的目标位姿;根据上述雷达的目标位姿,确定上述机器人的定位信息。
本申请实施例还提供了一种电子设备,包括:处理器及存储器;
上述存储器,用于存放计算机程序;
上述处理器用于执行上述存储器存放的计算机程序时,实现如下步骤:
根据机器人的雷达采集的点云信息,得到目标点云信息,其中,目标点云信息表示雷达的当前位姿;
获取预先生成的金字塔图,其中,金字塔图包括N个层,每层均包括多个单位区域,第i层中的一个单位区域对应第i+1层中的多个单位区域,且第i层中单位区域的概率为其对应的第i+1层中的单位区域的概率中的最大值,金字塔图的第N层中的单位区域对应定位场景的占用概率栅格地图的栅格区域,金字塔图的第N层中的单位区域的概率为该单位区域对应的栅格区域可能被物体占据的概率,i=1,…,N-1,N为大于1的正整数;
根据目标点云信息,在金字塔图中,逐层进行位姿匹配,并将目标层中位姿匹配评分满足预设条件的单位区域对应的位姿,确定为目标位姿;
对目标位姿进行校正,得到雷达当前的位姿信息,并根据雷达当前的位姿信息,确定机器人的定位信息。
可选的,参见图11,本申请实施例的电子设备还包括通信接口902和通信总线904,其中,处理器901,通信接口902,存储器903通过通信总线904完成相互间的通信。
可选的,上述处理器用于执行上述存储器存放的计算机程序时,还能够实现上述任一定位方法。具体的,该电子设备可以为搭载有雷达及里程计的机器人。
上述电子设备提到的通信总线可以是PCI(Peripheral ComponentInterconnect,外设部件互连标准)总线或EISA(Extended Industry StandardArchitecture,扩展工业标准结构)总线等。该通信总线可以分为地址总线、数据总线、控制总线等。为便于表示,图中仅用一条粗线表示,但并不表示仅有一根总线或一种类型的总线。
通信接口用于上述电子设备与其他设备之间的通信。
存储器可以包括RAM(Random Access Memory,随机存取存储器),也可以包括NVM(Non-Volatile Memory,非易失性存储器),例如至少一个磁盘存储器。可选的,存储器还可以是至少一个位于远离前述处理器的存储装置。
上述的处理器可以是通用处理器,包括CPU(Central Processing Unit,中央处理器)、NP(Network Processor,网络处理器)等;还可以是DSP(Digital Signal Processing,数字信号处理器)、ASIC(Application Specific Integrated Circuit,专用集成电路)、FPGA(Field-Programmable Gate Array,现场可编程门阵列)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件。
本申请实施例还提供了一种计算机可读存储介质,上述计算机可读存储介质内存储有计算机程序,上述计算机程序被处理器执行时实现如下步骤:
根据机器人的雷达采集的点云信息,得到目标点云信息,其中,目标点云信息表示雷达的当前位姿;
获取预先生成的金字塔图,其中,金字塔图包括N个层,每层均包括多个单位区域,第i层中的一个单位区域对应第i+1层中的多个单位区域,且第i层中单位区域的概率为其对应的第i+1层中的单位区域的概率中的最大值,金字塔图的第N层中的单位区域对应定位场景的占用概率栅格地图的栅格区域,金字塔图的第N层中的单位区域的概率为该单位区域对应的栅格区域可能被物体占据的概率,i=1,…,N-1,N为大于1的正整数;
根据目标点云信息,在金字塔图中,逐层进行位姿匹配,并将目标层中位姿匹配评分满足预设条件的单位区域对应的位姿,确定为目标位姿;
对目标位姿进行校正,得到雷达当前的位姿信息,并根据雷达当前的位姿信息,确定机器人的定位信息。
可选的,上述计算机程序被处理器执行时,还能够实现上述任一定位方法。
需要说明的是,在本文中,各个可选方案中的技术特征只要不矛盾均可组合来形成方案,这些方案均在本申请公开的范围内。诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
本说明书中的各个实施例均采用相关的方式描述,各个实施例之间相同相似的部分互相参见即可,每个实施例重点说明的都是与其他实施例的不同之处。尤其,对于装置、电子设备及存储介质的实施例而言,由于其基本相似于方法实施例,所以描述的比较简单,相关之处参见方法实施例的部分说明即可。
以上所述仅为本申请的较佳实施例而已,并非用于限定本申请的保护范围。凡在本申请的精神和原则之内所作的任何修改、等同替换、改进等,均包含在本申请的保护范围内。
Claims (10)
1.一种定位方法,其特征在于,所述方法包括:
根据机器人的雷达采集的点云信息,得到目标点云信息,其中,所述目标点云信息表示所述雷达的当前位姿;
获取预先生成的金字塔图,其中,所述金字塔图包括N个层,每层均包括多个单位区域,第i层中的一个单位区域对应第i+1层中的多个单位区域,且第i层中单位区域的概率为其对应的第i+1层中的单位区域的概率中的最大值,所述金字塔图的第N层中的单位区域对应定位场景的占用概率栅格地图的栅格区域,所述金字塔图的第N层中的单位区域的概率为该单位区域对应的栅格区域可能被物体占据的概率,i=1,…,N-1,N为大于1的正整数;
根据所述目标点云信息,在所述金字塔图中,逐层进行位姿匹配,并将目标层中位姿匹配评分满足预设条件的单位区域对应的位姿,确定为目标位姿;
对所述目标位姿进行校正,得到所述雷达当前的位姿信息,并根据所述雷达当前的位姿信息,确定所述机器人的定位信息。
2.根据权利要求1所述的方法,其特征在于,所述根据机器人的雷达采集的点云信息,得到目标点云信息,包括:
获取所述机器人的雷达采集的多帧点云信息,基于所述机器人的里程计数据,将所述多帧点云信息合成一帧数据,得到目标点云信息。
3.根据权利要求1所述的方法,其特征在于,根据如下方式生成金字塔图:
获取所述雷达在多个位姿下采集的点云信息,得到多帧样本点云信息;
生成所述多帧样本点云信息对应的占用概率栅格地图,其中,所述占用概率栅格地图包括多个栅格区域,各所述栅格区域对应的概率表示该栅格区域被物体占据的概率;
根据所述占用概率栅格地图中栅格区域的数量、及预设层级间单位区域数量比例,计算金字塔图层数;
根据所述占用概率栅格地图、预设层级间单位区域数量比例及所述金字塔图层数,生成金字塔图。
4.根据权利要求1所述的方法,其特征在于,所述根据所述目标点云信息,在所述金字塔图中,逐层进行位姿匹配,并将目标层中位姿匹配评分满足预设条件的单位区域对应的位姿,确定为目标位姿,包括:
获取预设目标层数m以及指定角度上的旋转点云信息,其中,m为正整数,且m≤N;
根据所述目标点云信息及所述指定角度上的旋转点云信息,在所述金字塔图中,按照从第一层到第m层的顺序,逐层进行位姿匹配,将第m层中位姿匹配评分最高的单位区域对应的位姿确定为目标位姿。
5.根据权利要求4所述的方法,其特征在于,所述根据所述目标点云信息及所述指定角度上的旋转点云信息,在所述金字塔图中,按照从第一层到第m层的顺序,逐层进行位姿匹配,并将第m层中位姿匹配评分最高的单位区域对应的位姿确定为目标位姿,包括:
根据所述目标点云信息及所述指定角度上的旋转点云信息,在所述金字塔图中,对第一层中的各单位区域逐个进行位姿匹配,得到位姿匹配评分满足预设条件的单位区域;
按照从第二层到第m层的顺序,逐层在其上层位姿匹配评分满足预设条件的单位区域所对应的当前层单位区域中进行位姿匹配,并将第m层中位姿匹配评分最高的单位区域对应的位姿确定为目标位姿。
6.根据权利要求1-5任一项所述的方法,其特征在于,所述对所述目标位姿进行校正,得到所述雷达的位姿,包括:
根据所述目标位姿及多帧样本点云信息,计算所述目标位姿处的点云信息,作为参考点云信息,其中,所述样本点云信息为所述雷达预先在多个位置处采集的点云信息;
对所述参考点云信息及所述目标点云信息中表示同一位置的点进行迭代,计算出所述参考点云信息与所述目标点云信息之间的位姿变换矩阵;
根据所述位姿变换矩阵对所述目标位姿进行变换,得到校正后的雷达的位姿。
7.根据权利要求6所述的方法,其特征在于,根据所述雷达当前的位姿信息,确定所述机器人的定位信息,包括:
获取所述雷达在多个位置的位姿,及获取所述机器人在各位姿对应的位置之间运动的第二里程计信息;
根据所述第二里程计信息,将所述雷达在多个位置的位姿转换到所述雷达当前位姿的坐标系下,得到各参考位姿;
根据所述各参考位姿及所述校正后的雷达的位姿,确定所述雷达的目标位姿;
根据所述雷达的目标位姿,确定所述机器人的定位信息。
8.一种定位装置,其特征在于,所述装置包括:
点云信息获取模块,用于根据机器人的雷达采集的点云信息,得到目标点云信息,其中,所述目标点云信息表示所述雷达的当前位姿;
金字塔图获取模块,用于获取预先生成的金字塔图,其中,所述金字塔图包括N个层,每层均包括多个单位区域,第i层中的一个单位区域对应第i+1层中的多个单位区域,且第i层中单位区域的概率为其对应的第i+1层中的单位区域的概率中的最大值,所述金字塔图的第N层中的单位区域对应定位场景的占用概率栅格地图的栅格区域,所述金字塔图的第N层中的单位区域的概率为该单位区域对应的栅格区域可能被物体占据的概率,i=1,…,N-1,N为大于1的正整数;
目标位姿匹配模块,用于根据所述目标点云信息,在所述金字塔图中,逐层进行位姿匹配,并将目标层中位姿匹配评分满足预设条件的单位区域对应的位姿,确定为目标位姿;
雷达位姿校正模块,用于对所述目标位姿进行校正,得到所述雷达当前的位姿信息;
定位信息确定模块,用于根据所述雷达当前的位姿信息,确定所述机器人的定位信息。
9.一种电子设备,其特征在于,包括处理器及存储器;
所述存储器,用于存放计算机程序;
所述处理器,用于执行所述存储器上所存放的程序时,实现权利要求1-7任一所述的定位方法。
10.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质内存储有计算机程序,所述计算机程序被处理器执行时实现权利要求1-7任一所述的定位方法。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010362075.XA CN113589306B (zh) | 2020-04-30 | 2020-04-30 | 定位方法、装置、电子设备及存储介质 |
PCT/CN2021/090659 WO2021219023A1 (zh) | 2020-04-30 | 2021-04-28 | 定位方法、装置、电子设备及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010362075.XA CN113589306B (zh) | 2020-04-30 | 2020-04-30 | 定位方法、装置、电子设备及存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113589306A true CN113589306A (zh) | 2021-11-02 |
CN113589306B CN113589306B (zh) | 2023-04-11 |
Family
ID=78237088
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010362075.XA Active CN113589306B (zh) | 2020-04-30 | 2020-04-30 | 定位方法、装置、电子设备及存储介质 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN113589306B (zh) |
WO (1) | WO2021219023A1 (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116148879B (zh) * | 2021-11-22 | 2024-05-03 | 珠海一微半导体股份有限公司 | 一种机器人提升障碍物标注精度的方法 |
CN114353807B (zh) * | 2022-03-21 | 2022-08-12 | 沈阳吕尚科技有限公司 | 一种机器人的定位方法及定位装置 |
CN115290098B (zh) * | 2022-09-30 | 2022-12-23 | 成都朴为科技有限公司 | 一种基于变步长的机器人定位方法和系统 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20140350839A1 (en) * | 2013-05-23 | 2014-11-27 | Irobot Corporation | Simultaneous Localization And Mapping For A Mobile Robot |
CN106092104A (zh) * | 2016-08-26 | 2016-11-09 | 深圳微服机器人科技有限公司 | 一种室内机器人的重定位方法及装置 |
CN107909612A (zh) * | 2017-12-01 | 2018-04-13 | 驭势科技(北京)有限公司 | 一种基于3d点云的视觉即时定位与建图的方法与系统 |
CN108917759A (zh) * | 2018-04-19 | 2018-11-30 | 电子科技大学 | 基于多层次地图匹配的移动机器人位姿纠正算法 |
CN110276834A (zh) * | 2019-06-25 | 2019-09-24 | 达闼科技(北京)有限公司 | 一种激光点云地图的构建方法、终端和可读存储介质 |
CN110307838A (zh) * | 2019-08-26 | 2019-10-08 | 深圳市优必选科技股份有限公司 | 机器人重定位方法、装置、计算机可读存储介质及机器人 |
CN110530368A (zh) * | 2019-08-22 | 2019-12-03 | 浙江大华技术股份有限公司 | 一种机器人定位方法及设备 |
CN110738121A (zh) * | 2019-09-17 | 2020-01-31 | 北京科技大学 | 一种前方车辆检测方法及检测系统 |
-
2020
- 2020-04-30 CN CN202010362075.XA patent/CN113589306B/zh active Active
-
2021
- 2021-04-28 WO PCT/CN2021/090659 patent/WO2021219023A1/zh active Application Filing
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20140350839A1 (en) * | 2013-05-23 | 2014-11-27 | Irobot Corporation | Simultaneous Localization And Mapping For A Mobile Robot |
CN106092104A (zh) * | 2016-08-26 | 2016-11-09 | 深圳微服机器人科技有限公司 | 一种室内机器人的重定位方法及装置 |
CN107909612A (zh) * | 2017-12-01 | 2018-04-13 | 驭势科技(北京)有限公司 | 一种基于3d点云的视觉即时定位与建图的方法与系统 |
CN108917759A (zh) * | 2018-04-19 | 2018-11-30 | 电子科技大学 | 基于多层次地图匹配的移动机器人位姿纠正算法 |
CN110276834A (zh) * | 2019-06-25 | 2019-09-24 | 达闼科技(北京)有限公司 | 一种激光点云地图的构建方法、终端和可读存储介质 |
CN110530368A (zh) * | 2019-08-22 | 2019-12-03 | 浙江大华技术股份有限公司 | 一种机器人定位方法及设备 |
CN110307838A (zh) * | 2019-08-26 | 2019-10-08 | 深圳市优必选科技股份有限公司 | 机器人重定位方法、装置、计算机可读存储介质及机器人 |
CN110738121A (zh) * | 2019-09-17 | 2020-01-31 | 北京科技大学 | 一种前方车辆检测方法及检测系统 |
Also Published As
Publication number | Publication date |
---|---|
CN113589306B (zh) | 2023-04-11 |
WO2021219023A1 (zh) | 2021-11-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113589306B (zh) | 定位方法、装置、电子设备及存储介质 | |
CN111429574B (zh) | 基于三维点云和视觉融合的移动机器人定位方法和系统 | |
US11145073B2 (en) | Computer vision systems and methods for detecting and modeling features of structures in images | |
CN108871353B (zh) | 路网地图生成方法、系统、设备及存储介质 | |
CN108550318B (zh) | 一种构建地图的方法及装置 | |
CN112347550B (zh) | 耦合式室内三维语义建图及建模方法 | |
CN111539994B (zh) | 一种基于语义似然估计的粒子滤波重定位方法 | |
CN110189366B (zh) | 一种激光粗配准方法、装置、移动终端及存储介质 | |
CN108638062B (zh) | 机器人定位方法、装置、定位设备及存储介质 | |
CN110386142A (zh) | 用于自动驾驶车辆的俯仰角校准方法 | |
CN111680673B (zh) | 一种栅格地图中动态物体的检测方法、装置及设备 | |
JP7131994B2 (ja) | 自己位置推定装置、自己位置推定方法、自己位置推定プログラム、学習装置、学習方法及び学習プログラム | |
CN113850129A (zh) | 一种旋转等变的空间局部注意力遥感图像目标检测方法 | |
US20210192777A1 (en) | Method, device and storage medium for positioning object | |
CN114119659A (zh) | 一种多传感器融合的目标跟踪方法 | |
Dimitrievski et al. | Robust matching of occupancy maps for odometry in autonomous vehicles | |
CN112733971B (zh) | 扫描设备的位姿确定方法、装置、设备及存储介质 | |
CN114820668A (zh) | 一种端到端的基于同心环卷积的建筑物规则轮廓自动提取方法 | |
US20230350418A1 (en) | Position determination by means of neural networks | |
Choi et al. | Doppler coherent focusing doa method for efficient radar map generation | |
US20220276046A1 (en) | System and method for providing improved geocoded reference data to a 3d map representation | |
CN115993616A (zh) | 一种基于异源影像匹配的无人机快速地理定位方法及装置 | |
CN115900682A (zh) | 通过序列估计和锚点检测改进道路拓扑的方法 | |
CN114414090A (zh) | 基于遥感影像和多层感知的地表温度预测方法及系统 | |
CN114111791B (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 |