CN104062671B - 曲率约束的gnss浮动车地图匹配方法及装置 - Google Patents

Abstract

本发明公开了一种曲率约束的GNSS浮动车地图匹配方法及装置。本发明方法通过计算GNSS轨迹点序列中两个相邻轨迹点之间的方位角，估算出真实轨迹在两个轨迹点之间的曲率积分值，根据此曲率积分值与此两点相对应的候选路径的曲率积分值作比较约束匹配过程，在道路网中得到含此约束的具有最大相似度的匹配结果。相比于现有浮动车地图匹配方法中采用的匹配特征，本发明方法采用曲率积分值可以较好地刻画浮动车轨迹曲线弯曲程度，能够根据GNSS浮动车两个轨迹点之间的累积弯曲程度，在道路网络中搜索出以该特征值具有最大相似作为约束条件的最佳匹配结果，在采用了这种曲率的约束条件后可以提高GNSS浮动车轨迹数据的地图匹配正确率，提高匹配效率。

Description

曲率约束的GNSS浮动车地图匹配方法及装置

技术领域

本发明属于GNSS导航定位和智能交通领域，具体涉及一种曲率约束的GNSS浮动车地图匹配方法、以及一种曲率约束的GNSS浮动车地图匹配装置。

背景技术

当前智能交通领域中，GNSS浮动车已成为一种交通、出行信息采集的重要手段。随着互联网大数据时代的到来，面向交通的地理信息服务(GeographicInformationServices)需求也明显增强，关于交通、出行等信息也是其所供应地理信息数据的重要组成之一。而浮动车地图匹配方法则是实现交通及出行等信息数据挖掘的关键技术。

目前，城市道路交通部门通过在浮动车上配置GNSS(如GPS、GLONASS、北斗二代等卫星导航系统)定位设备获得浮动车的地理坐标位置，而这些坐标位置数据在时间序列上形成GNSS轨迹数据。由于GNSS定位的误差及电子地图数据中道路数据的误差，导致这样通过GNSS定位设备得到的浮动车轨迹数据并不一定是定位在道路网络上的。另一方面，由于交通部门用来做浮动车的车辆有很多(比如出租车，公交车等)，如果按通常的GNSS一秒定一次位的频率，浮动车GNSS数据量将会是巨大的，因而浮动车的GNSS定位数据的采样间隔相对较长一般为40-100秒，导致浮动车的GNSS轨迹数据并不是一个真实的浮动车行驶轨迹。所谓地图匹配就是通过GNSS轨迹数据所包含的位置信息，将GNSS轨迹点逐一匹配到浮动车辆所在的道路路段上，将GNSS轨迹数据恢复为浮动车在道路网络中的真实行驶路径。

目前浮动车地图匹配方法有很多种，大多数都是通过位置、速度、方向等信息以几何距离、角度作为度量特征，在单个轨迹点匹配时依靠轨迹点到路段的距离特征来度量候选路段的匹配可能性，在前后轨迹点关联匹配时，主要依靠前后点之间的距离特征来度量前后轨迹点的关联路段对之间的匹配可能性。目前的匹配方法所用的特征并不能完全利用已有的位置信息来反映浮动车轨迹的一些整体几何特征，并未利用能够反映轨迹曲线的累积弯曲程度的特征来实施匹配。

平面曲线曲率为曲线上一点处的切向量变化率。平面曲线上两点之间的曲率积分为该曲线在此两点之间的切向量的累积变化量，这种累积变化量是曲线在两点之间曲线段的一种几何特征，表征了该曲线段的弯曲程度。真实的浮动车轨迹实际上是地图平面上的一条曲线，而GNSS轨迹数据是对该曲线经过GNSS采样得到的。本发明主要是根据轨迹曲线的曲率积分值来约束GNSS轨迹数据在道路网络中的地图匹配。

发明内容

针对现有技术中存在的上述技术问题，本发明提出了一种曲率约束的GNSS浮动车地图匹配方法，通过估计真实GNSS浮动车轨迹曲线上在相邻两GNSS轨迹点处的曲率积分值，并计算此两轨迹点对应于道路网络中可能的候选关联匹配路径的曲率积分值，以此两种曲率积分值之间的相似程度为约束条件，来实现GNSS浮动车轨迹数据的地图匹配。

为了实现上述目的，本发明采用如下技术方案：

曲率约束的GNSS浮动车地图匹配方法，包括如下步骤：

S1、为每辆浮动车构建一个按照该浮动车轨迹点时间顺序排列的GNSS轨迹点序列，估计真实GNSS浮动车轨迹曲线在相邻两个GNSS轨迹点处的曲率积分值；

S2、计算相邻两个GNSS轨迹点对应于道路网络中的候选关联匹配路径的曲率积分值；

S3、计算S1和S2中得到的两种曲率积分值之间的匹配度；

S4、根据S3中得到的每个匹配度，在所有候选路段中计算出路网中与GNSS轨迹对应的最优匹配路径。

进一步，上述步骤S1中，曲率积分值的计算包括如下两个步骤：

S11、计算相邻轨迹点连接线段的方位角：

