CN114674307B - 一种重定位方法及电子设备 - Google Patents

一种重定位方法及电子设备 Download PDF

Info

Publication number
CN114674307B
CN114674307B CN202210578518.8A CN202210578518A CN114674307B CN 114674307 B CN114674307 B CN 114674307B CN 202210578518 A CN202210578518 A CN 202210578518A CN 114674307 B CN114674307 B CN 114674307B
Authority
CN
China
Prior art keywords
association
global
subset
euclidean distance
pair
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
Application number
CN202210578518.8A
Other languages
English (en)
Other versions
CN114674307A (zh
Inventor
胡兰
张如高
虞正华
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Suzhou Moshi Intelligent Technology Co ltd
Original Assignee
Suzhou Moshi Intelligent Technology Co ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Suzhou Moshi Intelligent Technology Co ltd filed Critical Suzhou Moshi Intelligent Technology Co ltd
Priority to CN202210578518.8A priority Critical patent/CN114674307B/zh
Publication of CN114674307A publication Critical patent/CN114674307A/zh
Application granted granted Critical
Publication of CN114674307B publication Critical patent/CN114674307B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/005Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • G01C21/30Map- or contour-matching

Abstract

本发明公开了一种重定位方法及电子设备,其中,重定位方法包括针对在局部语义地图中观测到的第一物体,关联第一物体和第一全局物体,得到第一关联对,第一全局物体为全局语义地图中与第一物体具有相同语义信息的物体;针对在局部语义地图中观测到的第二物体,关联第二物体和第二全局物体,得到第二关联对,第二全局物体为全局语义地图中与第二物体具有相同语义信息的物体;若第一物体与第二物体之间的欧式距离,与第一全局物体与第二全局物体之间的欧式距离相匹配,合并第一关联对和第二关联对,并基于合并的关联对,对视觉设备进行重定位。重定位的准确度高。

Description

一种重定位方法及电子设备
技术领域
本发明涉及自动驾驶技术领域,具体涉及一种重定位方法及电子设备。
背景技术
在自动驾驶技术的SLAM(simultaneous localization and mapping,即时定位与地图构建)功能模块中,重定位是核心功能之一,被广泛用于解决全局任意起始点初始化、轨迹追踪丢失后重新寻迹等关键问题。现有基于视觉的重定位功能实现可分为基于稀疏特征点的重定位方法和基于语义重定位的方法。其中,基于语义重定位的方法由于利用了高阶语义信息,特征稳定性更强。这个方向目前主要分为两个大类,一类是使用神经网络强大的学习功能,根据观测的语义信息提取特征对,然后利用特征匹配找到对应的场景,最后再计算相机的位姿。另一类是基于传统计算机视觉技术的算法,其主要思路就是将语义定位问题抽象为图匹配问题,然后用图匹配算法进行求解。这类方法计算量小,使用性高,可迁移性强。但重定位的准确度还有待提升。
发明内容
有鉴于此,本发明实施方式提供了一种重定位方法、电子设备及计算机可读存储介质,可以提高重定位的准确度。
本发明一方面提供了一种重定位方法,所述方法包括:
针对在局部语义地图中观测到的第一物体,关联所述第一物体和第一全局物体,得到第一关联对,所述第一全局物体为全局语义地图中与所述第一物体具有相同语义信息的物体;
针对在所述局部语义地图中观测到的第二物体,关联所述第二物体和第二全局物体,得到第二关联对,所述第二全局物体为所述全局语义地图中与所述第二物体具有相同语义信息的物体;
若所述第一物体与所述第二物体之间的欧式距离,与所述第一全局物体与所述第二全局物体之间的欧式距离相匹配,合并所述第一关联对和所述第二关联对,并基于合并的关联对,对视觉设备进行重定位。
本发明另一方面还提供了一种计算机可读存储介质,所述计算机可读存储介质用于存储计算机程序,所述计算机程序被处理器执行时,实现如上所述的方法。
本发明另一方面还提供了一种电子设备,所述电子设备包括处理器和存储器,所述存储器用于存储计算机程序,所述计算机程序被所述处理器执行时,实现如上所述的方法。
本申请上述各个实施方式提供的技术方案中,根据从局部语义地图观测到的物体,在全局语义地图中查找具有相同语义信息的物体,并根据局部语义地图中物体间的欧式距离和全局语义地图中物体间的欧式距离,来确定关联对,进而对视觉设备进行重定位。在重定位时,是根据局部语义地图和全局语义地图中物体空间分布的几何相似性来进行重定位的。由于物体之间的空间分布较为稳定,受干扰因素较少,故可以提高重定位的准确度。
附图说明
通过参考附图会更加清楚的理解本发明的特征和优点,附图是示意性的而不应理解为对本发明进行任何限制,在附图中:
图1示出了本申请的一个实施例提供的重定位方法的流程示意图;
图2示出了本申请一个实施例提供的局部语义地图和全局语义地图的图形化示意图;
图3示出了本申请的一个实施例提供的电子设备的示意图。
具体实施方式
为使本发明实施方式的目的、技术方案和优点更加清楚,下面将结合本发明实施方式中的附图,对本发明实施方式中的技术方案进行清楚、完整地描述,显然,所描述的实施方式是本发明一部分实施方式,而不是全部的实施方式。基于本发明中的实施方式,本领域技术人员在没有作出创造性劳动前提下所获得的所有其他实施方式,都属于本发明保护的范围。
本申请的重定位方法基于预先创建好的全局语义地图和视觉设备移动过程中建立的局部语义地图,通过在全局语义地图中查找与局部语义地图相似的物体空间分布,可以确定视觉设备在全局语义地图中的位姿。其中,视觉设备包括但不限于相机、摄像机等。在本申请所示实施例中,视觉设备包括车载相机。
请参阅图1,为本申请的一个实施例提供的重定位方法的流程示意图。重定位方法可以应用于电子设备。电子设备包括但不限于车载控制设备、电脑、与视觉设备通信连接的远程服务器。重定位方法包括步骤S11至步骤S13。
步骤S11,针对在局部语义地图中观测到的第一物体,关联第一物体和第一全局物体,得到第一关联对,第一全局物体为全局语义地图中与第一物体具有相同语义信息的物体。
在一些实施例中,局部语义地图和全局语义地图可以是基于不同坐标系统建立的。比如局部语义地图基于相机坐标系统建立,全局语义地图基于世界坐标系建立。可以理解的是,局部语义地图和全局语义地图也可以是基于相同坐标系建立。
在一些实施例中,局部语义地图包括物体的语义信息和物体在局部语义地图中的位置信息;全局语义地图包括物体的语义信息和物体在全局语义地图中的位置信息。其中,物体包括但不限于视觉设备移动过程中,周围环境中的红绿灯、树、房子、道路标识、车牌等。同一物体,在局部语义地图的语义信息和在全局语义地图中的语义信息相同。另外,针对语义信息相同,位置不同的物体,在全局语义地图中体现为不同的物体。比如位于位置A的房子和位于位置B的房子,两者语义信息相同,但位置信息不同,在全局语义地图中表示为不同的物体。为便于理解,表格1示例性的给出了全局语义地图里语义信息和位置信息的对应关系示例。
表格1语义信息和位置信息的对应关系示例
Figure 436825DEST_PATH_IMAGE001
从表格1可以看出,在全局语义地图中,语义信息为“房子”的物体,分别位于位置A、位置B和位置D。
基于以上描述,以下对步骤S11进行详细描述。
在一些实施例中,在局部语义地图中观测到第一物体时,可以获得第一物体在局部语义地图中的语义信息和位置信息。基于第一物体的语义信息,可以在全局语义地图中查找与第一物体具有相同语义信息的第一全局物体。其中,查找到的第一全局物体可以作为全局语义地图中与第一物体相匹配的物体。第一关联对用于表示第一物体和第一全局物体之间的匹配关系。比如假设第一物体为x,第一全局物体为X,第一关联对可以记为(x,X),表示局部语义地图中的第一物体x和第一全局物体X相匹配。
另外,通过上述描述可知,全局语义地图中可以存在语义信息相同但位置不同的多个第一全局物体,即全局语义地图中可以存在与第一物体相匹配的多个第一全局物体。基于此,可以建立多个第一关联对,每个第一关联对用于表示第一物体与其中一个第一全局物体之间的匹配关系。比如,假设第一物体为x,在全局语义地图中存第一全局物体X1、X2、X3、X4,则可以建立4个第一关联对,分别为(x,X1)、(x,X2)、(x,X3)、(x,X4),用于表示第一物体x与全局语义地图中第一全局物体之间的匹配关系。
步骤S12,针对在局部语义地图中观测到的第二物体,关联第二物体和第二全局物体,得到第二关联对,第二全局物体为全局语义地图中与第二物体具有相同语义信息的物体。
在一些实施例中,第二物体和第一物体是在局部语义地图中处于不同位置的物体。第二物体可以是在观测到第一物体之后观测到的物体,也可以是与第一物体同时观测到的物体。其中,建立第二关联对的过程,与建立第一关联对类似,此处不赘述。
步骤S13,若第一物体与第二物体之间的欧式距离,与第一全局物体与第二全局物体之间的欧式距离相匹配,将第一关联对和第二关联对合并,并基于合并的关联对,对视觉设备进行重定位。
在一些实施例中,第一物体与第二物体之间的欧式距离,与第一全局物体与第二全局物体之间的欧式距离相匹配,可以指:第一物体与第二物体之间的欧式距离,等于第一全局物体与第二全局物体之间的欧式距离。具体来说,第一物体和第二物体的位置从局部语义地图变换到全局语义地图的过程为仿射变换。在变换前后,第一物体和第二物体之间的距离具有不变性。又由于第一全局物体是与第一物体具有相同语义信息的物体,第二全局物体是与第二物体具有相同语义信息的物体,若第一物体与第二物体之间的欧式距离,等于第一全局物体与第二全局物体之间的欧式距离,则可以判断第一物体和第二物体在局部语义地图中的空间分布,与第一全局物体和第二全局物体在全局语义地图中的空间分布相同。第一物体的位置从局部语义地图变换到全局语义地图后,可能位于第一全局物体在全局语义地图中的位置;第二物体的位置从局部语义地图变换到全局语义地图后,可能位于第二全局物体在全局语义地图中的位置。基于此,根据第一全局物体和第二全局物体在全局语义地图中的位置,以及第一物体和第二物体在局部语义地图中的位置,联合求解,就可以求得视觉设备在全局语义地图中的位姿,从而实现视觉设备在全局语义地图中的重定位。
基于以上描述,在步骤S13中所述的合并第一关联对和第二关联对,可以是指将第一关联对和第二关联对作为一个关联组合对,根据该关联组合对中第一物体和第二物体在局部语义地图里的位置,以及第一全局物体和第二全局物体在全局语义地图中的位置,求解视觉设备在全局语义地图中的位姿。
在一些实施例中,考虑到噪声等因素的存在,第一物体与第二物体之间的欧式距离,无法完全等于第一全局物体与第二全局物体之间的欧式距离。因此,在实际计算过程中,通常在满足如下条件时,可以确定第一物体与第二物体之间的欧式距离,与第一全局物体与第二全局物体之间的欧式距离相匹配:
基于第一物体与第二物体之间的欧式距离,以及第一全局物体与第二全局物体之间的欧式距离,得到的最小欧式距离比大于阈值,其中,最小欧式距离比基于如下表达式得到:
Figure 777808DEST_PATH_IMAGE002
其中,
Figure 752648DEST_PATH_IMAGE003
表示最小欧式距离比,
Figure 38135DEST_PATH_IMAGE004
表示第一物体与第二物体之间的欧式距离,
Figure 40726DEST_PATH_IMAGE005
表示第一全局物体与第二全局物体之间的欧式距离。可以理解的是,若没有噪声等因素 影响,
Figure 970636DEST_PATH_IMAGE006
Figure 666060DEST_PATH_IMAGE007
的取值为1时,表示第一物体与第二物体之间的欧式距离,等于第一 全局物体与第二全局物体之间的欧式距离。但在噪声存在的情况下,
Figure 173265DEST_PATH_IMAGE004
Figure 838601DEST_PATH_IMAGE005
不相等,
Figure 13231DEST_PATH_IMAGE006
Figure 754922DEST_PATH_IMAGE007
的取值通常一个大于1,一个小于1。为便于计算,可以通过取最小值的方 式,选择
Figure 15002DEST_PATH_IMAGE006
Figure 516652DEST_PATH_IMAGE007
中小于1的值作为最小欧式距离比。可以理解的是,最小欧式距离 比应该是越接近1,表示两个欧式距离越相近(即越匹配)。基于此,可以设置一个靠近1的阈 值(比如0.9)。若最小欧式距离比大于0.9,可以表示第一物体与第二物体之间的欧式距离, 与第一全局物体与第二全局物体之间的欧式距离相匹配。如此,在方案实施上,可行性更 高。
请参阅图2,为本申请一个实施例提供的局部语义地图和全局语义地图的图形化示意图。图2中,假设实线框内的地图为全局语义地图的图形化示意图,虚线框内的地图为局部语义地图的图形化示意图。
结合上述步骤S11。假设在局部语义地图中,观测到的第一物体为x。全局语义地图 中与第一物体x具有相同语义信息的第一全局物体为
Figure 545788DEST_PATH_IMAGE008
。将第一物体x分别与第一全 局物体
Figure 989539DEST_PATH_IMAGE008
进行关联,可以得到4个第一关联对,分别为
Figure 595970DEST_PATH_IMAGE009
Figure 9634DEST_PATH_IMAGE010
Figure 627697DEST_PATH_IMAGE011
Figure 711190DEST_PATH_IMAGE012
结合上述步骤S12。假设在局部语义地图中,观测到的第二物体为y。全局语义地图 中与第二物体y具有相同语义信息的第二全局物体为
Figure 680283DEST_PATH_IMAGE013
。将第二物体y分别与第二全 局物体
Figure 366480DEST_PATH_IMAGE013
进行关联,可以得到3个第二关联对,分别为
Figure 996306DEST_PATH_IMAGE014
Figure 375335DEST_PATH_IMAGE015
Figure 707090DEST_PATH_IMAGE016
结合上述步骤S13。假设第一物体x和第二物体y之间的欧式距离为
Figure 196978DEST_PATH_IMAGE017
。在全局语 义地图中,用矩形框圈出的6个第一全局物体和第二全局物体的组合,其欧式距离均可与第 一物体x和第二物体y之间的欧式距离
Figure 789633DEST_PATH_IMAGE017
相匹配。这种情况下,第一物体x的位置从局部语 义地图转换到全局语义地图后,可能位于全局语义地图中的4个位置处,即第一全局物体
Figure 729776DEST_PATH_IMAGE008
的位置处。第二物体y的位置从局部语义地图中转换到全局语义地图后,可能位于 全局语义地图中的3个位置处,即第二全局物体
Figure 407882DEST_PATH_IMAGE013
的位置处。很显然,这样的结果存在 不准确的问题。在全局语义地图中应该只有一组第一全局物体和第二全局物体的组合,与 第一物体x和第二物体y的组合匹配。现在出现多组第一全局物体和第二全局物体的组合, 可能会影响位姿求解的精度。
基于以上描述,可以在局部语义地图中继续观测新的物体,比如观测到第三物体 z,然后基于第一物体x、第一物体y和第三物体z在局部语义地图中的空间分布,可以在全局 语义地图中进一步把区域限定在椭圆区域内。全局语义地图中,不存在其他物体之间的空 间分布,与椭圆区域中的空间分布相同,则可以确定,第一物体x的位置从局部语义地图转 换到全局语义地图后,唯一落在椭圆区域内的第一全局物体
Figure 842406DEST_PATH_IMAGE018
的位置处;第一物体y的位 置从局部语义地图转换到全局语义地图后,唯一落在椭圆区域内的第二全局物体
Figure 289567DEST_PATH_IMAGE019
的位 置处;第三物体z的位置从局部语义地图转换到全局语义地图后,唯一落在椭圆区域内的第 三全局物体
Figure 10399DEST_PATH_IMAGE020
的位置处。如此,利用了空间分布的信息,避免了仅根据局部地图和全局地 图的语义信息一致性,位姿计算可能会出现错误的问题,提高了位姿计算的精度。
基于上述的方案描述,本申请的一些实施例中,提供一种基于关联集合的方法来进行重定位,可以实现增量式的重定位。方案阐述过程中,将上述局部语义地图中观测到的第一物体x和第二物体y作为基础:
在一些实施例中,首先构建包括关联子集的关联集合,关联子集可以包括关联对和子集得分,每个关联子集的子集得分用于评估相应关联子集在所有关联子集中的优先级顺序。在一些实施例中,每个关联子集的子集得分可以初始化为1。
在一些实施例中,构建完成的关联集合如下所示:
Figure 801899DEST_PATH_IMAGE021
Figure 633589DEST_PATH_IMAGE022
其中,D表示关联集合;
Figure 200837DEST_PATH_IMAGE023
表示第k个关联子集;n表示关联子集个数,
Figure 967936DEST_PATH_IMAGE024
表 示关联对;m表示关联子集中关联对的个数;
Figure 620634DEST_PATH_IMAGE025
表示第k个关联子集的子集得分。
基于构建的关联集合,若在局部语义地图中检测到第一物体x(即在局部语义地图 中检测到第一个物体),可以在每个关联子集中关联第一物体x与其中一个第一全局物体, 即在局部语义地图中观测到第一物体x时,每个关联子集中的m取值为1。此处,假设第一物 体x和第一全局物体
Figure 521594DEST_PATH_IMAGE008
之间存在4个第一关联对,分别为(x,X1)、(x,X2)、(x,X3)、(x, X4),则:
Figure 802402DEST_PATH_IMAGE026
Figure 428818DEST_PATH_IMAGE027
在一些实施例中,在构建完关联集合后,基于第二物体,构建包括临时关联子集的 临时关联集合,原理与上述构建关联集合类似,此处不赘述。此处,假设第二物体y和第二全 局物体
Figure 224605DEST_PATH_IMAGE013
之间存在3个第二关联对,分别为(y,Y1)、(y,Y2)、(y,Y3),则:
Figure 70201DEST_PATH_IMAGE028
Figure 877620DEST_PATH_IMAGE029
在一些实施例中,构建完关联集合D和临时关联集合
Figure 2833DEST_PATH_IMAGE030
后,针对任一关联子集(即 上述
Figure 630123DEST_PATH_IMAGE031
中的任一个),若该关联子集中的第一物体与第二物体之间的欧式距 离,与该关联子集中的第一全局物体与第二全局物体之间的欧式距离相匹配,将第二关联 对合并至该关联子集中,得到新关联子集。具体的,就是将每一个关联子集
Figure 748252DEST_PATH_IMAGE031
,分别与临时关联子集
Figure 144598DEST_PATH_IMAGE032
Figure 939248DEST_PATH_IMAGE033
Figure 53834DEST_PATH_IMAGE034
进行欧式距离匹配,若欧式距离匹配 成功,就将相应临时关联子集中的第二关联对合并到对应的关联子集中,得到一个新关联 子集。同时,更新新关联子集的子集得分,以提高新关联子集在关联子集中的优先级。在一 些实施例中,第二关联对存在对应的临时得分,该临时得分可以为第二关联对所在的临时 关联子集的临时子集得分。在更新新关联子集的子集得分时,将新关联子集当前的子集得 分、第二关联对对应的临时得分以及最小欧式距离比相加后得到的值,作为新关联子集更 新后的子集得分。最小欧式距离比可以基于如下表达式得到:
Figure 710075DEST_PATH_IMAGE035
其中,h表示最小欧式距离比,
Figure 960928DEST_PATH_IMAGE036
表示新关联子集中的第一物体与第二物体之间 的欧式距离,
Figure 427943DEST_PATH_IMAGE037
表示新关联子集中的第一全局物体与第二全局物体之间的欧式距离。
以下通过举例进行说明。
比如,基于如下表达式,将关联子集
Figure 764247DEST_PATH_IMAGE038
和临时关联子集
Figure 348812DEST_PATH_IMAGE039
进行欧式距离匹配:
Figure 329537DEST_PATH_IMAGE040
其中,
Figure 341356DEST_PATH_IMAGE041
表示第一物体x与第二物体y之间的欧式距离,
Figure 899376DEST_PATH_IMAGE042
表示第一全局物 体
Figure 146687DEST_PATH_IMAGE043
与第二全局物体Y1的欧式距离,
Figure 372132DEST_PATH_IMAGE044
表示将关联子集
Figure 289272DEST_PATH_IMAGE045
和临时关联子集
Figure 741113DEST_PATH_IMAGE046
进 行欧式距离匹配时的最小欧式距离比。若
Figure 401901DEST_PATH_IMAGE044
大于阈值,则将临时关联子集
Figure 107952DEST_PATH_IMAGE046
中的第 二关联对合并到关联子集
Figure 461573DEST_PATH_IMAGE045
,得到一个新关联子集
Figure 994185DEST_PATH_IMAGE047
Figure 599610DEST_PATH_IMAGE048
同理,基于关联子集
Figure 268489DEST_PATH_IMAGE045
和临时关联子集
Figure 58590DEST_PATH_IMAGE049
继续进行欧式距离匹配:
Figure 203132DEST_PATH_IMAGE050
相关参数的说明与上一个示例类似,此处不赘述。此处,假设若
Figure 471303DEST_PATH_IMAGE051
大于阈值, 则将临时关联子集
Figure 260267DEST_PATH_IMAGE049
中的第二关联对合并到关联子集
Figure 831057DEST_PATH_IMAGE045
,得到一个新关联子集
Figure 338262DEST_PATH_IMAGE052
Figure 144544DEST_PATH_IMAGE053
在一些实施例中,对于未与关联子集进行合并的第二关联对,在关联集合中构建新的关联子集,并在新的关联子集中,建立第二关联对。新的关联子集的子集得分可以第二关联对所在的临时关联子集的临时子集得分。
在一些实施例中,对于关联集合中未进行合并的关联子集,保持这些关联子集的子集得分不变化。
如此,经过上述的匹配合并操作后,以下给出了关联集合D所包括的部分关联子集示例:
Figure 933553DEST_PATH_IMAGE054
Figure 534299DEST_PATH_IMAGE055
Figure 528799DEST_PATH_IMAGE056
Figure 14138DEST_PATH_IMAGE057
在上述示例中,
Figure 777695DEST_PATH_IMAGE047
Figure 549342DEST_PATH_IMAGE052
是执行合并操作后得到的关联子集,
Figure 421352DEST_PATH_IMAGE058
Figure 569437DEST_PATH_IMAGE059
是关 联集合中原始的关联子集,
Figure 328445DEST_PATH_IMAGE060
是以关联子集的方式,单独添加至关联集合第二关联对。
从上面示例可以看出,经过这样的合并,局部语义地图中和全局语义地图中,存在相似几何空间分布的物体开始聚类。
进一步的,针对在局部语义地图中观测到的第三物体,关联第三物体和第三全局 物体,得到第三关联对,第三全局物体为全局语义地图中与第三物体具有相同语义信息的 物体。此处,基于第三关联对可以构建新的临时关联集合,并与上述更新后的关联集合D再 次进行欧式距离的匹配判断、合并等操作。具体的,针对关联集合中任一个已合并第二关联 对的关联子集来说,若在该关联子集中,第一物体与第三物体之间的欧式距离,与第一全局 物体与第三全局物体之间的欧式距离相匹配,且第二物体与第三物体之间的欧式距离,与 第二全局物体与第三全局物体之间的欧式距离相匹配,将第三关联对合并至该关联子集 中。比如,上述关联子集
Figure 536573DEST_PATH_IMAGE047
Figure 240086DEST_PATH_IMAGE052
即为已合并第二关联对的关联子集。此处以关联子集
Figure 926283DEST_PATH_IMAGE047
为例进行说明。
首先,建立第三关联对,并基于第三关联对确定新的临时关联集合。此处,假设第 三物体z和第三全局物体
Figure 556109DEST_PATH_IMAGE061
之间存在2个第二关联对,分别为(z,Z1)、(z,Z2),则:
Figure 669559DEST_PATH_IMAGE062
Figure 860369DEST_PATH_IMAGE063
为方便查看,此处一并列出
Figure 225622DEST_PATH_IMAGE064
的表达式:
Figure 83857DEST_PATH_IMAGE065
将关联子集
Figure 633787DEST_PATH_IMAGE064
和临时关联集合
Figure 702106DEST_PATH_IMAGE066
进行欧式距离匹配:
Figure 730105DEST_PATH_IMAGE067
Figure 177267DEST_PATH_IMAGE068
其中,
Figure 773464DEST_PATH_IMAGE069
表示第一物体x与第三物体z之间的欧式距离,
Figure 204445DEST_PATH_IMAGE070
表示第一全局物 体
Figure 36135DEST_PATH_IMAGE071
与第三全局物体Z1的欧式距离,
Figure 229481DEST_PATH_IMAGE072
表示第二物体y与第三物体z之间的欧式距离,
Figure 121214DEST_PATH_IMAGE073
表示第二全局物体
Figure 773912DEST_PATH_IMAGE074
与第三全局物体Z1的欧式距离,
Figure 284659DEST_PATH_IMAGE075
Figure 706413DEST_PATH_IMAGE076
表示将关 联子集
Figure 769047DEST_PATH_IMAGE077
和临时关联子集
Figure 33675DEST_PATH_IMAGE078
进行欧式距离匹配时的最小欧式距离比。假设
Figure 472747DEST_PATH_IMAGE075
Figure 749007DEST_PATH_IMAGE076
均大于阈值时,则将第三关联对合并至关联子集
Figure 123488DEST_PATH_IMAGE077
中,得到新的关联子集
Figure 485199DEST_PATH_IMAGE079
Figure 196803DEST_PATH_IMAGE080
通过关联子集
Figure 219248DEST_PATH_IMAGE079
的表达式可以看出,随着观测到的物体增多,聚类的物体增 多。局部语义地图中物体的空间分布,可以与全局语义地图中物体的空间分布,做到唯一匹 配。全局语义地图中的物体所在位置,可以为局部语义地图中的物体所在位置转换至全局 语义地图后的位置。如此,基于关联子集
Figure 889264DEST_PATH_IMAGE079
中的物体在全局语义地图中的位置和在局 部语义地图中的位置,可以确定视觉设备的位姿,即对视觉设备进行重定位,且精度较高。 可以理解的是,在局部语义地图中,还可以继续观测多个物体,比如在上述第三物体基础 上,继续观测第四物体、第五物体……。在局部语义地图中,每观测到一个新的物体后,可以 按照上述方法,对物体进行聚类。随着观测到的物体越多,重定位的精度可以越高。
在一些实施例中,关联子集的子集得分与关联子集的优先级成正比。在所有的关联子集中,可以按照优先级从高到低的顺序,选择预设个关联子集,并基于该些关联子集中的关联对,对视觉设备进行重定位。通过上述描述可知,在每一次合并时,会对关联子集的子集得分进行更新。可以理解的是,对于得分高的关联子集,具有的匹配物体更多,数据量更多,计算得到的位姿更准确。
在一些实施例中,在该些关联子集中,基于每个关联子集中的关联对所对应的物体位置,分别确定一个视觉设备的位姿。在确定出的位姿中,选择几何残差最小的位姿作为视觉设备的位姿。进一步提高结果的准确性。
在本申请的一些实施例中,根据从局部语义地图观测到的物体,在全局语义地图中查找具有相同语义信息的物体,并根据局部语义地图中物体间的欧式距离和全局语义地图中物体间的欧式距离,来确定关联对,进而对视觉设备进行重定位。在重定位时,是根据局部语义地图和全局语义地图中物体空间分布的几何相似性来进行重定位的。由于物体之间的空间分布较为稳定,受干扰因素较少,故可以提高重定位的准确度。举例来说,一些重定位技术中,是根据图像比对来进行重定位的,图像容易受光照等因素影响,故重定位的准确度会受这些因素影响。相比而言,本申请的重定位方法不受该些因素影响,重定位的准确度较高。
请参阅图3,为本申请的一个实施例提供的电子设备的示意图。电子设备包括处理器和存储器,所述存储器用于存储计算机程序,所述计算机程序被所述处理器执行时,实现上述的重定位方法。
其中,处理器可以为中央处理器(Central Processing Unit,CPU)。处理器还可以为其他通用处理器、数字信号处理器(Digital Signal Processor,DSP)、专用集成电路(Application Specific Integrated Circuit,ASIC)、现场可编程门阵列(Field-Programmable Gate Array,FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等芯片,或者上述各类芯片的组合。
存储器作为一种非暂态计算机可读存储介质,可用于存储非暂态软件程序、非暂态计算机可执行程序以及模块,如本发明实施方式中的方法对应的程序指令/模块。处理器通过运行存储在存储器中的非暂态软件程序、指令以及模块,从而执行处理器的各种功能应用以及数据处理,即实现上述方法实施方式中的方法。
存储器可以包括存储程序区和存储数据区,其中,存储程序区可存储操作系统、至少一个功能所需要的应用程序;存储数据区可存储处理器所创建的数据等。此外,存储器可以包括高速随机存取存储器,还可以包括非暂态存储器,例如至少一个磁盘存储器件、闪存器件、或其他非暂态固态存储器件。在一些实施方式中,存储器可选包括相对于处理器远程设置的存储器,这些远程存储器可以通过网络连接至处理器。上述网络的实例包括但不限于互联网、企业内部网、局域网、移动通信网及其组合。
本申请一个实施方式还提供一种计算机可读存储介质,所述计算机可读存储介质用于存储计算机程序,所述计算机程序被处理器执行时,实现上述的重定位方法。
虽然结合附图描述了本发明的实施方式,但是本领域技术人员可以在不脱离本发明的精神和范围的情况下作出各种修改和变型,这样的修改和变型均落入由所附权利要求所限定的范围之内。

Claims (9)

1.一种重定位方法,其特征在于,所述方法包括:
针对在局部语义地图中观测到的第一物体,关联所述第一物体和第一全局物体,得到第一关联对,所述第一全局物体为全局语义地图中与所述第一物体具有相同语义信息的物体;
针对在所述局部语义地图中观测到的第二物体,关联所述第二物体和第二全局物体,得到第二关联对,所述第二全局物体为所述全局语义地图中与所述第二物体具有相同语义信息的物体;
若所述第一物体与所述第二物体之间的欧式距离,与所述第一全局物体与所述第二全局物体之间的欧式距离相匹配,合并所述第一关联对和所述第二关联对,并基于合并的关联对,对视觉设备进行重定位;其中,所述全局语义地图中存在多个所述第一全局物体;
所述关联所述第一物体和第一全局物体,包括:
构建包括关联子集的关联集合,并在每个所述关联子集中关联所述第一物体与其中一个所述第一全局物体;
所述合并所述第一关联对和所述第二关联对,包括:
针对任一所述关联子集,若该关联子集中的第一物体与所述第二物体之间的欧式距离,与该关联子集中的第一全局物体与所述第二全局物体之间的欧式距离相匹配,将所述第二关联对合并至该关联子集中,得到新关联子集;其中,
所述关联子集包括子集得分,每个所述关联子集的子集得分用于评估相应关联子集在所有关联子集中的优先级顺序;
在得到新关联子集后,所述方法还包括:
更新所述新关联子集的子集得分,以提高所述新关联子集在关联子集中的优先级。
2.如权利要求1所述的方法,其特征在于,所述关联子集的子集得分与所述关联子集的优先级成正比,所述第二关联对存在对应的临时得分;
更新所述新关联子集的子集得分,包括:
将所述新关联子集当前的子集得分、所述第二关联对对应的临时得分以及最小欧式距离比相加后得到的值,作为所述新关联子集更新后的子集得分;其中,所述最小欧式距离比基于如下表达式得到:
Figure 339352DEST_PATH_IMAGE001
其中,h表示最小欧式距离比,
Figure 560249DEST_PATH_IMAGE002
表示所述新关联子集中的第一物体与所述第二物体之间的欧式距离,
Figure 913870DEST_PATH_IMAGE003
表示所述新关联子集中的第一全局物体与所述第二全局物体之间的欧式距离。
3.如权利要求1所述的方法,其特征在于,所述基于合并的关联对,对视觉设备进行重定位,包括:
在所有的关联子集中,按照优先级从高到低的顺序,选择预设个关联子集,并基于该些关联子集中的关联对,对视觉设备进行重定位。
4.如权利要求3所述的方法,其特征在于,所述基于该些关联子集中的关联对,对视觉设备进行重定位,包括:
在该些关联子集中,基于每个关联子集中的关联对所对应的物体位置,分别确定一个所述视觉设备的位姿;
在确定出的位姿中,选择几何残差最小的位姿作为所述视觉设备的位姿。
5.如权利要求1所述的方法,其特征在于,所述方法还包括:
针对在所述局部语义地图中观测到的第三物体,关联所述第三物体和第三全局物体,得到第三关联对,所述第三全局物体为所述全局语义地图中与所述第三物体具有相同语义信息的物体;
针对所述关联集合中任一个已合并所述第二关联对的关联子集,若在该关联子集中,第一物体与所述第三物体之间的欧式距离,与第一全局物体与所述第三全局物体之间的欧式距离相匹配,且第二物体与所述第三物体之间的欧式距离,与所述第二全局物体与所述第三全局物体之间的欧式距离相匹配,将所述第三关联对合并至该关联子集中。
6.如权利要求1所述的方法,其特征在于,对于未与所述关联子集进行合并的第二关联对,在所述关联集合中构建新的关联子集,并在所述新的关联子集中,建立所述第二关联对。
7.如权利要求1所述的方法,其特征在于,在满足如下条件时,确定所述第一物体与所述第二物体之间的欧式距离,与所述第一全局物体与所述第二全局物体之间的欧式距离相匹配:
基于所述第一物体与所述第二物体之间的欧式距离,以及所述第一全局物体与所述第二全局物体之间的欧式距离,得到的最小欧式距离比大于阈值,其中,所述最小欧式距离比基于如下表达式得到:
Figure 836695DEST_PATH_IMAGE004
其中,
Figure 566754DEST_PATH_IMAGE005
表示最小欧式距离比,
Figure 642157DEST_PATH_IMAGE006
表示所述第一物体与所述第二物体之间的欧式距离,
Figure 166680DEST_PATH_IMAGE007
表示所述第一全局物体与所述第二全局物体之间的欧式距离。
8.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质用于存储计算机程序,所述计算机程序被处理器执行时,实现如权利要求1至7中任一所述的方法。
9.一种电子设备,其特征在于,所述电子设备包括处理器和存储器,所述存储器用于存储计算机程序,所述计算机程序被所述处理器执行时,实现如权利要求1至7中任一所述的方法。
CN202210578518.8A 2022-05-26 2022-05-26 一种重定位方法及电子设备 Active CN114674307B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210578518.8A CN114674307B (zh) 2022-05-26 2022-05-26 一种重定位方法及电子设备

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210578518.8A CN114674307B (zh) 2022-05-26 2022-05-26 一种重定位方法及电子设备

Publications (2)

Publication Number Publication Date
CN114674307A CN114674307A (zh) 2022-06-28
CN114674307B true CN114674307B (zh) 2022-09-27

Family

ID=82079844

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210578518.8A Active CN114674307B (zh) 2022-05-26 2022-05-26 一种重定位方法及电子设备

Country Status (1)

Country Link
CN (1) CN114674307B (zh)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2015192745A1 (zh) * 2014-06-19 2015-12-23 无锡知谷网络科技有限公司 目标即时定位和构建地图的方法与装置
CN107144285A (zh) * 2017-05-08 2017-09-08 深圳地平线机器人科技有限公司 位姿信息确定方法、装置和可移动设备
CN108344999A (zh) * 2018-01-09 2018-07-31 浙江大学 一种用于水下机器人导航的声呐地图构建与重定位方法
CN109447023A (zh) * 2018-11-08 2019-03-08 北京奇艺世纪科技有限公司 确定图像相似度的方法、视频场景切换识别方法及装置
CN110207710A (zh) * 2019-06-26 2019-09-06 北京小狗智能机器人技术有限公司 机器人重定位方法及装置
CN114528453A (zh) * 2021-12-31 2022-05-24 北京易航远智科技有限公司 全局重定位方法、装置、电子设备及存储介质

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2015192745A1 (zh) * 2014-06-19 2015-12-23 无锡知谷网络科技有限公司 目标即时定位和构建地图的方法与装置
CN107144285A (zh) * 2017-05-08 2017-09-08 深圳地平线机器人科技有限公司 位姿信息确定方法、装置和可移动设备
CN108344999A (zh) * 2018-01-09 2018-07-31 浙江大学 一种用于水下机器人导航的声呐地图构建与重定位方法
CN109447023A (zh) * 2018-11-08 2019-03-08 北京奇艺世纪科技有限公司 确定图像相似度的方法、视频场景切换识别方法及装置
CN110207710A (zh) * 2019-06-26 2019-09-06 北京小狗智能机器人技术有限公司 机器人重定位方法及装置
CN114528453A (zh) * 2021-12-31 2022-05-24 北京易航远智科技有限公司 全局重定位方法、装置、电子设备及存储介质

Also Published As

Publication number Publication date
CN114674307A (zh) 2022-06-28

Similar Documents

Publication Publication Date Title
US8798357B2 (en) Image-based localization
CN111079570B (zh) 一种人体关键点识别方法、装置及电子设备
CN111652934A (zh) 定位方法及地图构建方法、装置、设备、存储介质
WO2016119117A1 (en) Localization and mapping method
WO2021027692A1 (zh) 视觉特征库的构建方法、视觉定位方法、装置和存储介质
US11193790B2 (en) Method and system for detecting changes in road-layout information
CN110390356B (zh) 视觉词典生成方法及装置、存储介质
CN112123343B (zh) 点云匹配方法、设备及存储介质
CN111046847A (zh) 一种视频处理方法、装置、电子设备以及介质
CN111784776A (zh) 视觉定位方法及装置、计算机可读介质和电子设备
CN114565668A (zh) 即时定位与建图方法及装置
JP2023510945A (ja) シーン識別方法及びその装置、インテリジェントデバイス、記憶媒体並びにコンピュータプログラム
CN115683129A (zh) 一种基于高清地图的长期重定位方法和装置
CN110068824B (zh) 一种传感器位姿确定方法和装置
CN114674307B (zh) 一种重定位方法及电子设备
CN111291611A (zh) 一种基于贝叶斯查询扩展的行人重识别方法及装置
WO2022252482A1 (zh) 机器人及其环境地图构建方法和装置
US20220351495A1 (en) Method for matching image feature point, electronic device and storage medium
CN109816709B (zh) 基于单目摄像头的深度估计方法、装置及设备
CN114943766A (zh) 重定位方法、装置、电子设备及计算机可读存储介质
CN116295466A (zh) 地图生成方法、装置、电子设备、存储介质、及车辆
Shen et al. A detector-oblivious multi-arm network for keypoint matching
CN110781841A (zh) 基于slam空间不变信息的闭环检测方法和装置
WO2020021238A1 (en) Method of model alignment through localisation usage
CN111368860B (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