CN111707275A - 一种定位方法、装置、电子设备及计算机可读存储介质 - Google Patents
一种定位方法、装置、电子设备及计算机可读存储介质 Download PDFInfo
- Publication number
- CN111707275A CN111707275A CN202010397339.5A CN202010397339A CN111707275A CN 111707275 A CN111707275 A CN 111707275A CN 202010397339 A CN202010397339 A CN 202010397339A CN 111707275 A CN111707275 A CN 111707275A
- Authority
- CN
- China
- Prior art keywords
- determining
- local
- plane
- positioning
- observation
- 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
- 238000000034 method Methods 0.000 title claims abstract description 57
- 238000003860 storage Methods 0.000 title description 13
- 239000011159 matrix material Substances 0.000 claims abstract description 44
- 230000009466 transformation Effects 0.000 claims abstract description 32
- 230000008569 process Effects 0.000 claims abstract description 15
- 239000013598 vector Substances 0.000 claims description 37
- 238000005457 optimization Methods 0.000 claims description 12
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 230000006870 function Effects 0.000 description 19
- 238000010586 diagram Methods 0.000 description 15
- 230000009467 reduction Effects 0.000 description 8
- 238000005516 engineering process Methods 0.000 description 7
- 238000004590 computer program Methods 0.000 description 6
- 238000004891 communication Methods 0.000 description 5
- 230000004807 localization Effects 0.000 description 5
- 238000004364 calculation method Methods 0.000 description 4
- 238000004422 calculation algorithm Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000014509 gene expression Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 230000007704 transition Effects 0.000 description 2
- 230000000712 assembly Effects 0.000 description 1
- 238000000429 assembly Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000003550 marker Substances 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
Images
Classifications
-
- 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/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F16/00—Information retrieval; Database structures therefor; File system structures therefor
- G06F16/20—Information retrieval; Database structures therefor; File system structures therefor of structured data, e.g. relational data
- G06F16/23—Updating
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F16/00—Information retrieval; Database structures therefor; File system structures therefor
- G06F16/20—Information retrieval; Database structures therefor; File system structures therefor of structured data, e.g. relational data
- G06F16/29—Geographical information databases
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Theoretical Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Databases & Information Systems (AREA)
- Data Mining & Analysis (AREA)
- General Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
Abstract
本申请披露了一种定位方法,包括:基于初始位置,获取局部语义地图;基于局部语义地图,确定局部平面;确定全局坐标系O1和局部平面的坐标系O2的转换矩阵Tp;基于所述转换矩阵Tp,确定车辆定位。本申请通过将平面假设作为一种约束,应用到定位过程中,提高了定位精度以及定位鲁棒性和成功率。
Description
技术领域
本申请涉及无人驾驶领域,具体涉及一种定位方法、装置、电子 设备及存储介质。
背景技术
随着智能驾驶的发展和普及,各种应用场景也对其关键技术尤其 是定位技术提出了更高的要求。目前主流的定位技术包括GPS定位 技术,基于外部设施如基站的定位技术,包括车载传感器的定位技术 如lslam、vlsam等。上述技术各有优缺点以及应用限制,为了适应越 来越广泛且复杂的应用场景,行业目前越来越重视对环境高级语义信 息的利用以提升定位效果,然而,高级语义具有的稀疏性,只能提供 有限的定位约束,容易出现定位失败的情况。
发明内容
针对现有技术中的定位精度低、失败率高的问题,本申请实施例 提出了一种定位方法、装置、电子设备及计算机可读存储介质。
本申请实施例的第一方面提供了一种定位方法,包括:基于当前 初始定位估计值,获取局部语义地图;基于局部语义地图,确定局部 平面;确定全局坐标系O1和局部平面的坐标系O2的转换矩阵Tp;基于 所述转换矩阵Tp,确定车辆定位。
在一些实施例中,所述基于初始位置,获取局部语义地图包括: 若当前初始定位估计值与上一次更新局部语义地图时输入的定位估 计值的差值不大于预设距离阈值时,获取上一次的局部语义地图;若 当前初始定位估计值与上一次更新局部地图时输入的定位估计值的 差值大于预设距离阈值时,更新所述局部语义地图。
在一些实施例中,所述基于局部语义地图,确定局部平面,包括: 基于语义标签获取位于道路平面上的地图元素;根据地图元素的三维 坐标信息,进行平面拟合,获得局部平面。
在一些实施例中,所述局部平面的坐标系r2的建立过程包括:获 取任意两个参与平面拟合的地图元素在局部平面上的两个投影点坐 标,并基于两个投影点坐标确定基向量l1;确定局部平面的法向量, 并将法向量确定为基向量l3;叉乘所述基向量l1和所述基向量l3,确 定基向量l2;将基向量{l1 l2 l3}单位化获得{n1 n2 n3}。
在一些实施例中,所述确定全局坐标系O1和所述局部平面的坐标 系O2的转换矩阵Tp,包括:确定{n1 n2 n3}在O2坐标系下的观测 {n1′ n2′ n3′};基于公式Tp *=argmin∑||Tpni-ni′||,确定转换矩 阵Tp,其中,i=1,2,3;其中,
在一些实施例中,所述基于所述转换矩阵Tp,确定车辆定位,包 括:当观测约束的个数不小于预设阈值时,基于所述转换矩阵Tp,将 平面约束加入到观测约束中,进行联合优化,确定车辆定位。
在一些实施例中,所述基于所述转换矩阵Tp,将平面约束加入到 观测约束中,进行联合优化,确定车辆定位,包括:基于方程 T*=argmin[∑e(mi,Mi)+f(T,Tp)],并结合平面约束 确定车辆定位,其中T*为车辆定位 结果的最优解,e为与T相关的观测误差函数,mi与Mi为匹配上的观 测元素,f为平面约束误差函数;Tpv为将T转换到O2坐标系下得到,Epv为将Tpv分解为六个自由度的欧拉角得到。
在一些实施例中,所述基于所述转换矩阵Tp,确定车辆定位,包 括:当观测约束的个数小于预设阈值时,将所述观测约束投影到所述 局部平面上,进而确定车辆定位。
在一些实施例中,所述将所述观测约束投影到所述局部平面上, 进而确定车辆定位,包括:基于方程 确定车辆精确定位,其中,Tpv为将T转换到O2坐标系下得到,e为与T相关的观测误差函数,mi与Mi为匹配上的观测元素,T*为车辆定位结果的最优解。
本申请实施例的第二方面提供了一种定位装置,包括:语义地图 获取单元,用于基于初始位置,获取局部语义地图;局部平面确定单 元,用于基于局部语义地图,确定局部平面;转换矩阵确定单元,用 于确定全局坐标系O1和局部平面的坐标系O2的转换矩阵Tp;定位确定 单元,用于基于所述转换矩阵Tp,将平面约束加入到观测约束中,进 行联合优化,确定车辆定位。
在一些实施例中,所述语义地图获取单元具体用于:若当前初始 定位估计值与上一次更新局部语义地图时输入的定位估计值的差值 不大于预设距离阈值时,获取上一次的局部语义地图;若当前初始定 位估计值与上一次更新局部地图时输入的定位估计值的差值大于预 设距离阈值时,更新所述局部语义地图。
在一些实施例中,所述局部平面确定单元具体用于:基于语义标 签获取位于道路平面上的地图元素;根据地图元素的三维坐标信息, 进行平面拟合,获得局部平面。
在一些实施例中,所述定位装置还包括坐标系O2建立单元,所述 坐标系O2建立单元具体用于:获取任意两个参与平面拟合的地图元素 在局部平面上的两个投影点坐标,并基于两个投影点坐标确定基向量 l1;确定局部平面的法向量,并将法向量确定为基向量l3;叉乘所述 基向量l1和所述基向量l3,确定基向量l2;将基向量{l1 l2 l3}单位 化获得{n1 n2n3}。
在一些实施例中,所述转换矩阵确定单元具体用于:确定 {n1 n2 n3}在O2坐标系下的观测{n1′ n2′ n3′};基于公式 Tp *=argmin∑||Tpni-ni′||,确定转换矩阵Tp,其中,i=1,2,3;其 中,
在一些实施例中,所述车辆定位单元具体用于:当观测约束的个 数不小于预设阈值时,基于所述转换矩阵Tp,将平面约束加入到观测 约束中,进行联合优化,确定车辆定位。
在一些实施例中,所述车辆定位单元具体用于:当观测约束的个 数不小于预设阈值时,基于方程T*=argmin[∑e(mi,Mi)+f(T,Tp)], 并结合平面约束条件确定车辆定位, 其中T*为车辆定位结果的最优解,e为与T相关的观测误差函数,mi与 Mi为匹配上的观测元素,f为平面约束误差函数;Tpv为将T转换到O2坐标系下得到,Epv为将Tpv分解为六个自由度的欧拉角得到。
在一些实施例中,所述车辆定位单元具体用于:当观测约束的个 数小于预设阈值时,将所述观测约束投影到所述局部平面上,进而确 定车辆定位。
在一些实施例中,所述车辆定位单元具体用于:当观测约束的个 数小于预设阈值时,基于方程确定车辆精确定位,其中,Tpv为将T转换到O2坐标系下得到,为与 T相关的观测误差函数,mi与Mi为匹配上的观测元素,T*为车辆定位 结果的最优解。
本申请实施例的第三方面提供了一种电子设备,包括:存储器以 及一个或多个处理器;其中,所述存储器与所述一个或多个处理器通 信连接,所述存储器中存储有可被所述一个或多个处理器执行的指令, 所述指令被所述一个或多个处理器执行时,所述电子设备用于实现如 前述各实施例所述的定位方法。
本申请实施例的第四方面提供了一种计算机可读存储介质,其上 存储有计算机可执行指令,当所述计算机可执行指令被计算装置执行 时,可用来实现如前述各实施例所述的定位方法。
本申请相比于现有技术,具有如下有益效果:
一、充分地利用地图语义,进一步提升定位精度以及定位平顺性 和鲁棒性;
二、在三维定位无法实现的情况下,采用对约束量需求更少的二 维定位方式,提高定位成功率。
附图说明
为了更清楚地说明本申请实施例的技术方案,下面将对实施例描 述中所需要使用的附图作简单的介绍。显而易见地,下面描述中的附 图仅仅是本申请的一些实施例,对于本领域的普通技术人员来讲,在 不付出创造性劳动的前提下,还可以根据这些附图将本申请应用于其 它类似情景。除非从语言环境中显而易见或另做说明,图中相同标号 代表相同结构和操作。
图1是根据本申请的一些实施例所示的定位方法示意图;
图2是根据本申请的一些实施例所示的局部平面确定方法示意 图;
图3是根据本申请的一些实施例所示的一种全局坐标系和局部 平面坐标系示意图;
图4是根据本申请的实施例所示的一种局部平面的坐标系O2的 建立过程流程图;
图5是根据本申请的一些实施例所示的一种转换矩阵确定方法 流程图;
图6是根据本申请的一些实施例所示的一种定位装置示意图;以 及
图7是根据本申请的一些实施例所示的电子设备示意图。
具体实施方式
在下面的详细描述中,通过示例阐述了本申请的许多具体细节, 以便提供对相关披露的透彻理解。然而,对于本领域的普通技术人员 来讲,本申请显而易见的可以在没有这些细节的情况下实施。应当理 解的是,本申请中使用“系统”、“装置”、“单元”和/或“模块”术 语,是用于区分在顺序排列中不同级别的不同部件、元件、部分或组 件的一种方法。然而,如果其他表达式可以实现相同的目的,这些术 语可以被其他表达式替换。
应当理解的是,当设备、单元或模块被称为“在……上”、“连接 到”或“耦合到”另一设备、单元或模块时,其可以直接在另一设备、 单元或模块上,连接或耦合到或与其他设备、单元或模块通信,或者 可以存在中间设备、单元或模块,除非上下文明确提示例外情形。例 如,本申请所使用的术语“和/或”包括一个或多个相关所列条目的 任何一个和所有组合。
本申请所用术语仅为了描述特定实施例,而非限制本申请范围。 如本申请说明书和权利要求书中所示,除非上下文明确提示例外情形, “一”、“一个”、“一种”和/或“该”等词并非特指单数,也可包括 复数。一般说来,术语“包括”与“包含”仅提示包括已明确标识的 特征、整体、步骤、操作、元素和/或组件,而该类表述并不构成一 个排它性的罗列,其他特征、整体、步骤、操作、元素和/或组件也 可以包含在内。
参看下面的说明以及附图,本申请的这些或其他特征和特点、操 作方法、结构的相关元素的功能、部分的结合以及制造的经济性可以 被更好地理解,其中说明和附图形成了说明书的一部分。然而,可以 清楚地理解,附图仅用作说明和描述的目的,并不意在限定本申请的 保护范围。可以理解的是,附图并非按比例绘制。
本申请中使用了多种结构图用来说明根据本申请的实施例的各 种变形。应当理解的是,前面或下面的结构并不是用来限定本申请。 本申请的保护范围以权利要求为准。
鉴于现有技术中,同时考虑到智能驾驶车辆在大部分场景下都行 驶于平面道路上,而地图元素的平面性也可以看作一种隐藏的语义信 息,因此本申请提出了一种基于局部平面假设的语义定位方法,以更 加充分地利用地图语义,进一步提升定位精度以及定位平顺性和鲁棒 性。
同时,由于平面假设的存在,本申请同时提出了降维定位策略, 在三维定位无法实现的情况下尝试对约束量需求更少的二维定位方 式,提高定位成功率。
图1根据本申请的一些实施例所示的定位方法示意图。所述定位 方法为基于局部语义平面假设的定位方法。
在102中,基于初始位置,获取局部语义地图。语义地图是对处 于“概念/语义空间”中的功能的几何体呈现,它由连接着的线段系 联,形成一个网络。在一些实施例中,无人驾驶车辆中存储的通常是 全局语义地图。例如,所述无人驾驶车辆存储的是一个园区、一个城 市的所有道路的语义地图,而局部语义地图仅是全局语义地图的一部 分,甚至,所述局部语义地图为能够实现车辆定位的最小的局部语义 地图。
在一些实施例中,获取局部语义地图的获取首先需要一个初始定 位估计值,以此为基础更新其附近的局部地图,该初始值可以来自外 部定位源,也可以来自内部的估计算法。具体地,若当前初始定位估 计值与上一次更新局部语义地图时输入的定位估计值的差值不大于 预设距离阈值时,获取上一次的局部语义地图;若当前初始定位估计 值与上一次更新局部地图时输入的定位估计值的差值大于预设距离 阈值时,更新所述局部语义地图。判断是否更新的原因是:如果局部 地图更新频率太高则会降低程序运行效率,因此需要判断是否需要进 行更新。逻辑关系如下式表示:
d(Testimate-Tlast)>Tthresh (1)
其中Testimate为当前初始定位计值,Tlast为上一次更新局部地图时输 入的定位估计值,d为距离度量函数,Tthresh为设定的距离阈值,即 本次是否更新局部地图取决于当前定位与上次更新时定位之间的距 离,如果距离过小,则直接获取上次的局部语义地图。更新局部语义 地图的过程即是从全局语义地图提取位于局部区域范围内的地图信 息,可以使用最近邻相关算法。
在104中,基于局部语义地图,确定局部平面。与102相对应地, 所述基于局部语义地图,确定局部平面也包括两种情形。当不需要更 新时,直接获取上次更新后计算的局部平面方程,以提高运行效率; 当需要更新局部语义地图时,基于重新获取的局部语义地图计算新的 局部平面方程。
在一些实施例中,所述局部平面的计算过程包括:1.选取点集; 2.拟合选取的点集。图2是根据本申请的一些实施例所示的局部平面 确定方法示意图。
在202中,基于语义标签获取位于道路平面上的地图元素。由于 地图具有语义信息,每一个地图元素都具有一个语义标签,由此可以 很方便地获取位于道路平面上的地图元素,例如车道线,人行道等。 地图元素的定义为:定义区域或形状的多边形、定义路线或路径的线 条,以及定义标记或图钉的点。
在一些实施例中,还可以对获取的地图元素进行筛选。例如,可 以使用类似于RANSAC等随机一致性算法对参与平面拟合但与拟合 出的平面距离过大的元素(外点)进行剔除。
在204中,根据地图元素的三维坐标信息,进行平面拟合,获得 局部平面。在一些实施例中,所述局部平面可以基于多个(至少3个) 地图元素对应的三维坐标信息,进行拟合获得,如公式(2)所示:
其中V表示三维空间平面参数矢量,p为平面地图元素三维坐标,上 式求得的最优解即为拟合平面参数。如前所述,获取局部平面后,可 以将平面性作为一种约束,用于精确定位。
在106中,确定全局坐标系O1和局部平面的坐标系O2的转换矩阵 Tp。
如图3所示,Tp的作用是通过运算将三维空间坐标转换到二维平 面坐标,以利用平面约束条件。计算Tp的关键是找到位于局部平面P上 的一个坐标系O2,并计算O1,O2之间的变换矩阵,即得到Tp。局部 平面的坐标系O2的建立过程见图4及其描述。
在108中,基于所述转换矩阵Tp,确定车辆定位。本申请设计了 一种基于平面约束进行定位的方法。值得说明的是,基于转换矩阵Tp, 确定车辆定位的方法可以有多种,本申请中采用的是最优的方式,但 并不用于限定本申请的保护范围,本申请的保护范围以权利要求为准。
图4给出了一种局部平面的坐标系O2的建立过程流程图。
在402中,获取任意两个参与平面拟合的地图元素在局部平面上 的两个投影点坐标,并基于两个投影点坐标确定基向量l1。如202中 所述,可以对获取的地图元素进行筛选。所述任意两个参与平面拟合 的地图元素是经过筛选后的地图元素中的任意两个。所述基向量可由 公式(3)确定:
其中k为计算中间标量,V为平面参数矢量,p为平面地图元素三 维坐标,pproj为p在平面上的投影。
在404中,确定局部平面的法向量,并将法向量确定为基向量l3。 l3为平面P的法相量,可直接由矢量V的前三位得到。
在406中,叉乘所述基向量l1和所述基向量l3,确定基向量l2。 由于l2同时于l1、l3正交,因此可由l1、l3的叉乘运算得出,如公式(4) 所示:
l2=l1×l3 (4)
在408中,将基向量{l1 l2 l3}单位化获得{n1 n2 n3}。
值得说明的是,图4仅是给出了一种确定局部平面的坐标系O2的 方法,其并不用于限定本申请,本领域的技术人员可以在不付出创造 性劳动的情况下,对其进行的任意变形,均在本申请的保护范围内, 本申请的保护范围以权利要求为准。
图5是根据本申请的一些实施例所示的一种转换矩阵确定方法 流程图。
在502中,确定{n1 n2 n3}在O2坐标系下的观测 {n1′ n2′ n3′}。由于其为一组基向量,则可以简单地如公式(5) 表示出来:
在504中,基于公式Tp *=argmin∑||Tpni-ni′||,确定转换矩 阵Tp,其中,i=1,2,3。
如108中所述,基于所述转换矩阵Tp,确定车辆定位。为了提高 定位成功率,本申请将车辆定位方式基于观测约束的个数,划分为两 种情形。
当观测约束的个数不小于预设阈值时,进行优化定位。所述优化 定位过程为:基于所述转换矩阵Tp,将平面约束加入到观测约束中, 进行联合优化,确定车辆定位。
当观测约束的个数不小于预设阈值时,进行降维定位。所述降维 定位过程为:将所述观测约束投影到所述局部平面上,进而确定车辆 定位。
具体地,所述优化定位过程为:
将平面约束加入观测约束进行联合优化,如公式(6)所示:
T*=argmin[∑e(mi,Mi)+f(T,Tp)] (6)
其中T*为车辆定位结果的最优解,e为与T相关的观测误差函数,mi与 Mi为匹配上的观测元素,f为平面约束误差函数。
为了实现平面约束,首先将T转换到O2坐标系下得到Tpv,再将其 分解为六个自由度的欧拉角表示Epv,则Epv位于局部平面P上的条件 为其中三个自由度为零,如公式(7)所示:
由上述过程可以实现车辆定位的优化计算,如果定位成功,则直 接输出定位结果,流程结束。同样,从理论上说,也可能存在定位失 败的情况,即有效观测约束的数量小于预设阈值时(针对公式7,预 设阈值为4,当采用不同的定位方法时,可以设定不同的预设阈值), 此时则采用降维定位的策略。
降维定位即利用局部平面信息将三维定位问题转化为二维定位 问题。具体地,所述降维定位过程如公式(8)所示:
其中,Tpv为将T转换到O2坐标系下得到,e为与T相关的观测误差函 数,mi与Mi为匹配上的观测元素,T*为车辆定位结果的最优解。
首先将优化O1坐标系下T的问题转化为优化O2坐标系下Tpv的问 题,由于坐标系发生了转换,观测地图元素Mi也需要转换为TpMi, 同时由于二维平面假设,还需要将之通过proj函数投影到局部平面P 上,构成二维误差函数。由此计算出的Tpv *同样位于p平面上,存在 于O2坐标系下,最后通过逆变换到O1坐标系下即可获得最终的三 维定位结果T*。由于计算Tpv *时使用的是二维误差函数,因此最少只 需要2个有效平面约束即可实现求解过程,在三维定位无法直接实现 的情况下也可以获得有效输出结果。
图6是根据本申请的一些实施例所示的一种定位装置示意图。图 6所示的定位装置用于执行如图1-5所示的定位方法。
如图6所示,所述定位装置600包括语义地图获取单元601、局 部平面确定单元602、转换矩阵确定模块603和定位确定单元604。
其中:
语义地图获取单元601用于基于初始位置,获取局部语义地图;
局部平面确定单元602用于基于局部语义地图,确定局部平面;
转换矩阵确定单元603用于确定全局坐标系O1和局部平面的坐 标系O2的转换矩阵Tp;
定位确定单元604用于基于所述转换矩阵Tp,将平面约束加入到 观测约束中,进行联合优化,确定车辆定位。
具体地,所述语义地图获取单元601用于:若当前初始定位估计 值与上一次更新局部语义地图时输入的定位估计值的差值不大于预 设距离阈值时,获取上一次的局部语义地图;若当前初始定位估计值 与上一次更新局部地图时输入的定位估计值的差值大于预设距离阈 值时,更新所述局部语义地图。
具体地,所述局部平面确定单元602用于基于语义标签获取位于 道路平面上的地图元素;根据地图元素的三维坐标信息,进行平面拟 合,获得局部平面。
具体地,所述转换矩阵确定单元603用于确定{n1 n2 n3}在O2坐标系下的观测{n1′n2′ n3′};基于公式Tp *=argmin∑||Tpni- ni′||,确定转换矩阵Tp,其中i=1,2,3,
所述{n1 n2 n3}的确定过程如图4中所述,在此不做展开。
具体地,定位确定单元604用于:当观测约束的个数不小于预设 阈值时,基于所述转换矩阵Tp,将平面约束加入到观测约束中,进行 联合优化,确定车辆定位;当观测约束的个数小于预设阈值时,将所 述观测约束投影到所述局部平面上,进而确定车辆定位。所述优化定 位和降维定位的方法如前文所述,在此不做展开。
图7是适于用来实现根据本申请实施方式的电子设备的结构示 意图。
如图7所示,电子设备700包括中央处理单元(CPU)701,其 可以根据存储在只读存储器(ROM)702中的程序或者从存储部分 708加载到随机访问存储器(RAM)703中的程序而执行上述图1-5 所示的实施方式中的各种处理。在RAM703中,还存储有电子设备 700操作所需的各种程序和数据。CPU701、ROM702以及RAM703 通过总线704彼此相连。输入/输出(I/O)接口705也连接至总线704。
以下部件连接至I/O接口705:包括键盘、鼠标等的输入部分706; 包括诸如阴极射线管(CRT)、液晶显示器(LCD)等以及扬声器等 的输出部分707;包括硬盘等的存储部分708;以及包括诸如LAN卡、 调制解调器等的网络接口卡的通信部分709。通信部分709经由诸如 因特网的网络执行通信处理。驱动器710也根据需要连接至I/O接口 705。可拆卸介质711,诸如磁盘、光盘、磁光盘、半导体存储器等 等,根据需要安装在驱动器710上,以便于从其上读出的计算机程序 根据需要被安装入存储部分708。
特别地,根据本申请的实施方式,上文参考图1-5描述的方法可 以被实现为计算机软件程序。例如,本申请的实施方式包括一种计算 机程序产品,其包括有形地包含在及其可读介质上的计算机程序,所 述计算机程序包含用于执行图1-5的方法的程序代码。在这样的实施 方式中,该计算机程序可以通过通信部分709从网络上被下载和安装, 和/或从可拆卸介质711被安装。
附图中的流程图和框图,图示了按照本申请各种实施方式的装置、 方法和计算机程序产品的可能实现的体系架构、功能和操作。在这点 上,路程图或框图中的每个方框可以代表一个模块、程序段或代码的 一部分,所述模块、程序段或代码的一部分包含一个或多个用于实现 规定的逻辑功能的可执行指令。也应当注意,在有些作为替换的实现 中,方框中所标注的功能也可以以不同于附图中所标注的顺序发生。 例如,两个接连地表示的方框实际上可以基本并行地执行,它们有时 也可以按相反的顺序执行,这依所涉及的功能而定。也要注意的是, 框图和/或流程图中的每个方框、以及框图和/或流程图中的方框的组合,可以用执行规定的功能或操作的专用的基于硬件的系统来实现, 或者可以用专用硬件与计算机指令的组合来实现。
描述于本申请实施方式中所涉及到的单元或模块可以通过软件 的方式实现,也可以通过硬件的方式来实现。所描述的单元或模块也 可以设置在处理器中,这些单元或模块的名称在某种情况下并不构成 对该单元或模块本身的限定。
作为另一方面,本申请还提供了一种计算机可读存储介质,该计 算机可读存储介质可以是上述实施方式中所述装置中所包含的计算 机可读存储介质;也可以是单独存在,未装配入设备中的计算机可读 存储介质。计算机可读存储介质存储有一个或者一个以上程序,所述 程序被一个或者一个以上的处理器用来执行描述于本申请的方法。
综上所述,本申请提出了一种定位方法、装置、电子设备及其计 算机可读存储介质。本申请实施例通过将平面约束与观测约束结合, 提升定位精度以及定位平顺性和鲁棒性;并在观测约束个数小于预设 阈值时,将三维定位问题转化为二位定位问题,进行降维定位。
应当理解的是,本申请的上述具体实施方式仅仅用于示例性说明 或解释本申请的原理,而不构成对本申请的限制。因此,在不偏离本 申请的精神和范围的情况下所做的任何修改、等同替换、改进等,均 应包含在本申请的保护范围之内。此外,本申请所附权利要求旨在涵 盖落入所附权利要求范围和边界、或者这种范围和边界的等同形式内 的全部变化和修改例。
Claims (10)
1.一种定位方法,其特征在于,包括:
基于当前初始定位估计值,获取局部语义地图;
基于局部语义地图,确定局部平面;
确定全局坐标系O1和局部平面的坐标系O2的转换矩阵Tp;
基于所述转换矩阵Tp,确定车辆定位。
2.如权利要求1所述的方法,其特征在于,所述基于初始位置,获取局部语义地图包括:
若当前初始定位估计值与上一次更新局部语义地图时输入的定位估计值的差值不大于预设距离阈值时,获取上一次的局部语义地图;
若当前初始定位估计值与上一次更新局部地图时输入的定位估计值的差值大于预设距离阈值时,更新所述局部语义地图。
3.如权利要求1所述的方法,其特征在于,所述基于局部语义地图,确定局部平面,包括:
基于语义标签获取位于道路平面上的地图元素;
根据地图元素的三维坐标信息,进行平面拟合,获得局部平面。
4.如权利要求1所述的方法,其特征在于,所述局部平面的坐标系O2的建立过程包括:
获取任意两个参与平面拟合的地图元素在局部平面上的两个投影点坐标,并基于两个投影点坐标确定基向量l1;
确定局部平面的法向量,并将法向量确定为基向量l3;
叉乘所述基向量l1和所述基向量l3,确定基向量l2;
将基向量{l1 l2 l3}单位化获得{n1 n2 n3}。
6.如权利要求1所述的方法,其特征在于,所述基于所述转换矩阵Tp,确定车辆定位,包括:
当观测约束的个数不小于预设阈值时,基于所述转换矩阵Tp,将平面约束加入到观测约束中,进行联合优化,确定车辆定位。
8.如权利要求1所述的方法,其特征在于,所述基于所述转换矩阵Tp,确定车辆定位,包括:
当观测约束的个数小于预设阈值时,将所述观测约束投影到所述局部平面上,进而确定车辆定位。
10.一种定位装置,其特征在于,包括:
语义地图获取单元,用于基于初始位置,获取局部语义地图;
局部平面确定单元,用于基于局部语义地图,确定局部平面;
转换矩阵确定单元,用于确定全局坐标系O1和局部平面的坐标系O2的转换矩阵Tp;
定位确定单元,用于基于所述转换矩阵Tp,将平面约束加入到观测约束中,进行联合优化,确定车辆定位。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010397339.5A CN111707275B (zh) | 2020-05-12 | 2020-05-12 | 一种定位方法、装置、电子设备及计算机可读存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010397339.5A CN111707275B (zh) | 2020-05-12 | 2020-05-12 | 一种定位方法、装置、电子设备及计算机可读存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111707275A true CN111707275A (zh) | 2020-09-25 |
CN111707275B CN111707275B (zh) | 2022-04-29 |
Family
ID=72537074
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010397339.5A Active CN111707275B (zh) | 2020-05-12 | 2020-05-12 | 一种定位方法、装置、电子设备及计算机可读存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111707275B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112180413A (zh) * | 2020-09-30 | 2021-01-05 | 驭势科技(北京)有限公司 | 定位方法、装置、设备和存储介质 |
CN112284402A (zh) * | 2020-10-15 | 2021-01-29 | 广州小鹏自动驾驶科技有限公司 | 一种车辆定位的方法和装置 |
CN112767477A (zh) * | 2020-12-31 | 2021-05-07 | 北京纵目安驰智能科技有限公司 | 一种定位方法、装置、存储介质及电子设备 |
WO2024004265A1 (ja) * | 2022-06-29 | 2024-01-04 | 三菱重工業株式会社 | 自己位置推定装置、自己位置推定方法、およびプログラム |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103810286A (zh) * | 2014-02-25 | 2014-05-21 | 合肥亿图网络科技有限公司 | 一种用于二维地图与三维地图匹配的坐标点定位方法 |
CN106052697A (zh) * | 2016-05-24 | 2016-10-26 | 百度在线网络技术(北京)有限公司 | 无人车、无人车定位方法、装置和系统 |
CN107438752A (zh) * | 2016-12-23 | 2017-12-05 | 深圳前海达闼云端智能科技有限公司 | 定位方法、终端和服务器 |
CN109272554A (zh) * | 2018-09-18 | 2019-01-25 | 北京云迹科技有限公司 | 一种识别目标的坐标系定位和语义地图构建的方法及系统 |
CN109815847A (zh) * | 2018-12-30 | 2019-05-28 | 中国电子科技集团公司信息科学研究院 | 一种基于语义约束的视觉slam方法 |
CN110110021A (zh) * | 2019-03-22 | 2019-08-09 | 纵目科技(上海)股份有限公司 | 一种高精度局部地图间的坐标转换方法、终端和存储介质 |
CN110148170A (zh) * | 2018-08-31 | 2019-08-20 | 北京初速度科技有限公司 | 一种应用于车辆定位的定位初始化方法及车载终端 |
CN110706279A (zh) * | 2019-09-27 | 2020-01-17 | 清华大学 | 基于全局地图与多传感器信息融合的全程位姿估计方法 |
JP2020042366A (ja) * | 2018-09-06 | 2020-03-19 | Tis株式会社 | 自律移動装置、サーバ装置、プログラム、および情報処理方法 |
-
2020
- 2020-05-12 CN CN202010397339.5A patent/CN111707275B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103810286A (zh) * | 2014-02-25 | 2014-05-21 | 合肥亿图网络科技有限公司 | 一种用于二维地图与三维地图匹配的坐标点定位方法 |
CN106052697A (zh) * | 2016-05-24 | 2016-10-26 | 百度在线网络技术(北京)有限公司 | 无人车、无人车定位方法、装置和系统 |
CN107438752A (zh) * | 2016-12-23 | 2017-12-05 | 深圳前海达闼云端智能科技有限公司 | 定位方法、终端和服务器 |
CN110148170A (zh) * | 2018-08-31 | 2019-08-20 | 北京初速度科技有限公司 | 一种应用于车辆定位的定位初始化方法及车载终端 |
JP2020042366A (ja) * | 2018-09-06 | 2020-03-19 | Tis株式会社 | 自律移動装置、サーバ装置、プログラム、および情報処理方法 |
CN109272554A (zh) * | 2018-09-18 | 2019-01-25 | 北京云迹科技有限公司 | 一种识别目标的坐标系定位和语义地图构建的方法及系统 |
CN109815847A (zh) * | 2018-12-30 | 2019-05-28 | 中国电子科技集团公司信息科学研究院 | 一种基于语义约束的视觉slam方法 |
CN110110021A (zh) * | 2019-03-22 | 2019-08-09 | 纵目科技(上海)股份有限公司 | 一种高精度局部地图间的坐标转换方法、终端和存储介质 |
CN110706279A (zh) * | 2019-09-27 | 2020-01-17 | 清华大学 | 基于全局地图与多传感器信息融合的全程位姿估计方法 |
Non-Patent Citations (2)
Title |
---|
LIU XIAO,ZHANG LEI,QIN SHENGRAN ETC.: "Optimized LOAM Using Ground Plane Constraints and SegMatch-Based Loop Detection", 《SENSORS》 * |
焦雨琪,牛蕊,夏志: "基于坐标变换的交互多模型车载定位研究", 《信息技术与网络安全》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112180413A (zh) * | 2020-09-30 | 2021-01-05 | 驭势科技(北京)有限公司 | 定位方法、装置、设备和存储介质 |
CN112284402A (zh) * | 2020-10-15 | 2021-01-29 | 广州小鹏自动驾驶科技有限公司 | 一种车辆定位的方法和装置 |
CN112284402B (zh) * | 2020-10-15 | 2021-12-07 | 广州小鹏自动驾驶科技有限公司 | 一种车辆定位的方法和装置 |
CN112767477A (zh) * | 2020-12-31 | 2021-05-07 | 北京纵目安驰智能科技有限公司 | 一种定位方法、装置、存储介质及电子设备 |
WO2024004265A1 (ja) * | 2022-06-29 | 2024-01-04 | 三菱重工業株式会社 | 自己位置推定装置、自己位置推定方法、およびプログラム |
Also Published As
Publication number | Publication date |
---|---|
CN111707275B (zh) | 2022-04-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111707275B (zh) | 一种定位方法、装置、电子设备及计算机可读存储介质 | |
US10627241B2 (en) | Map-centric map matching method and apparatus | |
CN109285188B (zh) | 用于生成目标物体的位置信息的方法和装置 | |
CN108279016B (zh) | Had地图的平滑处理方法和装置、导航系统及自动驾驶系统 | |
WO2021254019A1 (zh) | 协同构建点云地图的方法、设备和系统 | |
CN113793370B (zh) | 三维点云配准方法、装置、电子设备及可读介质 | |
JP2008020225A (ja) | 自己位置推定プログラム、自己位置推定方法および自己位置推定装置 | |
CN113298910A (zh) | 生成交通标志线地图的方法、设备和存储介质 | |
US11514588B1 (en) | Object localization for mapping applications using geometric computer vision techniques | |
CN113191342A (zh) | 车道定位方法及电子设备 | |
CN106556397A (zh) | 一种gnss地图匹配方法和装置 | |
EP3859279A1 (en) | Method and apparatus for localizing a data set based upon synthetic image registration | |
CN111860084B (zh) | 图像特征的匹配、定位方法及装置、定位系统 | |
CN115239899B (zh) | 位姿图生成方法、高精地图生成方法和装置 | |
CN110363847B (zh) | 一种基于点云数据的地图模型构建方法和装置 | |
CN116468761A (zh) | 基于概率分布距离特征描述的配准方法、设备及存储介质 | |
CN115937479A (zh) | 导航引导面处理方法、装置、电子设备及计算机程序产品 | |
CN116312054A (zh) | 一种水上船舶交通流复杂度计算方法、装置、设备和介质 | |
CN115619954A (zh) | 稀疏语义地图的构建方法、装置、设备及存储介质 | |
CN111383337B (zh) | 用于识别对象的方法和装置 | |
CN114492573A (zh) | 一种基于松弛迭代的语义特征的地图匹配方法及装置 | |
CN110399892B (zh) | 环境特征提取方法和装置 | |
CN110389349B (zh) | 定位方法和装置 | |
CN111833395A (zh) | 一种基于神经网络模型的测向体制单目标定位方法和装置 | |
CN111765892A (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 |