定义GNSS轨迹点序列为P[0]、P[1]…P[n]，相邻轨迹点分别为P[i]和P[i+1]，P[i]与P[i+1]之间的连接线段为P[i]P[i+1]，P[i]P[i+1]的方位角为Δx＝P[i+1].x-P[i].x，Δy＝P[i+1].y-P[i].y；其中，1≤i≤n-1；

如果Δx≥0，则如果Δx<0，则

通过S11得到相邻轨迹点连接线段的n-1个方位角；

S12、估算相邻轨迹点之间的真实GNSS浮动车轨迹曲线的曲率积分值：

将P[i-1]到P[i]的线段视为轨迹曲线在P[i]处的切向量，将P[i+1]到P[i+2]的线段视为轨迹曲线在P[i+1]处的切向量；

根据S11得到的线段P[i-1]P[i]的方位角和线段P[i+1]P[i+2]的方位角计算如果取值在(-π,π]之间，则曲率积分值为如果取值小于-π，则曲率积分值为如果取值大于π，则曲率积分值为

进一步，上述步骤S2中，曲率积分值的计算包括如下步骤：

道路网络数据包括道路网络的弧段和节点数据，弧段数据中包含道路弧段的属性数据、几何形状点数据、起始节点和终止节点信息，节点数据中包含与该节点连接的弧段信息；

S21、对道路网络数据建立格网索引

计算道路网络数据的最小边界矩形R，将矩形R的长边分成k段，短边分成l段，则矩形R分割成k*l个矩形单元；道路网络数据按照划分好的矩形单元存放，将道路网络的弧段数据和节点数据分边存放到其所在的矩形单元中，矩形单元边界相交的弧段或者节点在边界所属的矩形单元中存放；

S22、遍历道路网络中的所有道路弧段，计算每条道路弧段上从起始端点到终止端点之间的曲率积分值；

S23、采用dijkstra算法，计算道路网络中任意两个节点的最短路径。

进一步，上述步骤S22中，曲率积分值的计算过程如下：

假设一条道路弧段由形状点序列R[0]、R[1]…R[n]组成，其中，R[0]为道路弧段的起始端点，即道路弧段的关联起始节点，R[n]为道路弧段的终止端点，即道路弧段的关联终止节点，定义R[i-1]、R[i]、R[i+1]为形状点序列中的点，其中，1≤i≤n-1；

S221、计算相邻形状点R[i]、R[i+1]所组成线段R[i]R[i+1]的方位角以及R[i-1]、R[i]所组成线段R[i-1]R[i]的方位角

S222、计算

如果取值在(-π,π]之间，则值不变；如果取值小于-π，则π；如果取值大于π，则

S223、从i＝1开始遍历至i＝n-1，将所有求得的值累加，累加得到的结果即为该道路弧段的曲率积分值。

进一步，上述步骤S3中，匹配度的计算包括单点匹配度的计算和关联匹配度的计算；

S31、单点匹配度的计算

S311、计算轨迹点的单点特征

判断轨迹点所属的矩形单元，计算与该矩形单元具有8邻域相邻的8个矩形单元，计算轨迹点到此9个矩形单元内的所有弧段之间距离：

假设弧段a由Pnt[0]、Pnt[1]…Pnt[n]个形状点组成，Pnt[i]Pnt[i+1]为其中一对相邻形状点形成的线段，则求轨迹点到该线段的垂足；

如果垂足在线段内，则轨迹点到该线段距离为轨迹点到该垂足P的直线距离，如果垂足不在线段内，则距离为轨迹点到离垂足较近的一侧端点距离，并将该端点设为垂足P；

遍历弧段a中所有相邻形状点形成的线段，并比较轨迹点到线段的距离，得到距离值最小的一个相邻形状点线段，并将其垂足作为轨迹点到此弧段的垂足，轨迹点到此垂足的距离，即为轨迹点到此弧段的距离；

S312、计算轨迹点到弧段的垂足沿弧段到其终止节点的距离L

假设S311中得到的轨迹点到弧段a的垂足P在线段Pnt[i]Pnt[i+1]上，计算P到Pnt[i+1]的距离L1，然后再累加从Pnt[i+1]到Pnt[n]之间所有相邻形状点线段的长度L2，最后将L的值赋为L1+L2；

S313、根据一个预定距离值d0，将步骤S311中得到的轨迹点到弧段距离小于d0的道路弧段放入一个备选弧集S中；弧段的属性中包含轨迹点到此弧段的距离、垂足和垂足到弧段终点的距离；

S314、单点匹配度M1的计算

根据轨迹点到弧段的距离值da用线性分段函数计算备选弧段集S中所有弧段a的M1值，

当0≤da<10时，M1＝5-0.1*da；

当10≤da<35时，M1＝3.8-0.12*da；

当35≤da<50时，M1＝4.7-0.07*da；

当50≤da≤100时，M1＝2-0.02*da；

对于轨迹点到弧段的距离值da大于100的弧段不予考虑；

S32、关联匹配度的计算

S321、计算前后相邻轨迹点之间的关联特征

根据前后两轨迹点的位置坐标计算两点之间直线距离d1；根据步骤S1中的结果得到前后两轨迹点之间的轨迹曲线曲率积分值c1；

