基于高精度定位定姿数据超低时延地图车道匹配算法、软件制造技术

本申请提供了一种基于高精度定位定姿数据超低时延地图车道匹配算法、软件，其中，空间索引的构建方法包括：获取车道宽度和用于表征车道位置走向的车道点迹坐标序列中的各相邻坐标；根据车道宽度和相邻坐标，确定可能与车道匹配的矩形区域；确定用于包围矩形区域的、长宽边分别与经纬度坐标系相平行的外接矩形，并获取外接矩形的其中一组对角线的顶点坐标数据；基于顶点坐标数据确定目标地址；根据顶点坐标数据和目标地址生成索引项添加至空间索引；循环执行上述各步骤，直至遍历完成车道点迹坐标序列中的所有相邻坐标，完成空间索引的构建，可以至少用以解决相关技术的方案中无法满足对于实时性要求较高、更新计算频率较快的应用场景的技术问题。的应用场景的技术问题。的应用场景的技术问题。

【技术实现步骤摘要】
基于高精度定位定姿数据超低时延地图车道匹配算法、软件


[0001]本申请涉及信息
，尤其涉及一种基于高精度定位定姿数据超低时延地图车道匹配算法、软件。

技术介绍

[0002]伴随着车路协同技术的快速发展，应用于智能网联车辆的自动驾驶技术也被广泛应用于日常交通的方方面面。其中，在自动驾驶技术的应用场景中，往往需要获取当前车辆所在车道等信息，并且我们希望对应的应用软件的底层算法能够高效、准确地获取这些信息。这些信息比如可以是车道方位信息、车道宽度信息、车道限速信息、基于该车道是否允许直行的信息、基于该车道是否允许左转的信息等等。
[0003]相关技术中，一般通过表征车道位置走向的车道点迹坐标序列描述车道的方位，如图1所示。常见的实现自车所在车道的匹配定位的方法大致包括：循环遍历MAP消息中的每个节点，一般一个节点对应一个路口；对每个当前所访问的节点，循环遍历该节点下的每一条道路；对每一条道路，循环遍历其下的每一条车道；对每一个当前考察的车道，循环遍历用于描述车道位置走向的车道点迹坐标序列；对车道点迹坐标序列中每对相邻的两点坐标，计算当前车辆的坐标到相邻的两点坐标的连线的垂线距离，并判断该垂线距离是否小于预设距离，若所述垂线距离小于指定预设距离，且车辆行驶方向与车道方向夹角小于或者等于预设角度，同时垂足落在当前考察的两点之间，则认为当前车辆与此两点所在的车道相匹配。
[0004]然而，专利技术人发现相关技术的方案具有直观、易于实现的特点，但是也至少存在如下技术问题：
[0005]多重循环遍历的方式决定了相关技术的方案的计算复杂度较高。理论上，假设表征车道位置走向的车道点迹坐标序列共包括N个序列点，N为大于或者等于1的整数，那么每进行一次车道匹配，平均要进行N/2次车辆的坐标到相邻两个坐标点的连线的垂线距离的计算才能找到匹配的车道，即计算复杂度为O(N)。这样的计算复杂度对于实时性要求不高的低速自动驾驶应用场景或者交通环境较简单的需求来说勉强可以满足，但无法满足对于实时性要求较高、更新计算频率较快的应用场景。

技术实现思路