S322、根据S313得到前后两个轨迹点的备选路段集S[i]、S[i+1]中的每个候选路段对a[i]和a[i+1]之间计算出一对候选弧段a[i]和a[i+1]之间的最短路径，其中，a[i]为S[i]中候选弧段，a[i+1]为S[i+1]中候选弧段：

S3221、得到a[i]的终止节点Nb和a[i+1]的起始节点Ne，在道路数据处理器中计算Nb到Ne之间最短路径及其长度Lsp；

S3222、根据单点特征匹配器中结果，得到前一轨迹点弧段a[i]上的垂足到a[i]终止节点的距离L[i]，以及后一轨迹点在弧段a[i+1]上的垂足到a[i+1]终止节点的距离L[i+1]；假设弧段a[i+1]的长度为La[i+1]，则从前一轨迹点候选弧段a[i]到后一轨迹点候选弧段a[i+1]之间距离Lsp重新设为Lsp+L[i]+La[i+1]-L[i+1]；

S323、根据S3221中计算的最短路径，计算最短路径上的所有弧段的曲率积分值，将这些曲率积分值相累加即可得到c2；

S324、候选路段对的关联匹配度M2的计算

S3241、路径的长度关联匹配度M21

前后两GNSS轨迹点的匹配候选弧段之间的最短路径长度Lsp、以及之间直线距离d1，计算两者之差的绝对值|Lsp-d1|代入公式5-0.01*1.3^|Lsp-d1|来计算M21；

S3242、路径的曲率关联匹配度M22

根据前后相邻轨迹点的曲率积分估值c1与其对应候选弧段之间最短路径的曲率积分估值c2，计算两者之差|c1-c2|代入公式5-0.01*1.15^|c1-c2|来计算M22；

S3243、根据S3241和S3242计算所得M21+M22之和作为M2。

进一步，上述步骤S4中，在所有候选路段中计算出路网中与GNSS轨迹对应的最优匹配路径的步骤如下：

S41、建立有向无环图结构G，按轨迹点的时间顺序，将匹配候选路段作为有向无环图结构G的顶点，将相邻轨迹点的候选道路弧段之间能够计算最短路径的路段对作为有向无环图结构G的边，这对候选路段的单点匹配度M1值之和以及它们之间的关联匹配度M2的总和作为边的权重；

S42、在有向无环图结构G中加入一个虚拟起始节点Nv，Nv到第一个轨迹点对应的候选弧段生成的每个节点再添加一条虚拟边，并设虚拟边权重均为1；

S43、在有向无环图结构G中用拓扑序方法来求出从虚拟节点Nv出发的权重最长的路径解，从最长路径解中删除该解中起始位置的虚拟节点和虚拟边，则这个最长路径的顶点对应为每个轨迹点应该匹配的路段，路径的边对应每对相邻轨迹点的匹配路段之间的最短路径，根据图G中最长路径对应过来在道路网络中的路径，即为具有曲率约束的地图匹配结果。

此外，本发明还提出了一种曲率约束的GNSS浮动车地图匹配装置，通过采用如下技术方案将曲率积分值这一轨迹的几何特征作为约束条件，形成上述浮动车地图匹配方法：

曲率约束的GNSS浮动车地图匹配装置，包括：

匹配控制单元，用于实现对各个功能器件间的数据传输、地图匹配流程的控制；

轨迹数据处理器，用于实现对GNSS轨迹数据的存储、读写和曲率积分值的计算；

道路数据处理器，用于实现对道路网络数据的存储、读写、曲率积分值和最短路径计算；

单点特征匹配器，用于实现GNSS轨迹数据与道路网络数据之间的单点特征匹配；

关联特征匹配器，用于实现GNSS轨迹数据与道路网络数据之间的关联特征匹配；

最佳匹配计算器，用于在单点特征与关联特征的匹配结果基础上实施全局优化计算，得到最终GNSS轨迹地图匹配结果。

进一步，上述轨迹数据处理器，包括轨迹数据控制器、轨迹数据外存储器、内存储器和曲率计算单元；

将从浮动车GNSS设备定位得到的浮动车轨迹点的地理坐标、时刻、车速、车牌信息保存在轨迹数据外存储器中，在轨迹数据外存储器上根据车牌为每辆浮动车构建一个按照该浮动车轨迹点时间顺序排列的GNSS轨迹点序列，所有浮动车的GNSS轨迹数据均以GNSS轨迹点序列的形式存放在轨迹数据外存储器中；轨迹数据控制器将一辆车的GNSS轨迹点序列从轨迹数据外存储器载入到内存储器中，通过在内存储器中计算相邻轨迹点连接线段的方位角，估算相邻轨迹点之间的真实GNSS浮动车轨迹曲线的曲率积分值。

进一步，上述道路数据处理器，包括道路数据控制器、道路数据外存储器、内存储器、曲率计算单元和最短路径计算单元；

将道路网络数据放入道路数据外存储器中，在道路数据外存储器中对道路网络数据建立格网索引；道路数据控制器逐条将道路弧段载入内存储器中，遍历道路网络中的所有道路弧段，计算每条弧段上从起始端点到终止端点之间的曲率积分值；将路网数据载入内存储器中，采用dijkstra算法实现道路网络中任意两个节点的最短路径计算。

本发明如有如下有益效果：