[0006]本申请的一个目的是提供一种基于高精度定位定姿数据超低时延地图车道匹配算法、软件，至少用以解决相关技术的方案中无法满足对于实时性要求较高、更新计算频率较快的应用场景的技术问题。
[0007]为实现上述目的，本申请的一些实施例提供了一种空间索引的构建方法，所述方法包括：获取车道宽度和用于表征车道位置走向的车道点迹坐标序列中的各相邻坐标；根据所述车道宽度和所述相邻坐标，确定可能与车道匹配的矩形区域；确定用于包围所述矩形区域的、长宽边分别与经纬度坐标系相平行的外接矩形，并获取所述外接矩形的其中一
组对角线的顶点坐标数据；基于所述顶点坐标数据确定目标地址；根据所述顶点坐标数据和所述目标地址生成索引项添加至空间索引；循环执行上述各步骤，直至遍历完成所述车道点迹坐标序列中的所有相邻坐标，完成所述空间索引的构建。
[0008]本申请的一些实施例还提供了一种车道匹配方法，所述方法应用于根据如上所述的空间索引的构建方法构建得到的空间索引，所述方法包括：获取车辆当前的定位数据；从所述空间索引检索出包括所述定位数据的三元组的集合；遍历所述三元组以进行验证；根据验证结果进行车道匹配。
[0009]本申请的一些实施例还提供了一种电子设备，所述设备包括：一个或多个处理器；以及存储有计算机程序指令的存储器，所述计算机程序指令在被执行时使所述处理器执行如上任意一项所述的方法。
[0010]本申请的一些实施例还提供了一种计算机可读介质，其上存储有计算机程序指令，所述计算机程序指令可被处理器执行以实现所述的方法。
[0011]相较于现有技术，本申请实施例提供的方案中，本申请实施例提供的空间索引的构建方法，首先获取车道宽度和用于表征车道位置走向的车道点迹坐标序列中的各相邻坐标；然后根据所述车道宽度和所述相邻坐标，确定可能与车道匹配的矩形区域；之后进一步确定用于包围所述矩形区域的、长宽边分别与经纬度坐标系相平行的外接矩形，并获取所述外接矩形的其中一组对角线的顶点坐标数据；基于所述顶点坐标数据确定目标地址；根据所述顶点坐标数据和所述目标地址生成索引项添加至空间索引，以根据构建好的空间索引进行车道匹配。这样，当需要进行车道匹配时，仅需要使用实时获取到的车辆定位数据在所述空间索引进行检索即可。这样，使用所述空间索引进行检索的速度很快，以所述空间索引算法为Rtree索引结构为例，其检索的平均计算复杂度为O(logN)，可以实现快速匹配车辆所在车道。
附图说明
[0012]图1为根据相关技术提供的一种车道点迹坐标序列的示例性示意图；
[0013]图2为本申请实施例提供的一种空间索引的构建方法的示例性流程图；
[0014]图3为本申请实施例提供的一种矩形区域的示例性示意图；
[0015]图4为本申请实施例提供的一种外接矩形的示例性示意图；
[0016]图5为本申请实施例提供的一种车道匹配方法的示例性流程图；
[0017]图6为本申请实施例提供的一种电子设备的示例性结构图。
具体实施方式
[0018]为使本申请实施例的目的、技术方案和优点更加清楚，下面将结合本申请实施例中的附图，对本申请实施例中的技术方案进行清楚、完整的描述，显然，所描述的实施例是本申请一部分实施例，而不是全部的实施例。基于本申请中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本申请保护的范围。
[0019]在本文中使用以下术语。
[0020]地图消息，MAP消息。
[0021]全球导航卫星系统，英文全称Global Navigation Satellite System，简称
“
GNSS”，又称全球卫星导航系统，是能在地球表面或近地空间的任何地点为用户提供全天候的3维坐标和速度以及时间信息的空基无线电导航定位系统。
[0022]全球定位系统，英文全称Global Positioning System，简称“GPS”，是一种以人造地球卫星为基础的高精度无线电导航的定位系统。
[0023]空间索引算法，是一种将空间数据组织成索引结构以便快速检索的算法。其基本思想是将空间数据划分为若干个空间单元，将数据存储在相应的单元内，并建立索引来加速检索。空间单元的划分方式和索引结构的设计是空间索引算法的核心内容。
[0024]实施例一
[0025]本申请实施例提供了一种空间索引的构建方法，如图2所示，所述方法可以包括如下步骤：
[0026]步骤S101，获取车道宽度和用于表征车道位置走向的车道点迹坐标序列中的各相邻坐标；
[0027]步骤S102，根据所述车道宽度和所述相邻坐标，确定可能与车道匹配的矩形区域；
[0028]步骤S103，确定用于包围所述矩形区域的、长宽边分别与经纬度坐标系相平行的外接矩形，并获取所述外接矩形的其中一组对本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种空间索引的构建方法，其特征在于，所述方法包括：获取车道宽度和用于表征车道位置走向的车道点迹坐标序列中的各相邻坐标；根据所述车道宽度和所述相邻坐标，确定可能与车道匹配的矩形区域；确定用于包围所述矩形区域的、长宽边分别与经纬度坐标系相平行的外接矩形，并获取所述外接矩形的其中一组对角线的顶点坐标数据；基于所述顶点坐标数据确定目标地址；根据所述顶点坐标数据和所述目标地址生成索引项添加至空间索引；循环执行上述各步骤，直至遍历完成所述车道点迹坐标序列中的所有相邻坐标，完成所述空间索引的构建。2.根据权利要求1所述的方法，其特征在于，所述获取车道宽度和用于表征车道位置走向的车道点迹坐标序列中的各相邻坐标，具体为：于MAP消息更新时，根据所述MAP消息获取车道宽度和用于表征车道位置走向的车道点迹坐标序列中的各相邻坐标；对应地，所述用于表征车道位置走向的车道点迹坐标序列中的各相邻坐标的确定方法包括：遍历所述MAP消息中的和每一个路口分别对应的每一个节点；对于每一个节点,遍历其下的每一条道路；对于每一条道路，遍历其下的每一条车道；对于每一条车道，遍历用于表征车道位置走向的车道点迹坐标序列，得到所述相邻坐标。3.根据权利要求1所述的方法，其特征在于，所述相邻坐标分别为第一坐标和第二坐标；所述根据所述车道宽度和所述相邻坐标，确定可能与车道匹配的矩形区域包括：将所述第一坐标和第二坐标转换为直角坐标并构造向量，归一化所述向量至长度为1；将进行归一化处理后的向量以所述第一坐标为起点旋转90
°
得到目标向量；根据所述车道宽度和所述目标向量，确定可能与车道匹配的矩形区域的4点坐标，以根据所述4点坐标确定所述矩形区域。4.根据权利要求3所述的方法，其特征在于，所述将进行归一化处理后的向量以所述第一坐标为起点旋转90
°
得到目标向量具体为：将进行归一化处理后的向量以所述第一坐标为起点逆向旋转90
°
得到目标向量；对应的，所述根据所述车道宽度和所述目标向量，确定可能与车道匹配的矩形区域的4点坐标，以根据所述4点坐标确定所述矩形区域包括：通过如下公式确定所述4点坐标：通过如下公式确定所述4点坐标：通过如下公式确...

【专利技术属性】
技术研发人员：闫学亮，王卓，左练鹏，黄亮，
申请(专利权)人：云控智行上海汽车科技有限公司，
类型：发明
国别省市：