本发明通过计算GNSS轨迹点序列中两个相邻轨迹点之间的方位角，估算出真实轨迹在两个轨迹点之间的曲率积分值，根据此曲率积分值与此两点相对应的候选路径的曲率积分值作比较约束匹配过程，在道路网中得到含此约束的具有最大相似度的匹配结果。相比于现有浮动车地图匹配方法中采用的匹配特征，本发明方法采用曲率积分值来较好地刻画了浮动车轨迹曲线弯曲程度，能够根据GNSS浮动车两个轨迹点之间的累积弯曲程度，在道路网络中搜索出以该特征值具有最大相似作为约束条件的最佳匹配结果，在采用了这种曲率的约束条件后可以提高GNSS浮动车轨迹数据的地图匹配正确率，提高匹配效率。

附图说明

图1为本发明中曲率约束的GNSS浮动车地图匹配装置的结构示意图；

图2为图1中轨迹数据处理器的结构示意图；

图3为构建GNSS轨迹点序列的示意图；

图4为图1中道路数据处理器的结构示意图；

图5为道路数据单元格网示意图；

图6为本发明中曲率约束的GNSS浮动车地图匹配方法总体流程图。

具体实施方式

下面结合附图以及具体实施方式对本发明作进一步详细说明：

结合图1所示，曲率约束的GNSS浮动车地图匹配装置，包括匹配控制单元、轨迹数据处理器、道路数据处理器、单点特征匹配器、关联特征匹配器和最佳匹配计算器。以上各功能器件通过数据总线来交互数据。

匹配控制单元，用于实现对各个功能器件间的数据传输、地图匹配方法流程控制的功能；

轨迹数据处理器，用于实现对GNSS轨迹数据的存储、读写和曲率积分计算等功能；

道路数据处理器，用于实现对道路网络数据的存储、读写、曲率计算和路径计算等功能；

单点特征匹配器，用于实现GNSS轨迹数据与道路网络数据之间的单点特征匹配；

关联特征匹配器，用于实现GNSS轨迹数据与道路网络数据之间的关联特征匹配；

最佳匹配计算器，在单点特征与关联特征的匹配结果基础上实施全局优化计算，得到最终GNSS轨迹地图匹配结果。

下面具体说明各个功能器件在GNSS浮动车地图匹配过程中的作用：

如图6所示，曲率约束的GNSS浮动车地图匹配方法的总体流程如下：

1)、在轨迹数据处理器中对GNSS轨迹数据进行轨迹几何特征计算、轨迹存储等预处理操作；

2)、在道路数据处理器中对道路网络数据进行道路弧段几何特征计算、道路格网索引建立、以及道路网络数据存储等预处理操作；

3)、以一辆车为单位按时间顺序遍历所有轨迹点，实施下面两步骤：

3.1)、在单点特征匹配器中对单个轨迹点计算其单点匹配特征，并根据该单点匹配特征建立该点的候选匹配道路弧段，给每个候选匹配道路弧段一个单点匹配度；

3.2)、在关联特征匹配器中对前后相邻的轨迹点计算它们之间的关联匹配特征，根据此关联匹配特征计算相应的候选匹配道路弧段对的匹配度；

4)、在最佳匹配计算器中综合步骤3中计算的每个匹配度，在所有候选路段中计算出路网中与GNSS轨迹对应的最优匹配路径；

下面描述曲率约束的GNSS浮动车地图匹配装置中各功能模块的具体实施方法。

如图2所示，轨迹数据处理器，包括轨迹数据控制器、轨迹数据外存储器、内存储器和曲率计算单元。

轨迹数据处理器按照以下方式对GNSS轨迹数据进行轨迹几何特征计算、轨迹存储等预处理操作：

1)、将从浮动车GNSS设备定位得到的浮动车轨迹点的地理坐标、时刻、车速、车牌等信息保存在轨迹数据外存储器中，在轨迹数据外存储器上根据车牌为每辆浮动车构建一个按照该浮动车轨迹点时间顺序排列的GNSS轨迹点序列，如图4所示，所有浮动车的GNSS轨迹数据均以GNSS轨迹点序列的形式存放在轨迹数据外存储器中；其中，轨迹数据外存储器可以采用诸如硬盘、SD卡等存储器件；

2)、曲率计算单元则实现如下计算功能：

轨迹数据控制器将一辆车的轨迹点序列从轨迹数据外存储器载入到内存储器中，

2.1)、计算相邻轨迹点连接线段的方位角：

假设GNSS轨迹点序列为P[0]、P[1]…P[n]，其中，相邻轨迹点为P[i]、P[i+1]，1≤i≤n-1；则对其实施如下计算得到线段P[i]P[i+1]的方位角

定义Δx＝P[i+1].x-P[i].x，Δy＝P[i+1].y-P[i].y，

如果Δx≥0，则如果Δx<0，则

通过上述计算得到相邻轨迹点连接线段的n-1个方位角；

2.2)、估算相邻轨迹点之间的真实GNSS浮动车轨迹曲线的曲率积分值：

将P[i-1]到P[i]的线段视为轨迹曲线在P[i]处的切向量，将P[i+1]到P[i+2]的线段视为轨迹曲线在P[i+1]处切向量；

根据2.1)得到的线段P[i-1]P[i]的方位角和线段P[i+1]P[i+2]的方位角计算如果取值在(-π,π]之间，则曲率积分值为如果取值小于-π，则曲率积分值为如果取值大于π，则曲率积分值为

以上步骤2.1)和2.2)均根据需要在一辆车的轨迹点序列中遍历实现。

如图3所示，道路数据处理器，包括道路数据控制器、道路数据外存储器、内存储器、曲率计算单元和最短路径计算单元。

道路数据处理器按照以下方式对道路网络数据进行道路弧段几何特征计算、道路格网索引建立、以及道路网络数据存储等预处理操作：

1)、将道路网络数据放入道路数据外存储器中；

道路网络数据包括道路网络的弧段和节点数据，弧段数据中包含道路弧段的属性数据、几何形状点数据、起始节点和终止节点信息，节点数据中包含与该节点连接的弧段信息；

2)、在道路数据外存储器中对道路网络数据建立格网索引：

计算道路网络数据的最小边界矩形R，将矩形R的长边分成k段，短边分成l段，则矩形R分割成k*l个矩形单元；道路网络数据按照划分好的矩形单元存放，将道路网络的弧段数据和节点数据分边存放到其所在的矩形单元中，矩形单元边界相交的弧段或者节点在边界所属的矩形单元中存放；

其中，上述对于矩形R的分割需满足：分割后的每一段长度均小于100米；

3)、遍历道路网络中的所有道路弧段，计算每条弧段上从起始端点到终止端点之间的曲率积分值，其中，道路数据控制器逐条将道路弧段载入内存储器中；

假设一条道路弧段由形状点序列R[0]、R[1]…R[n]组成，其中R[0]为道路弧段的起始端点，即道路弧段关联起始节点，R[n]为道路弧段的终止端点，即道路弧段关联终止节点，定义R[i-1]、R[i]、R[i+1]为形状点序列中的点，则在弧段的形状点序列中遍历实现下列步骤计算弧段的曲率积分值：

3.1)、计算相邻形状点R[i]、R[i+1]所组成线段R[i]R[i+1]的方位角以及R[i-1]、R[i]所组成线段R[i-1]R[i]的方位角具体求解方法在上面已述及，此处不再赘述；

3.2)、计算

如果取值在(-π,π]之间，则值不变，如果取值小于-π，则值更正为如果取值大于π，则其值更正为

3.3)、从i＝1开始遍历至i＝n-1，将所有求得的值累加，得到的结果即为该道路弧段的曲率积分值；

3.4)、在最短路径计算单元中计算两个节点的最短路径：

将路网数据载入内存储器中，采用dijkstra算法实现道路网络中任意两个节点的最短路径计算，其中搜索使用的优先队列采用配对堆。

从轨迹数据处理器中向单点特征匹配器中载入一辆车的GNSS轨迹点序列，逐一进行单点匹配。如图5所示，以下步骤针对每个轨迹点一一实施：

1)、计算轨迹点单点特征：

判断轨迹点所属的矩形单元格R0，计算与R0具有8邻域相邻的8个矩形单元，计算轨迹点到此9个单元格内的所有弧段之间距离：

假设弧段a由Pnt[0]、Pnt[1]…Pnt[n]个形状点组成，Pnt[i]Pnt[i+1]为其中一对相邻形状点形成的线段，则求轨迹点到该线段的垂足，如果垂足在线段内，则轨迹点到该线段距离为轨迹点到该垂足的直线距离，如果垂足不在线段内，则距离为轨迹点到离垂足较近的一侧端点距离，并将该端点设为垂足；遍历弧段a中所有相邻形状点形成的线段，并比较轨迹点到线段的距离，得到距离值最小的一个相邻形状点线段，并将其垂足作为轨迹点到此弧段的垂足，轨迹点到此垂足的距离，即为轨迹点到此弧段的距离；

2)、计算轨迹点到弧段的垂足沿弧段到其终止节点的距离L：

假设步骤1)中得到的轨迹点到弧段a的垂足P在线段Pnt[i]Pnt[i+1]上，计算P到Pnt[i+1]的距离L1，然后再累加从Pnt[i+1]到Pnt[n]之间所有相邻形状点线段的长度L2，最后将L的值赋为L1+L2；

3)、根据一个预定距离值d0，将步骤1)中得到的轨迹点到弧段距离小于d0的道路弧段放入一个备选弧集S中；弧段的属性中包含轨迹点到此弧段的距离、垂足和垂足到弧段终点的距离；

4)、单点匹配度M1的计算：

根据轨迹点到弧段的距离值da用线性分段函数计算备选弧段集S中所有弧段a的M1值，

当0≤da<10时，M1＝5-0.1*da；

当10≤da<35时，M1＝3.8-0.12*da；

当35≤da<50时，M1＝4.7-0.07*da；

当50≤da≤100时，M1＝2-0.02*da；

对于距离值da大于100的弧段不予考虑。

关联特征匹配器在浮动车轨迹点序列中前后相邻轨迹点间进行关联特征匹配：

1)、计算前后相邻轨迹点之间的关联特征：

第一种关联特征为：根据前后两轨迹点的位置坐标计算两点之间直线距离d1；

第二种关联特征为：在轨迹数据处理器中根据上面公式的结果，得到前后两轨迹点之间的轨迹曲线曲率积分值c1；

2)、根据前后两个轨迹点的备选路段集S[i]、S[i+1]中的每个候选路段，对a[i]和a[i+1]之间计算出一对候选弧段a[i]和a[i+1]之间的最短路径，其中，a[i]为S[i]中候选弧段，a[i+1]为S[i+1]中候选弧段：

2.1)、得到a[i]的终止节点Nb和a[i+1]的起始节点Ne，在道路数据处理器中计算Nb到Ne之间最短路径及其长度Lsp；

2.2)、根据单点特征匹配器中结果，得到前一轨迹点弧段a[i]上的垂足到a[i]终止节点的距离L[i]，以及后一轨迹点在弧段a[i+1]上的垂足到a[i+1]终止节点的距离L[i+1]；假设弧段a[i+1]的长度为La[i+1]，则从前一轨迹点候选弧段a[i]到后一轨迹点候选弧段a[i+1]之间距离Lsp重新设为Lsp+L[i]+La[i+1]-L[i+1]；

3)、计算候选路段对a[i]和a[i+1]之间的最短路径的曲率积分c2：

在道路网路处理器中，根据2.1)中计算的最短路径，计算最短路径上的所有弧段的曲率积分值，将这些曲率积分值相累加即可得到c2；

4)、候选路段对的关联匹配度M2的计算：

4.1)、路径长度关联匹配度M21

前后两GNSS轨迹点的匹配候选弧段之间的最短路径长度Lsp以及它们之间直线距离d1，计算两者之差的绝对值|Lsp-d1|来计算M21，采用将|Lsp-d1|的值从小到大的映射为5到0的取值范围的函数来计算即可，比如M21＝5-0.01*1.3^|Lsp-d1|；

4.2)、路径的曲率关联匹配度M22

根据前后相邻轨迹点的曲率积分估值c1与其对应候选弧段之间最短路径的曲率积分估值c2，计算两者之差|c1-c2|来计算M22，采用将|c1-c1|的值从小到大的映射为5到0的取值范围的函数来计算即可，比如M22＝5-0.01*1.15^|c1-c2|；

4.3)、根据步骤4.1)和4.2)计算所得M21+M22之和作为M2。

最佳匹配计算器在所有相邻候选匹配路段对之间的路径组合中搜索出最大相似度的路径P：

1)、建立有向无环图结构G，按轨迹点的时间顺序，将匹配候选路段作为有向无环图结构G的顶点，将相邻轨迹点的候选道路弧段之间能够计算最短路径的路段对作为有向无环图结构G的边，这对候选路段的单点匹配度M1值之和以及它们之间的关联匹配度M2的总和作为边的权重；

2)、在有向无环图结构G中加入一个虚拟起始节点Nv，Nv到第一个轨迹点对应的候选弧段生成的每个节点再添加一条虚拟边，并设虚拟边权重均为1；

3)、在有向无环图结构G中用拓扑序方法来求出从虚拟节点Nv出发的权重最长的路径解，从最长路径解中删除该解中起始位置的虚拟节点和虚拟边，则这个最长路径的顶点对应为每个轨迹点应该匹配的路段，路径的边对应每对相邻轨迹点的匹配路段之间的最短路径，根据图G中最长路径对应过来在道路网络中的路径即为具有曲率约束的地图匹配结果。

当然，以上说明仅仅为本发明的较佳实施例，本发明并不限于列举上述实施例，应当说明的是，任何熟悉本领域的技术人员在本说明书的教导下，所做出的所有等同替代、明显变形形式，均落在本说明书的实质范围之内，理应受到本发明的保护。

Claims (9)

1.曲率约束的GNSS浮动车地图匹配方法，其特征在于，包括如下步骤：

S1、为每辆浮动车构建一个按照该浮动车轨迹点时间顺序排列的GNSS轨迹点序列，估计真实GNSS浮动车轨迹曲线在相邻两个GNSS轨迹点处的曲率积分值；

S2、计算相邻两个GNSS轨迹点对应于道路网络中的候选关联匹配路径的曲率积分值；

S3、计算S1和S2中得到的两种曲率积分值之间的匹配度；

S4、根据S3中得到的每个匹配度，在所有候选路段中计算出路网中与GNSS轨迹对应的最优匹配路径。

2.根据权利要求1所述的曲率约束的GNSS浮动车地图匹配方法，其特征在于，所述步骤S1中，曲率积分值的计算包括如下两个步骤：

S11、计算相邻轨迹点连接线段的方位角：

定义GNSS轨迹点序列为P[0]、P[1]…P[n]，相邻轨迹点分别为P[i]和P[i+1]，P[i]与P[i+1]之间的连接线段为P[i]P[i+1]，P[i]P[i+1]的方位角为Δx＝P[i+1].x-P[i].x，Δy＝P[i+1].y-P[i].y；其中，1≤i≤n-1；

如果Δx≥0，则如果Δx<0，则

通过S11得到相邻轨迹点连接线段的n-1个方位角；

其中，x为横向坐标，y为纵向坐标，Δx为两横向坐标差值，Δy为两纵向坐标差值；

S12、估算相邻轨迹点之间的真实GNSS浮动车轨迹曲线的曲率积分值：

将P[i-1]到P[i]的线段视为轨迹曲线在P[i]处的切向量，将P[i+1]到P[i+2]的线段视为轨迹曲线在P[i+1]处的切向量；

根据S11得到的线段P[i-1]P[i]的方位角和线段P[i+1]P[i+2]的方位角计算如果取值在(-π,π]之间，则曲率积分值为如果取值小于-π，则曲率积分值为如果取值大于π，则曲率积分值为

3.根据权利要求1所述的曲率约束的GNSS浮动车地图匹配方法，其特征在于，所述步骤S2中，曲率积分值的计算包括如下步骤：

道路网络数据包括道路网络的弧段和节点数据，弧段数据中包含道路弧段的属性数据、几何形状点数据、起始节点和终止节点信息，节点数据中包含与该节点连接的弧段信息；

S21、对道路网络数据建立格网索引

计算道路网络数据的最小边界矩形R，将矩形R的长边分成k段，短边分成l段，则矩形R分割成k*l个矩形单元；道路网络数据按照划分好的矩形单元存放，将道路网络的弧段数据和节点数据分边存放到其所在的矩形单元中，矩形单元边界相交的弧段或者节点在边界所属的矩形单元中存放；

S22、遍历道路网络中的所有道路弧段，计算每条道路弧段上从起始端点到终止端点之间的曲率积分值；

S23、采用dijkstra算法，计算道路网络中任意两个节点的最短路径。

4.根据权利要求3所述的曲率约束的GNSS浮动车地图匹配方法，其特征在于，所述步骤S22中，曲率积分值的计算过程如下：

假设一条道路弧段由形状点序列R[0]、R[1]…R[n]组成，其中，R[0]为道路弧段的起始端点，即道路弧段的关联起始节点，R[n]为道路弧段的终止端点，即道路弧段的关联终止节点，定义R[i-1]、R[i]、R[i+1]为形状点序列中的点，其中，1≤i≤n-1；

S221、计算相邻形状点R[i]、R[i+1]所组成线段R[i]R[i+1]的方位角以及R[i-1]、R[i]所组成线段R[i-1]R[i]的方位角

S222、计算

如果取值在(-π,π]之间，则值不变；如果取值小于-π，则 如果取值大于π，则

S223、从i＝1开始遍历至i＝n-1，将所有求得的值累加，累加得到的结果即为该道路弧段的曲率积分值。

5.根据权利要求3所述的曲率约束的GNSS浮动车地图匹配方法，其特征在于，所述步骤S3中，匹配度的计算包括单点匹配度的计算和关联匹配度的计算；

S31、单点匹配度的计算

S311、计算轨迹点的单点特征

判断轨迹点所属的矩形单元，计算与该矩形单元具有8邻域相邻的8个矩形单元，计算轨迹点到此9个矩形单元内的所有弧段之间距离：

假设弧段a由Pnt[0]、Pnt[1]…Pnt[n]个形状点组成，Pnt[i]Pnt[i+1]为其中一对相邻形状点形成的线段，则求轨迹点到该线段的垂足；

如果垂足在线段内，则轨迹点到该线段距离为轨迹点到该垂足P的直线距离，如果垂足不在线段内，则距离为轨迹点到离垂足较近的一侧端点距离，并将该端点设为垂足P；

遍历弧段a中所有相邻形状点形成的线段，并比较轨迹点到线段的距离，得到距离值最小的一个相邻形状点线段，并将其垂足作为轨迹点到此弧段的垂足，轨迹点到此垂足的距离，即为轨迹点到此弧段的距离；

S312、计算轨迹点到弧段的垂足沿弧段到其终止节点的距离L

假设S311中得到的轨迹点到弧段a的垂足P在线段Pnt[i]Pnt[i+1]上，计算P到Pnt[i+1]的距离L1，然后再累加从Pnt[i+1]到Pnt[n]之间所有相邻形状点线段的长度L2，最后将L的值赋为L1+L2；

S313、根据一个预定距离值d0，将步骤S311中得到的轨迹点到弧段距离小于d0的道路弧段放入一个备选弧集S中；弧段的属性中包含轨迹点到此弧段的距离、垂足和垂足到弧段终点的距离；

S314、单点匹配度M1的计算

根据轨迹点到弧段的距离值da用线性分段函数计算备选弧段集S中所有弧段a的M1值，

当0≤da<10时，M1＝5-0.1*da；

当10≤da<35时，M1＝3.8-0.12*da；

当35≤da<50时，M1＝4.7-0.07*da；

当50≤da≤100时，M1＝2-0.02*da；

对于轨迹点到弧段的距离值da大于100的弧段不予考虑；

S32、关联匹配度的计算

S321、计算前后相邻轨迹点之间的关联特征

根据前后两轨迹点的位置坐标计算两点之间直线距离d1；根据步骤S1中的结果得到前后两轨迹点之间的轨迹曲线曲率积分值c1；

S322、根据S313得到前后两个轨迹点的备选路段集S[i]、S[i+1]中的每个候选路段对a[i]和a[i+1]之间计算出一对候选弧段a[i]和a[i+1]之间的最短路径，其中，a[i]为S[i]中候选弧段，a[i+1]为S[i+1]中候选弧段：

S3221、得到a[i]的终止节点Nb和a[i+1]的起始节点Ne，在道路数据处理器中计算Nb到Ne之间最短路径及其长度Lsp；

S3222、根据单点特征匹配器中结果，得到前一轨迹点弧段a[i]上的垂足到a[i]终止节点的距离L[i]，以及后一轨迹点在弧段a[i+1]上的垂足到a[i+1]终止节点的距离L[i+1]；假设弧段a[i+1]的长度为La[i+1]，则从前一轨迹点候选弧段a[i]到后一轨迹点候选弧段a[i+1]之间距离Lsp重新设为Lsp+L[i]+La[i+1]-L[i+1]；

S323、根据S3221中计算的最短路径，计算最短路径上的所有弧段的曲率积分值，将这些曲率积分值相累加即可得到c2；

S324、候选路段对的关联匹配度M2的计算

S3241、路径的长度关联匹配度M21

前后两GNSS轨迹点的匹配候选弧段之间的最短路径长度Lsp、以及之间直线距离d1，计算两者之差的绝对值|Lsp-d1|代入公式5-0.01*1.3^|Lsp-d1|来计算M21；

S3242、路径的曲率关联匹配度M22

根据前后相邻轨迹点的曲率积分估值c1与其对应候选弧段之间最短路径的曲率积分估值c2，计算两者之差|c1-c2|代入公式5-0.01*1.15^|c1-c2|来计算M22；

S3243、根据S3241和S3242计算所得M21+M22之和作为M2。

6.根据权利要求5所述的曲率约束的GNSS浮动车地图匹配方法，其特征在于，所述步骤S4中，在所有候选路段中计算出路网中与GNSS轨迹对应的最优匹配路径的步骤如下：

S41、建立有向无环图结构G，按轨迹点的时间顺序，将匹配候选路段作为有向无环图结构G的顶点，将相邻轨迹点的候选道路弧段之间能够计算最短路径的路段对作为有向无环图结构G的边，这对候选路段的单点匹配度M1值之和以及它们之间的关联匹配度M2的总和作为边的权重；

S42、在有向无环图结构G中加入一个虚拟起始节点Nv，Nv到第一个轨迹点对应的候选弧段生成的每个节点再添加一条虚拟边，并设虚拟边权重均为1；

S43、在有向无环图结构G中用拓扑序方法来求出从虚拟节点Nv出发的权重最长的路径解，从最长路径解中删除该解中起始位置的虚拟节点和虚拟边，则这个最长路径的顶点对应为每个轨迹点应该匹配的路段，路径的边对应每对相邻轨迹点的匹配路段之间的最短路径，根据图G中最长路径对应过来在道路网络中的路径，即为具有曲率约束的地图匹配结果。

7.曲率约束的GNSS浮动车地图匹配装置，其特征在于，包括：

匹配控制单元，用于实现对各个功能器件间的数据传输、地图匹配流程的控制；

轨迹数据处理器，用于实现对GNSS轨迹数据的存储、读写和曲率积分值的计算；

道路数据处理器，用于实现对道路网络数据的存储、读写、曲率积分值和最短路径计算；

单点特征匹配器，用于实现GNSS轨迹数据与道路网络数据之间的单点特征匹配；

关联特征匹配器，用于实现GNSS轨迹数据与道路网络数据之间的关联特征匹配；

最佳匹配计算器，用于在单点特征与关联特征的匹配结果基础上实施全局优化计算，得到最终GNSS轨迹地图匹配结果。

8.根据权利要求7所述的曲率约束的GNSS浮动车地图匹配装置，其特征在于，所述轨迹数据处理器，包括轨迹数据控制器、轨迹数据外存储器、内存储器和曲率计算单元；

将从浮动车GNSS设备定位得到的浮动车轨迹点的地理坐标、时刻、车速、车牌信息保存在轨迹数据外存储器中，在轨迹数据外存储器上根据车牌为每辆浮动车构建一个按照该浮动车轨迹点时间顺序排列的GNSS轨迹点序列，所有浮动车的GNSS轨迹数据均以GNSS轨迹点序列的形式存放在轨迹数据外存储器中；轨迹数据控制器将一辆车的GNSS轨迹点序列从轨迹数据外存储器载入到内存储器中，通过在内存储器中计算相邻轨迹点连接线段的方位角，估算相邻轨迹点之间的真实GNSS浮动车轨迹曲线的曲率积分值。

9.根据权利要求7所述的曲率约束的GNSS浮动车地图匹配装置，其特征在于，所述道路数据处理器，包括道路数据控制器、道路数据外存储器、内存储器、曲率计算单元和最短路径计算单元；

将道路网络数据放入道路数据外存储器中，在道路数据外存储器中对道路网络数据建立格网索引；道路数据控制器逐条将道路弧段载入内存储器中，遍历道路网络中的所有道路弧段，计算每条弧段上从起始端点到终止端点之间的曲率积分值；将路网数据载入内存储器中，采用dijkstra算法实现道路网络中任意两个节点的最短路径计算。