CN105957342B - Track grade road plotting method and system based on crowdsourcing space-time big data - Google Patents
Track grade road plotting method and system based on crowdsourcing space-time big data Download PDFInfo
- Publication number
- CN105957342B CN105957342B CN201610370700.9A CN201610370700A CN105957342B CN 105957342 B CN105957342 B CN 105957342B CN 201610370700 A CN201610370700 A CN 201610370700A CN 105957342 B CN105957342 B CN 105957342B
- Authority
- CN
- China
- Prior art keywords
- lanes
- lane
- rectangular window
- nlane
- trajectory
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 68
- 239000013598 vector Substances 0.000 claims abstract description 65
- 238000001514 detection method Methods 0.000 claims abstract description 45
- 238000013210 evaluation model Methods 0.000 claims abstract description 24
- 238000013507 mapping Methods 0.000 claims abstract description 14
- 238000010276 construction Methods 0.000 claims abstract description 13
- 230000004927 fusion Effects 0.000 claims abstract description 6
- 238000012937 correction Methods 0.000 claims description 28
- 238000005457 optimization Methods 0.000 claims description 28
- 238000004364 calculation method Methods 0.000 claims description 18
- 238000013519 translation Methods 0.000 claims description 17
- 230000001360 synchronised effect Effects 0.000 claims description 15
- 238000000605 extraction Methods 0.000 claims description 13
- 230000003993 interaction Effects 0.000 claims 6
- 239000000203 mixture Substances 0.000 abstract description 34
- 238000010586 diagram Methods 0.000 description 10
- 238000005259 measurement Methods 0.000 description 10
- 238000011160 research Methods 0.000 description 4
- 230000001186 cumulative effect Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 239000008280 blood Substances 0.000 description 1
- 210000004369 blood Anatomy 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000013480 data collection Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 238000007500 overflow downdraw method Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 239000013589 supplement Substances 0.000 description 1
- 230000002747 voluntary effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/01—Detecting movement of traffic to be counted or controlled
- G08G1/0104—Measuring and analyzing of parameters relative to traffic conditions
Landscapes
- Chemical & Material Sciences (AREA)
- Analytical Chemistry (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明提供一种基于众包时空大数据的车道级道路测图方法,包括建立轨迹向量的相似度评估模型,基于融合经验知识的生长聚类方法进行轨迹优选,构建高斯约束混合模型,并使用EM算法求解模型参数;探测车道信息,得到道路路段车道数量初次探测结果;基于道路建设规则,对初次探测结果进行修正;根据修正后的车道数量,根据相邻情况对车道中心线进行修正。本发明降低了获取城市精细道路信息的成本,且探测方法简单、容易实现。
The present invention provides a lane-level road mapping method based on crowdsourcing spatio-temporal big data, which includes establishing a similarity evaluation model of trajectory vectors, optimizing trajectory based on the growth clustering method of fusion experience knowledge, constructing a Gaussian constraint mixture model, and using The EM algorithm solves the model parameters; detects the lane information, and obtains the initial detection result of the number of lanes in the road section; based on the road construction rules, the initial detection result is corrected; according to the corrected number of lanes, the centerline of the lane is corrected according to the adjacent conditions. The invention reduces the cost of acquiring urban fine road information, and the detection method is simple and easy to implement.
Description
技术领域technical field
本发明涉及众包时空大数据的高精度车道级道路测图,属于地理信息系统与智能交通研究领域。The invention relates to high-precision lane-level road mapping of crowdsourced spatiotemporal big data, and belongs to the field of geographic information system and intelligent transportation research.
背景技术Background technique
高精度道路地图是未来自动驾驶的血液和灵魂,而车道级精细道路信息是构建高精度道路地图的关键组成部分。目前,研究者提出基于视觉方法从高分辨率遥感影像中提取车道线,亦或是利用高精度激光点云数据获取道路细节信息,以及从测量车采集的大量高精度GPS轨迹数据中提取道路路面信息(道路边界线、车道数量、车道中心线)。Rogersetal.(1999)是最早尝试利用时空DGPS(差分全球定位系统)轨迹数据提取道路中心线以及车道边界线的研究者之一。随后在Rogers等人研究的基础上,利用时空GPS轨迹数据获取道路信息逐渐发展成为一种端对端的模式。这种端对端模式的道路信息获取可以总结为如下几个过程:首先对DGPS轨迹数据进行优化,然后将DGPS轨迹数据与现有地图数据匹配,样条曲线拟合道路中心线,最后通过聚类方法提取车道信息以及细化交叉口的几何结构。JohnKrumm提出一种脱离原始地图的道路信息获取模式,该模式首先采用轨迹分类和融合方法从大量DGPS轨迹数据中提取道路级别信息,然后利用高斯混合模型从归属于每一条路段的大量轨迹数据中提取车道信息。然而,这些获取车道级精细道路信息的途径都存在数据采集成本高、采集时间长、更新速度慢、数据处理复杂等缺点。High-precision road maps are the blood and soul of future autonomous driving, and lane-level fine road information is a key component of building high-precision road maps. At present, researchers propose to extract lane lines from high-resolution remote sensing images based on vision methods, or use high-precision laser point cloud data to obtain road detail information, and extract road pavement from a large number of high-precision GPS trajectory data collected by surveying vehicles. Information (road boundaries, number of lanes, lane centerlines). Rogers et al. (1999) was one of the first researchers who attempted to extract road centerlines and lane boundaries using spatio-temporal DGPS (Differential Global Positioning System) trajectory data. Subsequently, on the basis of the research of Rogers et al., the use of spatio-temporal GPS trajectory data to obtain road information gradually developed into an end-to-end model. This end-to-end mode of road information acquisition can be summarized as the following processes: first, optimize the DGPS trajectory data, then match the DGPS trajectory data with the existing map data, fit the spline curve to the road centerline, and finally pass Class methods extract lane information and refine intersection geometry. John Krumm proposed a road information acquisition mode that is separated from the original map. This mode first uses trajectory classification and fusion methods to extract road level information from a large number of DGPS trajectory data, and then uses Gaussian mixture model to extract from a large number of trajectory data belonging to each road segment. lane information. However, these approaches to obtain lane-level fine road information have disadvantages such as high data collection cost, long collection time, slow update speed, and complex data processing.
随着传感器技术、无线通信和网络技术的飞速发展,“人人都是传感器”,人们的出行会产生大量时空轨迹大数据,蕴含着丰富的精细道路信息和人类行为活动信息。轨迹数据的采集逐渐由专业部门测量车或者专业人员采集演变为由非专业人士自由自愿的记录其出行轨迹的形式,数据的采集开始转变为众包模式。众包模式下的车载轨迹数据(众包大数据)无疑是目前可以提供车道级道路信息提取的最佳数据源。与现有的出租车数据相比,由众包模式采集的车载轨迹数据属于大数据(大数据是指无法在可承受的时间范围内用常规软件工具进行捕捉、管理和处理的数据集合,是需要新处理模式才能具有更强的决策力、洞察发现力和流程优化能力来适应海量、高增长率和多样化的信息资产)。目前国内学者唐炉亮等人(2015,2016)提出利用低精度GPS轨迹数据提取城市车道级道路信息,包括车道数量、车道转向、车道中心线,然而如何利用众包大数据,开展车道级精细道路测图是全世界科学家们面临的难题。With the rapid development of sensor technology, wireless communication and network technology, "everyone is a sensor", people's travel will generate a large amount of spatio-temporal trajectory big data, which contains rich fine road information and human behavior information. The collection of trajectory data has gradually evolved from the collection of measuring vehicles by professional departments or by professionals to the form of free and voluntary recording of travel trajectories by non-professionals, and the collection of data has begun to transform into a crowdsourcing model. The vehicle trajectory data (crowdsourcing big data) under the crowdsourcing mode is undoubtedly the best data source that can provide lane-level road information extraction at present. Compared with the existing taxi data, the vehicle trajectory data collected by the crowdsourcing mode belongs to big data (big data refers to the collection of data that cannot be captured, managed and processed by conventional software tools within an affordable time frame, and is A new processing model is needed to have stronger decision-making power, insight discovery power and process optimization ability to adapt to massive, high growth rate and diversified information assets). At present, domestic scholars Tang Luliang et al. (2015, 2016) proposed to use low-precision GPS trajectory data to extract urban lane-level road information, including the number of lanes, lane turning, and lane centerline. Road mapping is a difficult problem faced by scientists all over the world.
发明内容Contents of the invention
本发明在以上研究的基础上,提出了一种基于众包时空大数据的高精度车道级道路测图(优质轨迹数据滤选和高精度道路信息提取)的新技术方案。On the basis of the above research, the present invention proposes a new technical solution for high-precision lane-level road mapping (high-quality trajectory data filtering and high-precision road information extraction) based on crowdsourcing spatiotemporal big data.
本发明技术方案提供一种基于众包时空大数据的车道级道路测图方法,包括以下步骤,The technical solution of the present invention provides a lane-level road mapping method based on crowdsourcing spatio-temporal big data, comprising the following steps,
步骤1,建立轨迹向量的相似度评估模型,设va和vb是两个不同的轨迹向量,所述相似度评价模型如下,Step 1, establishing a similarity evaluation model of trajectory vectors, assuming that v a and v b are two different trajectory vectors, the similarity evaluation model is as follows,
其中,表示向量之间的相似度值,e为自然底数,ω1和ω2分别表示距离因子diffHd和角度因子diffθab的权重值,且ω1+ω2=1;距离因子diffHd和角度因子diffθab分别表示向量va和vb的距离差异和角度差异;in, Represents the similarity value between vectors, e is the natural base, ω 1 and ω 2 represent the weight values of distance factor diff Hd and angle factor diff θab respectively, and ω 1 +ω 2 =1; distance factor diff Hd and angle factor diff θab represents the distance difference and angle difference of vectors v a and v b respectively;
步骤2,基于融合经验知识的生长聚类方法进行轨迹优选,包括根据已有的高精度GPS轨迹数据与同步的低精度GPS轨迹数据,确定相似度评价模型的权重值ω1和ω2,提取轨迹优选的先验知识,基于众包轨迹数据之间的相似度采用生长聚类方式进行数据优选;Step 2. Optimizing the trajectory based on the growth clustering method based on the fusion of empirical knowledge, including determining the weight values ω 1 and ω 2 of the similarity evaluation model based on the existing high-precision GPS trajectory data and the synchronized low-precision GPS trajectory data, and extracting The prior knowledge of trajectory optimization, based on the similarity between crowdsourcing trajectory data, adopts the growth clustering method to optimize data;
步骤3,构建高斯约束混合模型,并使用EM算法求解模型参数;所述高斯约束混合模型定义如下,Step 3, build a Gaussian constrained mixture model, and use the EM algorithm to solve the model parameters; the Gaussian constrained mixture model is defined as follows,
其中,p(x)表示为高斯约束混合模型的综合概率值,x表示待计算样本值,在进行车道计算时,x代表判断窗口内轨迹点在其纵剖面上垂直投影的纵坐标值;k是高斯成分的数量,每一个高斯成分对应一个车道;ωj是第j个高斯成分的权重,对应车道的交通流量;参数μ1…μk是每一个高斯成分中轨迹的平均值,等于每个车道的中心线,μj表示μ1…μk参数内的任意一个值,j=1,2,…,k;σ是每一个高斯成分中轨迹的标准差;Among them, p(x) represents the comprehensive probability value of the Gaussian constrained mixture model, and x represents the sample value to be calculated. When calculating the lane, x represents the ordinate value of the vertical projection of the trajectory point in the judgment window on its longitudinal section; k is the number of Gaussian components, and each Gaussian component corresponds to a lane; ω j is the weight of the jth Gaussian component, corresponding to the traffic flow of the lane; the parameter μ 1 ...μ k is the average value of the trajectory in each Gaussian component, equal to each The center line of each lane, μ j represents any value in μ 1 ...μ k parameters, j=1,2,...,k; σ is the standard deviation of the trajectory in each Gaussian component;
所述高斯约束混合模型中高斯成分的数量k获取方式为,计算结构风险模型的值,以结构风险模型值最小为原则确定k;The method for obtaining the quantity k of Gaussian components in the Gaussian constrained mixture model is to calculate the value of the structural risk model, and determine k based on the principle that the value of the structural risk model is the smallest;
步骤4,根据步骤3所得结果,探测车道信息,得到道路路段车道数量初次探测结果;实现方式如下,Step 4, according to the result obtained in step 3, detect the lane information, and obtain the initial detection result of the number of lanes in the road section; the implementation method is as follows,
将处于同一条路段上的所有轨迹作为一个提取单元,设给定一组从交叉口Intersection1到交叉口Intersection2的轨迹集合AT,从轨迹集合AT的一端开始,构建移动矩形窗口,其中移动矩形窗口的长边平行于当前覆盖所有轨迹的中心线,移动矩形窗口的宽边则垂直于当前覆盖所有轨迹的中心线,矩形窗口长边的中心线垂直于其覆盖的所有轨迹数据的中心线,矩形窗口宽边的中线与其覆盖的轨迹数据的中心线重合;Taking all the trajectories on the same road segment as an extraction unit, set a set of trajectories A T from the intersection Intersection 1 to the intersection Intersection 2 , and start from one end of the trajectory set A T to construct a moving rectangular window, where The long side of the moving rectangular window is parallel to the center line of all tracks currently covered, the wide side of the moving rectangular window is perpendicular to the center line of all tracks currently covered, and the center line of the long side of the rectangular window is perpendicular to the center of all track data it covers Line, the center line of the wide side of the rectangular window coincides with the center line of the covered trajectory data;
将移动矩形窗口从轨迹集合AT的一端开始,按照矩形窗口的长边长度开始平移,依次利用高斯约束混合模型来探测每一个矩形窗口内覆盖的路段的车道数量及车道中心线,包括根据移动矩形窗口,将移动矩形窗口内的所有轨迹点投影到矩形窗口的长边中心线上,得到投影后的轨迹数据集X=(x1,x2,…,xN),t=1,2,3,…,N,其中,xt表示投影后第t个轨迹点的纵坐标值,N为参加投影轨迹点的个数;将轨迹数据集X代入高斯约束混合模型,提取矩形窗口内路段的车道数量和车道中心线;假设从交叉口Intersection1到交叉口Intersection2的轨迹集合AT,矩形窗口一共进行了l次平移,每一次平移确定的车道数量记为Nlanef,f=1,2,…,l,作为道路路段车道数量初次探测结果;Start the moving rectangular window from one end of the trajectory set AT , and start to translate according to the length of the long side of the rectangular window, and then use the Gaussian constraint mixture model to detect the number of lanes and lane centerlines of the road sections covered in each rectangular window, including moving Rectangular window, project all trajectory points in the moving rectangular window onto the center line of the long side of the rectangular window, and obtain the projected trajectory data set X=(x 1 ,x 2 ,…,x N ), t=1,2 ,3,...,N, where x t represents the ordinate value of the tth trajectory point after projection, and N is the number of trajectory points participating in the projection; Substitute the trajectory data set X into the Gaussian constraint mixture model to extract the road section in the rectangular window The number of lanes and the centerline of the lanes; assuming the trajectory set A T from intersection Intersection 1 to intersection Intersection 2 , the rectangular window has been translated l times in total, and the number of lanes determined by each translation is recorded as Nlane f , f=1, 2,...,l, as the initial detection results of the number of lanes in the road segment;
步骤5,根据步骤4获取的道路路段车道数量初次探测结果,基于道路建设规则,对初次探测结果进行修正;Step 5, according to the initial detection result of the number of lanes in the road segment obtained in step 4, and based on the road construction rules, the initial detection result is corrected;
步骤6,根据步骤5得到的修正后的车道数量,根据相邻情况对车道中心线进行修正。In step 6, according to the number of corrected lanes obtained in step 5, the centerline of the lane is corrected according to the adjacent conditions.
而且,步骤5中对初次探测结果进行修正,实现方式如下,Moreover, in step 5, the initial detection result is corrected, and the implementation method is as follows,
第一步,对于步骤4中某次平移确定的车道数量Nlanef,比较Nlanef+1和Nlanef、Nlanef+2,如果Nlanef和Nlanef+1是不同的,则用Nlanef替换Nlanef+1,f=1,2,…,l-2;The first step, for the number of lanes Nlane f determined by a translation in step 4, compare Nlane f+1 with Nlane f and Nlane f+2 , if Nlane f and Nlane f+1 are different, replace Nlane with Nlane f f+1 , f=1,2,...,l-2;
第二步,根据Nlanef的值和分布对第一步的结果分类,设存在s个类,记为Cg=<Nlg,ncg>,Nlg是类簇Cg的车道数量,ncg是Nlaneg中属于Cg,g=1,2,…,s的总数量;The second step is to classify the results of the first step according to the value and distribution of Nlane f , assuming there are s classes, recorded as C g =<Nl g , nc g >, Nl g is the number of lanes of the cluster C g , nc g is the total number of C g , g=1,2,...,s in Nlane g ;
第三步,比较Cg+1和Cg,如果Nlg+1不同于Nlg,且ncg+1<cv,令Cg的Nlg替换Cg+1的Nlg+1,g=1,2,…,s,完成车道数量结果的最终优化,其中,cv是预设的阈值。The third step is to compare C g+1 and C g , if Nl g+1 is different from Nl g , and nc g+1 < cv, let Nl g of C g replace Nl g +1 of C g +1 , g= 1,2,...,s, complete the final optimization of the number of lanes, where cv is the preset threshold.
而且,步骤6对车道中心线进行修正,实现方式如下,Moreover, step 6 corrects the centerline of the lane, and the implementation method is as follows,
设某一段路段La的车道数量被修正,如果La相邻路段Lb和Lc同时满足与La具有相同的车道数量,且修正前与修正后的车道数量并未发生变化,那么就将Lb与Lc的车道中心线连接,得到La最终的车道中心线;如果La相邻路段Lb或者Lc的车道数量修正前与修正后也发生变化,那么就根据La修正前提取的车道中心线位置,计算基于La修正前车道中心线位置推算La路段的道路中心线,按照La修正后车道宽度和车道数量重新确定La修正后的车道中心线位置。Assuming that the number of lanes of a section La is corrected, if the adjacent sections Lb and Lc of La have the same number of lanes as La at the same time, and the number of lanes before and after correction has not changed, then the Lb and Lc The lane centerline is connected to get the final lane centerline of La; if the number of lanes of the adjacent section Lb or Lc of La also changes before and after correction, then the calculation is based on the La correction based on the position of the lane centerline extracted before La correction. Calculate the road centerline of the La section from the position of the front lane centerline, and re-determine the La-corrected lane centerline position according to the La-corrected lane width and the number of lanes.
本发明提供一种基于众包时空大数据的车道级道路测图系统,包括以下模块,The present invention provides a lane-level road mapping system based on crowdsourcing spatiotemporal big data, which includes the following modules,
第一模块,用于建立轨迹向量的相似度评估模型,设va和vb是两个不同的轨迹向量,所述相似度评价模型如下,The first module is used to establish a similarity evaluation model of trajectory vectors, assuming v a and v b are two different trajectory vectors, and the similarity evaluation model is as follows,
其中,表示向量之间的相似度值,e为自然底数,ω1和ω2分别表示距离因子diffHd和角度因子diffθab的权重值,且ω1+ω2=1;距离因子diffHd和角度因子diffθab分别表示向量va和vb的距离差异和角度差异;in, Represents the similarity value between vectors, e is the natural base, ω 1 and ω 2 represent the weight values of distance factor diff Hd and angle factor diff θab respectively, and ω 1 +ω 2 =1; distance factor diff Hd and angle factor diff θab represents the distance difference and angle difference of vectors v a and v b respectively;
第二模块,用于基于融合经验知识的生长聚类方法进行轨迹优选,包括根据已有的高精度GPS轨迹数据与同步的低精度GPS轨迹数据,确定相似度评价模型的权重值ω1和ω2,提取轨迹优选的先验知识,基于众包轨迹数据之间的相似度采用生长聚类方式进行数据优选;The second module is used to optimize the trajectory based on the growth clustering method based on the fusion of empirical knowledge, including determining the weight values ω 1 and ω of the similarity evaluation model based on the existing high-precision GPS trajectory data and the synchronized low-precision GPS trajectory data 2. Extract the prior knowledge of trajectory optimization, and use the growth clustering method to optimize data based on the similarity between crowdsourced trajectory data;
第三模块,用于构建高斯约束混合模型,并使用EM算法求解模型参数;所述高斯约束混合模型定义如下,The third module is used to construct the Gaussian constraint mixture model, and use the EM algorithm to solve the model parameters; the Gaussian constraint mixture model is defined as follows,
其中,p(x)表示为高斯约束混合模型的综合概率值,x表示待计算样本值,在进行车道计算时,x代表判断窗口内轨迹点在其纵剖面上垂直投影的纵坐标值;k是高斯成分的数量,每一个高斯成分对应一个车道;ωj是第j个高斯成分的权重,对应车道的交通流量;参数μ1…μk是每一个高斯成分中轨迹的平均值,等于每个车道的中心线,μj表示μ1…μk参数内的任意一个值,j=1,2,…,k;σ是每一个高斯成分中轨迹的标准差;Among them, p(x) represents the comprehensive probability value of the Gaussian constrained mixture model, and x represents the sample value to be calculated. When calculating the lane, x represents the ordinate value of the vertical projection of the trajectory point in the judgment window on its longitudinal section; k is the number of Gaussian components, and each Gaussian component corresponds to a lane; ω j is the weight of the jth Gaussian component, corresponding to the traffic flow of the lane; the parameter μ 1 ...μ k is the average value of the trajectory in each Gaussian component, equal to each The center line of each lane, μ j represents any value in μ 1 ...μ k parameters, j=1,2,...,k; σ is the standard deviation of the trajectory in each Gaussian component;
所述高斯约束混合模型中高斯成分的数量k获取方式为,计算结构风险模型的值,以结构风险模型值最小为原则确定k;The method for obtaining the quantity k of Gaussian components in the Gaussian constrained mixture model is to calculate the value of the structural risk model, and determine k based on the principle that the value of the structural risk model is the smallest;
第四模块,用于根据第三模块所得结果,探测车道信息,得到道路路段车道数量初次探测结果;实现方式如下,The fourth module is used to detect lane information according to the results obtained in the third module, and obtain the initial detection result of the number of lanes in road sections; the implementation method is as follows,
将处于同一条路段上的所有轨迹作为一个提取单元,设给定一组从交叉口Intersection1到交叉口Intersection2的轨迹集合AT,从轨迹集合AT的一端开始,构建移动矩形窗口,其中移动矩形窗口的长边平行于当前覆盖所有轨迹的中心线,移动矩形窗口的宽边则垂直于当前覆盖所有轨迹的中心线,矩形窗口长边的中心线垂直于其覆盖的所有轨迹数据的中心线,矩形窗口宽边的中线与其覆盖的轨迹数据的中心线重合;Taking all the trajectories on the same road segment as an extraction unit, set a set of trajectories A T from the intersection Intersection 1 to the intersection Intersection 2 , and start from one end of the trajectory set A T to construct a moving rectangular window, where The long side of the moving rectangular window is parallel to the center line of all tracks currently covered, the wide side of the moving rectangular window is perpendicular to the center line of all tracks currently covered, and the center line of the long side of the rectangular window is perpendicular to the center of all track data it covers Line, the center line of the wide side of the rectangular window coincides with the center line of the covered trajectory data;
将移动矩形窗口从轨迹集合AT的一端开始,按照矩形窗口的长边长度开始平移,依次利用高斯约束混合模型来探测每一个矩形窗口内覆盖的路段的车道数量及车道中心线,包括根据移动矩形窗口,将移动矩形窗口内的所有轨迹点投影到矩形窗口的长边中心线上,得到投影后的轨迹数据集X=(x1,x2,…,xN),t=1,2,3,…,N,其中,xt表示投影后第t个轨迹点的纵坐标值,N为参加投影轨迹点的个数;将轨迹数据集X代入高斯约束混合模型,提取矩形窗口内路段的车道数量和车道中心线;假设从交叉口Intersection1到交叉口Intersection2的轨迹集合AT,矩形窗口一共进行了l次平移,每一次平移确定的车道数量记为Nlanef,f=1,2,…,l,作为道路路段车道数量初次探测结果;Start the moving rectangular window from one end of the trajectory set AT , and start to translate according to the length of the long side of the rectangular window, and then use the Gaussian constraint mixture model to detect the number of lanes and lane centerlines of the road sections covered in each rectangular window, including moving Rectangular window, project all trajectory points in the moving rectangular window onto the center line of the long side of the rectangular window, and obtain the projected trajectory data set X=(x 1 ,x 2 ,…,x N ), t=1,2 ,3,...,N, where x t represents the ordinate value of the tth trajectory point after projection, and N is the number of trajectory points participating in the projection; Substitute the trajectory data set X into the Gaussian constraint mixture model to extract the road section in the rectangular window The number of lanes and the centerline of the lanes; assuming the trajectory set A T from intersection Intersection 1 to intersection Intersection 2 , the rectangular window has been translated l times in total, and the number of lanes determined by each translation is recorded as Nlane f , f=1, 2,...,l, as the initial detection results of the number of lanes in the road segment;
第五模块,用于根据第四模块获取的道路路段车道数量初次探测结果,基于道路建设规则,对初次探测结果进行修正;The fifth module is used to correct the initial detection results based on the road construction rules according to the initial detection results of the number of lanes in the road section obtained by the fourth module;
第六模块,用于根据第五模块得到的修正后的车道数量,根据相邻情况对车道中心线进行修正。The sixth module is used to correct the centerline of the lane according to the adjacent situation according to the corrected number of lanes obtained by the fifth module.
而且,第五模块中对初次探测结果进行修正,实现方式如下,Moreover, in the fifth module, the initial detection result is corrected, and the implementation method is as follows,
第一步,对于第四模块中某次平移确定的车道数量Nlanef,比较Nlanef+1和Nlanef、Nlanef+2,如果Nlanef和Nlanef+1是不同的,则用Nlanef替换Nlanef+1,f=1,2,…,l-2;In the first step, for the number of lanes Nlane f determined by a translation in the fourth module, compare Nlane f+1 with Nlane f and Nlane f+2 , if Nlane f and Nlane f+1 are different, replace with Nlane f Nlane f+1 , f=1,2,...,l-2;
第二步,根据Nlanef的值和分布对第一步的结果分类,设存在s个类,记为Cg=<Nlg,ncg>,Nlg是类簇Cg的车道数量,ncg是Nlaneg中属于Cg,g=1,2,…,s的总数量;The second step is to classify the results of the first step according to the value and distribution of Nlane f , assuming there are s classes, recorded as C g =<Nl g , nc g >, Nl g is the number of lanes of the cluster C g , nc g is the total number of C g , g=1,2,...,s in Nlane g ;
第三步,比较Cg+1和Cg,如果Nlg+1不同于Nlg,且ncg+1<cv,令Cg的Nlg替换Cg+1的Nlg+1,g=1,2,…,s,完成车道数量结果的最终优化,其中,cv是预设的阈值。The third step is to compare C g+1 and C g , if Nl g+1 is different from Nl g , and nc g+1 < cv, let Nl g of C g replace Nl g +1 of C g +1 , g= 1,2,...,s, complete the final optimization of the number of lanes, where cv is the preset threshold.
而且,第六模块对车道中心线进行修正,实现方式如下,Moreover, the sixth module corrects the centerline of the lane, and the implementation method is as follows,
设某一段路段La的车道数量被修正,如果La相邻路段Lb和Lc同时满足与La具有相同的车道数量,且修正前与修正后的车道数量并未发生变化,那么就将Lb与Lc的车道中心线连接,得到La最终的车道中心线;如果La相邻路段Lb或者Lc的车道数量修正前与修正后也发生变化,那么就根据La修正前提取的车道中心线位置,计算基于La修正前车道中心线位置推算La路段的道路中心线,按照La修正后车道宽度和车道数量重新确定La修正后的车道中心线位置。Assuming that the number of lanes of a section La is corrected, if the adjacent sections Lb and Lc of La have the same number of lanes as La at the same time, and the number of lanes before and after correction has not changed, then the Lb and Lc The lane centerline is connected to get the final lane centerline of La; if the number of lanes of the adjacent section Lb or Lc of La also changes before and after correction, then the calculation is based on the La correction based on the position of the lane centerline extracted before La correction. Calculate the road centerline of the La section from the position of the front lane centerline, and re-determine the La-corrected lane centerline position according to the La-corrected lane width and the number of lanes.
本发明构筑了一种众包时空大数据的高精度车道级道路测图技术方案,降低了获取城市精细道路信息的成本,且探测方法简单、容易实现。本发明所提供技术方案包括:首先,通过对比高精度车载GPS轨迹与其同步低精度GPS轨迹数据之间的空间相似度,采用基于经验知识的生长聚类方法,从众包轨迹数据中挑选出定位精度相对较高的数据;其次,构建垂直于轨迹数据的移动窗口;然后,采用优化后的高斯混合模型方法对处于道路路段的所有轨迹进行纵向探测,获取探测窗口内的车道数量;进一步,利用道路建设规则,也即,同一条路段只有在接近交叉口位置会出现增设车道的情况,而路段中间部分车道数量通常保持不变,提出车道数量优化策略,对车道数量信息进行修正;最后,利用修正后的车道数量信息,对已提取的车道中心线进行修正,完成相应路段车道级道路信息的提取。本发明得到的车道数量判断正确率为85%,车道中心线的定位精度在0.35m左右,降低了获取城市精细道路信息的成本,且探测方法简单、容易实现。The invention constructs a high-precision lane-level road mapping technical solution for crowdsourcing spatio-temporal big data, which reduces the cost of obtaining urban fine road information, and the detection method is simple and easy to implement. The technical solution provided by the present invention includes: firstly, by comparing the spatial similarity between the high-precision vehicle-mounted GPS trajectory and its synchronous low-precision GPS trajectory data, and using the growth clustering method based on empirical knowledge, the positioning accuracy is selected from the crowdsourced trajectory data. Relatively high data; secondly, construct a moving window perpendicular to the trajectory data; then, use the optimized Gaussian mixture model method to conduct longitudinal detection on all trajectories in the road section, and obtain the number of lanes in the detection window; further, use the road Construction rules, that is, the same road section will only add lanes near the intersection, and the number of lanes in the middle of the road section usually remains unchanged. An optimization strategy for the number of lanes is proposed to correct the information on the number of lanes; finally, use the correction The final lane number information is corrected for the extracted lane centerline, and the extraction of lane-level road information of the corresponding road section is completed. The correct rate of judging the number of lanes obtained by the invention is 85%, and the positioning accuracy of the center line of the lane is about 0.35m, which reduces the cost of acquiring urban fine road information, and the detection method is simple and easy to implement.
附图说明:Description of drawings:
图1是本发明实施例的方法流程图;Fig. 1 is the method flowchart of the embodiment of the present invention;
图2是本发明实施例的轨迹向量相似度示意图;Fig. 2 is a schematic diagram of trajectory vector similarity in an embodiment of the present invention;
图3是本发明实施例的基于经验知识的生长聚类示意图;Fig. 3 is a schematic diagram of growth clustering based on empirical knowledge according to an embodiment of the present invention;
图4是本发明实施例的基于经验知识的生长聚类方法轨迹优选结果示意图,其中图4a为众包轨迹数据实验区域示意图,图4b轨迹优选结果示意图;Fig. 4 is a schematic diagram of the trajectory optimization result of the growth clustering method based on empirical knowledge according to an embodiment of the present invention, wherein Fig. 4a is a schematic diagram of the experimental area of crowdsourcing trajectory data, and Fig. 4b is a schematic diagram of the trajectory optimization result;
图5是本发明实施例的高斯混合模型及车道中心线位置探测示意图,其中图5a为高斯混合模型优化结果,图5b为车道中心线位置探测结果;Fig. 5 is a schematic diagram of the Gaussian mixture model and the position detection of the lane centerline according to the embodiment of the present invention, wherein Fig. 5a is the optimization result of the Gaussian mixture model, and Fig. 5b is the detection result of the lane centerline position;
图6是本发明实施例的构建矩形窗口探测车道信息示意图;6 is a schematic diagram of building a rectangular window to detect lane information according to an embodiment of the present invention;
图7是本发明实施例的车道数量优化示意图;Fig. 7 is a schematic diagram of optimization of the number of lanes in an embodiment of the present invention;
图8是本发明实施例的车道数量探测结果示意图;Fig. 8 is a schematic diagram of the detection result of the number of lanes according to the embodiment of the present invention;
图9是本发明实施例的车道数量优化结果示意图。Fig. 9 is a schematic diagram of the optimization result of the number of lanes according to the embodiment of the present invention.
具体实施方式Detailed ways
以下结合附图和实施例详细说明本发明技术方案。The technical solution of the present invention will be described in detail below in conjunction with the drawings and embodiments.
本发明提供一种众包时空大数据的高精度车道级道路测图方法,参见图1,实施例包括如下步骤:The present invention provides a high-precision lane-level road mapping method for crowdsourcing spatiotemporal big data, referring to Fig. 1, the embodiment includes the following steps:
步骤1,建立轨迹向量的相似度评估模型。根据车辆行驶特点,一般驾驶员按照驾驶规则会沿着车道中心线行驶。因此,在不考虑短暂的变车道行为条件下,可以真实刻画驾驶员驾驶轨迹的高精度的轨迹数据通常集中在车道中心线附近,且相邻轨迹之间距离小于车道宽度,轨迹之间的航向角夹角趋近于0°左右。为了评估这种属于同一条车道中心线周围的轨迹之间的相似度,本发明建立了一种新的轨迹向量相似度评估模型,该相似度模型从轨迹向量之间的垂直距离和夹角两方面进行相似度度量,其中轨迹向量是指一条轨迹中由每一个轨迹点及其航向角构成的单位轨迹向量,也即这些轨迹向量的模都相同,且可以随意定义。两个轨迹向量的差异从方向和距离两方面度量。如图2所示,N表示正北方向,va<(xa,ya),(xa+1,ya+1)>和vb<(xb,yb),(xb+1,yb+1)>是两个不同的轨迹向量,矢量va和vb的方位角分别是θa和θb,相似度评价模型如下:Step 1. Establish a similarity evaluation model of trajectory vectors. According to the driving characteristics of the vehicle, the general driver will drive along the centerline of the lane according to the driving rules. Therefore, without considering the short-term lane-changing behavior, the high-precision trajectory data that can truly describe the driver's driving trajectory is usually concentrated near the centerline of the lane, and the distance between adjacent trajectories is smaller than the lane width. The included angle tends to be around 0°. In order to evaluate the similarity between the trajectories belonging to the center line of the same lane, the present invention establishes a new trajectory vector similarity evaluation model. In terms of similarity measurement, the trajectory vector refers to the unit trajectory vector composed of each trajectory point and its heading angle in a trajectory, that is, the modules of these trajectory vectors are the same and can be defined arbitrarily. The difference between two trajectory vectors is measured in terms of both direction and distance. As shown in Figure 2, N represents the true north direction, v a <(x a ,y a ),(x a+1 ,y a+1 )> and v b <(x b ,y b ),(x b +1 ,y b+1 )> are two different trajectory vectors, the azimuth angles of vectors v a and v b are θ a and θ b respectively, and the similarity evaluation model is as follows:
其中,表示向量之间的相似度值,且当相似度值为1时表示两个轨迹向量完全相同,相似度值为0时表示两个轨迹向量完全不相似;e为自然底数;ω1和ω2分别表示距离因子(diffHd)和角度因子(diffθab)的权重值,且ω1+ω2=1;diffHd和diffθab分别表示向量va和vb的距离差异和角度差异。公式8定义两个轨迹向量的距离差异diffHd,公式9定义了两个轨迹向量的角度差异diffθab:in, represents the similarity value between vectors, and When the similarity value is 1, it means that the two trajectory vectors are exactly the same, and when the similarity value is 0, it means that the two trajectory vectors are completely dissimilar; e is the natural base; ω 1 and ω 2 represent the distance factor (diff Hd ) and angle respectively The weight value of the factor (diff θab ), and ω 1 +ω 2 =1; diff Hd and diff θab represent the distance difference and angle difference of vectors v a and v b respectively. Equation 8 defines the distance difference diff Hd of two trajectory vectors, and Equation 9 defines the angle difference diff θab of two trajectory vectors:
公式8中的Disconfine由车道的宽度决定,是一个常量,用来约束相同车道上靠近每个车道中心线的GPS轨迹的相似度。Hdab向量va起点到vb起点的垂直距离,计算公式如公式11所示;Hdba是向量vb起点到向量va起点的垂直距离,计算公式如公式12所示;△θ是向量va与向量vb的航向角度差值,其中矢量va和vb的方位角分别是θa和θb,计算公式分别如下:Dis confine in Equation 8 is determined by the width of the lane and is a constant used to constrain the similarity of GPS trajectories close to the centerline of each lane on the same lane. Hd ab is the vertical distance from the starting point of vector v a to the starting point of v b , the calculation formula is shown in formula 11; Hd ba is the vertical distance from the starting point of vector v b to the starting point of vector v a , the calculation formula is shown in formula 12; △θ is the vector The heading angle difference between v a and vector v b , where the azimuth angles of vector v a and v b are θ a and θ b respectively, the calculation formulas are as follows:
Δθ=|θa-θb| 公式10Δθ=|θ a -θ b | Formula 10
步骤2,基于融合经验知识的生长聚类方法进行轨迹优选。高精度的轨迹点其轨迹向量之间的相似度值也相对较高。在进行轨迹优选时,首先需要已有的高精度GPS轨迹数据与其同步低精度GPS轨迹数据,提取轨迹优选的先验知识。实施例中,高精度DGPS轨迹和同步的低精度轨迹的精度分别为0.5m和10-15m,采样频率均为1s。按照步骤一建立的相似度估算模型计算低精度轨迹和DGPS轨迹的相似度,进行相似度评价模型权重值确定及经验知识获取。Step 2, trajectory optimization based on the growth clustering method fused with empirical knowledge. The similarity value between trajectory vectors of high-precision trajectory points is also relatively high. When performing trajectory optimization, the existing high-precision GPS trajectory data must be synchronized with the low-precision GPS trajectory data to extract prior knowledge of trajectory optimization. In the embodiment, the accuracy of the high-precision DGPS trajectory and the synchronous low-precision trajectory are 0.5m and 10-15m respectively, and the sampling frequency is 1s. Calculate the similarity between the low-precision trajectory and the DGPS trajectory according to the similarity estimation model established in step 1, and determine the weight value of the similarity evaluation model and acquire empirical knowledge.
1)相似度评价模型权重值确定1) Determine the weight value of the similarity evaluation model
相似度不仅用于DGPS和低精度GPS数据中提取先验知识,而且还用于众源数据聚类和优选,因此本发明进一步提出使用垂直距离、角度差异与测量误差的相关性来估计ω1和ω2的值。Similarity is not only used to extract prior knowledge from DGPS and low-precision GPS data, but also used for crowd source data clustering and optimization, so the present invention further proposes to use the correlation between vertical distance, angle difference and measurement error to estimate ω 1 and the value of ω2 .
对于GPS轨迹集合T=<Trace1,Trace2,…,Traces>,其包含s条GPS轨迹:Trace1,Trace2,…,Traces,轨迹集合T的同步高精度DGPS轨迹表示为DT=<Dt1,Dt2,…,Dts>,Dt1,Dt2,…,Dts是集合DT内的轨迹数据。轨迹集合DT和轨迹集合T的精度分别是0.5m和10-15m。假设第i条GPS轨迹Tracei=<p1,p2,…,pn>,p1,p2,…,pn分别表示轨迹Tracei的轨迹点,共有n个轨迹点;Dti=<rp1,rp2,…,rpn>,rp1,rp2,…,rpn则为轨迹Tracei的同步高精度轨迹Dti的轨迹点;Tracei∈T,Dti∈DT,i=1,2,…,s。由轨迹Tracei和其同步高精度轨迹Dti内的轨迹点,构成的轨迹向量表示为:Tvi=<v1,v2,…,vn-1>,v1,v2,…,vn-1分别表示为由轨迹Tracei的轨迹点p1与p2,…,pn-1与pn构成的轨迹向量;Dvi=<rv1,rv2,…,rvn-1>,rv1,rv2,…,rvn-1分别表示为由轨迹Tracei的同步高精度轨迹Dti轨迹点rp1与rp2,…,rpn-1与rpn构成的轨迹向量。Tvi和Dvi的距离和角度分别表示为:Di=<d1,d2,…,dn-1>,d1,d2,…,dn-1表示轨迹向量集合Tvi和Dvi内相对应的轨迹向量v1,v2,…,vn-1到rv1,rv2,…,rvn-1的距离;Ai=<a1,a2,…,an-1>,a1,a2,…,an-1表示轨迹向量集合Tvi和Dvi内相对应的轨迹向量v1,v2,…,vn-1与rv1,rv2,…,rvn-1的角度差异,i=1,2,…,s。轨迹集合T内所有的轨迹数据的定位误差可以表示为Ei=<ε1,ε2,…,εn>,其中Ei表示轨迹集合T内的轨迹Tracei所有轨迹点与其对应的同步高精度轨迹Dti的所有轨迹点的空间距离,εj是集合Ei内的任意一个误差值,其中εj=|pj-rpj|,pj为Tracei内任意一个轨迹点,rpj为pj相对应的高精度轨迹点,i=1,2,…,s,j=1,2,…,n。相似度评价模型中,权值ω1和ω2的计算公式分别如下(rDε和rAε分别表示Di和Ei的相关系数,可以基于协方差矩阵估计Ai和Ei的值):For the GPS track set T=<Trace 1 ,Trace 2 ,...,Trace s >, which contains s GPS tracks: Trace 1 ,Trace 2 ,...,Trace s , the synchronous high-precision DGPS track of the track set T is expressed as DT= <Dt 1 , Dt 2 , . . . , Dt s >, Dt 1 , Dt 2 , . . . , Dt s are trajectory data within the set DT. The accuracies of trajectory set DT and trajectory set T are 0.5m and 10-15m, respectively. Assume that the i-th GPS track Trace i =<p 1 , p 2 ,..., p n >, p 1 , p 2 ,..., p n represent the track points of the track Trace i respectively, and there are n track points in total; Dt i = <rp 1 ,rp 2 ,…,rp n >, rp 1 ,rp 2 ,…,rp n are the track points of the synchronous high-precision track Dt i of the track Trace i ; Trace i ∈ T, Dt i ∈ DT,i =1,2,...,s. The trajectory vector formed by the trajectory Trace i and the trajectory points in its synchronous high-precision trajectory Dt i is expressed as: Tv i =<v 1 ,v 2 ,...,v n-1 >, v 1 ,v 2 ,..., v n-1 is respectively represented as a trajectory vector composed of the trajectory points p 1 and p 2 ,...,p n-1 and p n of the trajectory Trace i ; Dv i =<rv 1 ,rv 2 ,...,rv n-1 >, rv 1 , rv 2 ,...,rv n-1 are respectively represented as trajectory vectors composed of the synchronous high-precision trajectory Dt i trajectory points rp 1 and rp 2 ,...,rp n-1 and rp n of the trajectory Trace i . The distance and angle of Tv i and Dv i are respectively expressed as: D i =<d 1 ,d 2 ,…,d n-1 >,d 1 ,d 2 ,…,d n-1 represents the trajectory vector set Tv i and The distance from the corresponding trajectory vector v 1 , v 2 ,…,v n-1 to rv 1 ,rv 2 ,…,rv n-1 in Dv i ; A i =<a 1 ,a 2 ,…,a n -1 >,a 1 ,a 2 ,…,a n-1 means the corresponding trajectory vector v 1 ,v 2 ,…,v n-1 and rv 1 ,rv 2 , in the trajectory vector set Tv i and Dv i ..., rv n-1 angle difference, i = 1, 2, ..., s. The positioning error of all the trajectory data in the trajectory set T can be expressed as E i =<ε 1 ,ε 2 ,…,ε n >, where E i represents the synchronous height of all the trajectory points in the trajectory Trace i in the trajectory set T and their corresponding The spatial distance of all track points in the precision track Dt i , ε j is any error value in the set E i , where ε j =|p j -rp j |, p j is any track point in Trace i , rp j is the high-precision trajectory point corresponding to p j , i=1,2,...,s, j=1,2,...,n. In the similarity evaluation model, the calculation formulas of weights ω 1 and ω 2 are as follows (r Dε and r Aε represent the correlation coefficients of D i and E i respectively, and the values of A i and E i can be estimated based on the covariance matrix):
ω2=1-ω1 公式14ω 2 =1-ω 1 Formula 14
2)先验知识提取2) Prior Knowledge Extraction
第一步:按照步骤1提出的向量相似度评价模型及权重值的确定,计算高精度DGPS与其同步低精度GPS之间的相似度,同时通过对比低精度GPS轨迹数据的位置和其同步高精度DGPS数据的位置,计算低精度GPS数据的测量误差;Step 1: According to the vector similarity evaluation model proposed in step 1 and the determination of weight values, calculate the similarity between high-precision DGPS and its synchronous low-precision GPS, and compare the location of low-precision GPS trajectory data with its synchronous high-precision The position of DGPS data, calculate the measurement error of low-precision GPS data;
第二步,根据第一步获得的相似度以及其对应的GPS测量误差,构建归属于同一个GPS轨迹数据的属性描述对,也即(相似度值,GPS测量误差)是某一个轨迹的属性描述对。In the second step, according to the similarity obtained in the first step and its corresponding GPS measurement error, an attribute description pair belonging to the same GPS trajectory data is constructed, that is, (similarity value, GPS measurement error) is an attribute of a certain trajectory Description right.
第三步,从GPS数据的属性描述对内,按照相似度阈值,也即从相似度值为0.5开始,选择出相似度值大于0.5,大于0.6,大于0.7…,大于0.9的所有GPS数据,并统计属于每一个相似度阈值内所有GPS数据的GPS测量误差,并计算这些GPS测量误差的平均值以及满足这些阈值的数据的个数占总体数据的比例。The third step is to select all GPS data whose similarity value is greater than 0.5, greater than 0.6, greater than 0.7..., greater than 0.9 according to the similarity threshold, that is, starting from the similarity value of 0.5, from the attribute description of the GPS data. And count the GPS measurement errors of all GPS data belonging to each similarity threshold, and calculate the average value of these GPS measurement errors and the ratio of the number of data meeting these thresholds to the overall data.
第四步,将第三步设定的相似度阈值(如:相似度阈值大于0.5,相似度阈值大于0.6….)定义为:Tsh,h=1,2,3,4,5;将满足这些阈值的GPS测量误差的平均值定义为Tsh,h=1,2,3,4,5;将满足阈值的GPS测量误差占总体数据的比例定义为:Perh,h=1,2,3,4,5;完成先验知识获取。In the fourth step, the similarity threshold set in the third step (such as: the similarity threshold is greater than 0.5, and the similarity threshold is greater than 0.6...) is defined as: Ts h , h=1,2,3,4,5; The average value of GPS measurement errors meeting these thresholds is defined as Ts h , h=1,2,3,4,5; the ratio of GPS measurement errors meeting the thresholds to the overall data is defined as: Per h , h=1,2 ,3,4,5; complete prior knowledge acquisition.
其中,STh表示满足Tsh的数据集,STh∈T,T是用于经验提取的实验数据的总体数据集,STh的百分比计算公式如下:Among them, ST h represents the data set that satisfies Ts h , ST h ∈ T, T is the overall data set of experimental data used for empirical extraction, and the calculation formula of the percentage of ST h is as follows:
Perh表示STh的百分比,N(STh)和N(T)是分别是STh和T轨迹点的数量,STh的计算公式为:Per h represents the percentage of ST h , N(ST h ) and N(T) are the number of ST h and T trajectory points respectively, and the calculation formula of ST h is:
Tεh是Tsh的测量误差,∑ε是STh中所有轨迹点误差的和,h=1,2,…,5,Tsh,Tεh,Perh记为RSTh=<Tsh,Tεh,Perh>,RSTh为先验知识集合,作为生长聚类方法的先验知识。Tε h is the measurement error of Ts h , ∑ε is the sum of all track point errors in ST h , h=1, 2,...,5, Ts h , Tε h , Per h is recorded as RST h =<Ts h , Tε h , Per h >, RST h is the prior knowledge set, which is the prior knowledge of the growth clustering method.
根据提取的先验知识,对相似度评价模型中的距离权值和角度权值进行计算,然后基于众包轨迹数据之间的相似度采用生长聚类方法进行数据优选,其中先验知识内的Tε是聚类的阈值,Per被用于从整个轨迹簇中选取高精度的数据的比例,参见图3(图3中vs表示种子向量,vsn表示与种子向量进行相似度计算的任意一个向量,Cluster1,Cluster2,Cluster3表示通过聚类后得到的几个轨迹向量类簇;图3中(d)部分内的‘Selected data’则表示最终被选取的轨迹数据),生长聚类方法的主要步骤如下:According to the extracted prior knowledge, the distance weight and angle weight in the similarity evaluation model are calculated, and then based on the similarity between crowdsourcing trajectory data, the growth clustering method is used for data optimization, in which the prior knowledge Tε is the threshold of clustering, Per is used to select the proportion of high-precision data from the entire trajectory cluster, see Figure 3 (v s in Figure 3 represents the seed vector, and v sn represents any one of the similarity calculations with the seed vector Vector, Cluster 1 , Cluster 2 , and Cluster 3 represent several trajectory vector clusters obtained after clustering; 'Selected data' in part (d) of Figure 3 represents the final selected trajectory data), growth clustering The main steps of the method are as follows:
第一步:初始化所有的轨迹向量,标记为未聚类;初始化当前类簇的编号(CCL),记CCL=1;Step 1: Initialize all trajectory vectors and mark them as unclustered; initialize the number of the current cluster (CC L ), record C L =1;
第二步:如果存在未聚类的轨迹向量,则从剩余的未聚类轨迹向量中随机选择一个轨迹向量作为种子轨迹向量vs,种子轨迹向量的聚类标记即为CL(vs),且CL(vs)=CCL,如图3中(a)部分,进入第三步;如果所有轨迹都已经被聚类,如图3中(c)部分,则进入第五步;Step 2: If there are unclustered trajectory vectors, randomly select a trajectory vector from the remaining unclustered trajectory vectors as the seed trajectory vector v s , and the clustering label of the seed trajectory vector is CL(v s ), And CL(v s )= C L , as shown in part (a) of Figure 3, enter the third step; if all trajectories have been clustered, as shown in Figure 3 (c), then enter the fifth step;
第三步:搜索vs临近的轨迹向量,记为vsn:如果满足Sim(vs,vsn)>Tε,将vs和vsn融合为一个轨迹簇,vsn的聚类标记记为CL(vsn),且CL(vsn)=CCL,进入第四步;如果找不到与当前种子向量vs满足相似度阈值的轨迹向量时,令CCL=CCL+1,返回第二步;(Sim(vs,vsn)是vs和vsn的相似度值,Tε是相似度阈值)Step 3: Search for the trajectory vector close to v s , denoted as v sn : If Sim(v s ,v sn )>Tε is satisfied, v s and v sn are fused into a trajectory cluster, and the clustering mark of v sn is denoted as CL(v sn ), and CL(v sn )=CC L , enter the fourth step; if no trajectory vector meeting the similarity threshold with the current seed vector v s is found, set CC L =CC L +1, return The second step; (Sim(v s ,v sn ) is the similarity value of v s and v sn , Tε is the similarity threshold)
第四步:令轨迹向量vsn作为种子轨迹vs,返回第三步,如图3中(b)部分;The fourth step: make the trajectory vector v sn as the seed trajectory v s , and return to the third step, as shown in part (b) of Figure 3;
第五步:根据第一步到第四步的运行结果,也即最终的聚类类簇,计算所有类簇内轨迹点数量占参与聚类轨迹点总数的比例,然后对所有的轨迹簇按照其轨迹点数占总体轨迹点数比值大小倒序排列,其中Per表示数据优选的选择度,从第一个类簇的轨迹点比例数开始累积求和直到满足Per,这些参与累积求和的类簇被作为高精度数据优选选取,如图3中(d)部分,选取的实验区域众包轨迹数据如图4a,轨迹优选的结果如图4b。Step 5: Calculate the ratio of the number of trajectory points in all clusters to the total number of trajectory points participating in the clustering based on the results of the first to fourth steps, that is, the final clustering cluster, and then calculate all trajectory clusters according to The ratio of the number of trajectory points to the total number of trajectory points is arranged in reverse order, where Per represents the optimal selectivity of the data. From the proportion of trajectory points of the first cluster, the cumulative summation is performed until Per is satisfied. These clusters participating in the cumulative summation are regarded as The optimal selection of high-precision data, as shown in part (d) of Figure 3, the crowdsourced trajectory data of the selected experimental area is shown in Figure 4a, and the result of trajectory optimization is shown in Figure 4b.
步骤3,构建高斯约束混合模型,并使用EM算法求解模型参数。在已有的高斯约束混合算法求取车道信息的算法基础上,本发明对其进行了优化。高斯约束混合模型定义如下:Step 3, build a Gaussian constrained mixture model, and use the EM algorithm to solve the model parameters. On the basis of the existing Gaussian constrained hybrid algorithm for obtaining lane information, the present invention optimizes it. A Gaussian constrained mixture model is defined as follows:
其中,p(x)表示为高斯约束混合模型的综合概率值,x表示待计算样本值(在进行车道计算时,x代表判断窗口内轨迹点在其纵剖面上垂直投影的纵坐标值);k是高斯成分的数量,也即约束高斯混合模型中高斯峰的个数,代表车道的数量,每一个高斯成分对应一个车道;ω1…ωk是每个成分的权重,对应每个车道的交通流量,其中权重值为正且被标准化,即ωj是第j个高斯成分的权重,ωj>0,j=1,2,…,k,ω1+ω2+…ωk=1;参数μ1…μk是每一个高斯成分中轨迹的平均值,等于每个车道的中心线,μj表示μ1…μk参数内的任意一个值,j=1,2,…,k;σ是每一个高斯成分中轨迹的标准差,并且由于每个车道与邻近车道的宽度通常相同,因此把σ设为一个常数,通常设定为1.75(根据国内道路建设标准,车道宽度一般为3.75m左右,在具体实施过程中,本领域技术人员可以按照所选区域道路建设标准进行重新设定)。使用EM法求解模型参数:θj (m)(ωj (m),μj (m),σ(m)),j=1,2,…,k,其中m是迭代次数。目前如何利用EM算法求解高斯混合模型的各个参数已经有很多成熟的方法,具体实施过程中,技术人员可以参考现有方法,本发明不予赘述。Among them, p(x) represents the comprehensive probability value of the Gaussian constrained mixture model, and x represents the sample value to be calculated (when performing lane calculation, x represents the ordinate value of the vertical projection of the trajectory point in the judgment window on its longitudinal section); k is the number of Gaussian components, that is, the number of Gaussian peaks in the constrained Gaussian mixture model, which represents the number of lanes, and each Gaussian component corresponds to a lane; ω 1 ... ω k is the weight of each component, corresponding to the weight of each lane Traffic flow, where the weight value is positive and normalized, that is, ω j is the weight of the jth Gaussian component, ω j >0,j=1,2,...,k,ω 1 +ω 2 +...ω k =1 ; The parameter μ 1 ... μ k is the average value of the trajectory in each Gaussian component, which is equal to the centerline of each lane, μ j represents any value in the parameters of μ 1 ... μ k , j = 1, 2, ..., k ;σ is the standard deviation of the trajectory in each Gaussian component, and since the width of each lane is usually the same as that of adjacent lanes, σ is set as a constant, usually set to 1.75 (according to domestic road construction standards, the lane width is generally About 3.75m, in the specific implementation process, those skilled in the art can reset according to the road construction standards of the selected area). Use the EM method to solve the model parameters: θ j (m) (ω j (m) , μ j (m) ,σ (m) ), j=1,2,...,k, where m is the number of iterations. At present, there are many mature methods on how to use the EM algorithm to solve the parameters of the Gaussian mixture model. In the specific implementation process, technical personnel can refer to the existing methods, and the present invention will not repeat them.
高斯约束混合模型的关键是获得高斯成分的数量,也即计算每一个k值对应下,结构风险模型的值,然后从其中选择出结构风险模型值最小时对应的k作为其车道数量。结构风险模型的构建方法如下所示:The key to the Gaussian constrained mixture model is to obtain the number of Gaussian components, that is, to calculate the value of the structural risk model corresponding to each value of k, and then select the k corresponding to the minimum value of the structural risk model as the number of lanes. The construction method of the structural risk model is as follows:
k=min(Rsrm(p(xi|θk))) 公式19k=min(R srm (p(x i |θ k ))) Formula 19
L(xi,p(xi|θk))=-log(p(xi|θk)) 公式20L(x i ,p(x i |θ k ))=-log(p(x i |θ k )) Formula 20
公式2中的Rsrm(p(xi|θk))是结构风险模型,L(xi,p(xi|θk))是用于评估适合度的经验风险模型,J(p(xi|θk))是正则项,用于标示模型复杂度,也即表示为:JTSW(p(xi|θk)),λ>0是正则参数,p(xi|θk)表示样本值xi在模型参数θk条件下的高斯概率值,其中模型参数θk可表示为:θk(ωk,μk,σ),n表示样本的个数,i=1,2,…,n;计算公式如下:R srm (p( xi |θ k )) in Equation 2 is a structural risk model, L( xi ,p( xi |θ k )) is an empirical risk model for assessing fitness, J(p( x i |θ k )) is a regular term, which is used to mark the complexity of the model, which is expressed as: J TSW (p(x i |θ k )), λ>0 is a regular parameter, p(x i |θ k ) represents the Gaussian probability value of the sample value x i under the condition of the model parameter θ k , where the model parameter θ k can be expressed as: θ k (ω k ,μ k ,σ), n represents the number of samples, i=1, 2,...,n; the calculation formula is as follows:
其中Dw是优化后的轨迹在道路路面的平铺宽度,如图5,图5a内长虚线标示的‘1stGaussian component’表示高斯混合模型的第一个成分,短虚线标示的’2ndGaussiancomponent’表示高斯混合模型的第二个成分;其中位于图5b中的参数μ1、μ2则分别对应为图5a内第一个高斯成分的均值及第二个高斯成分的均值,也即为第一个车道的车道中心线位置和第二个车道的车道中心线位置。(如何获取轨迹在道路路面的平铺宽度目前已经有很多方法提出,具体实施过程中,本领域技术人员可自行选取,本发明不予赘述),其中k表示可能存在的车道数量,按照目前国内道路建设标准,城市车道数量一般包括两车道,三车道,四车道,五车道,也即k=2,3,4,5。Δμk是k对应的高斯成分中两个临近高斯峰的平均值μj的变化值,其变化值也反映了探测车道宽度,j=1,2,…,k。Δμk的计算方法如公式6,公式6内κ、η、γij为基于最大后验估计的EM算法的超参数;x表示样本值(在进行车道计算时,x表示判断窗口内轨迹点在其纵剖面上垂直投影的纵坐标值);n表示样本数据的个数,ωj+1表示第j+1个高斯成分的权重值,j=1,2,…,k-1,k为高斯成分数,k=2,3,4,5;现有研究中已有非常成熟的参数推荐,具体实施时可以参考现有方法案例中给出的数值进行计算,具体不再赘述。Among them, Dw is the tile width of the optimized trajectory on the road surface, as shown in Figure 5, the '1 st Gaussian component' marked by the long dashed line in Figure 5a represents the first component of the Gaussian mixture model, and the ' 2nd Gaussian component' marked by the short dashed line Gaussiancomponent' represents the second component of the Gaussian mixture model; the parameters μ 1 and μ 2 in Figure 5b correspond to the mean value of the first Gaussian component and the mean value of the second Gaussian component in Figure 5a respectively, that is, The lane centerline location of the first lane and the lane centerline location of the second lane. (how to obtain the tiling width of the track on the road surface has many methods to propose at present, in the specific implementation process, those skilled in the art can choose by themselves, the present invention will not repeat them), wherein k represents the number of possible lanes, according to the current domestic According to road construction standards, the number of urban lanes generally includes two lanes, three lanes, four lanes, and five lanes, that is, k=2,3,4,5. Δμ k is the change value of the average value μ j of two adjacent Gaussian peaks in the Gaussian component corresponding to k, and its change value also reflects the detection lane width, j=1,2,...,k. The calculation method of Δμ k is shown in Formula 6. In Formula 6, κ, η, and γ ij are the hyperparameters of the EM algorithm based on maximum a posteriori estimation; x represents the sample value (when performing lane calculation, x represents the trajectory point in the judgment window ordinate value of the vertical projection on its longitudinal section); n represents the number of sample data, ω j+1 represents the weight value of the j+1th Gaussian component, j=1,2,...,k-1, k is Number of Gaussian components, k=2, 3, 4, 5; there are very mature parameter recommendations in the existing research, and the specific implementation can refer to the values given in the existing method cases for calculation, and the details will not be repeated.
步骤4,根据步骤3所述的优化后的高斯混合模型方法,完成高精度车道级道路测图,实现探测车道信息,得到道路路段车道数量初次探测结果。在具体实施高精度车道级道路测图过程中,利用现有方法将处于同一条路段上的所有轨迹作为一个提取单元(具体如何将同一条路段上的所有轨迹归为一个提取单元,目前已经有很多成熟方法,具体实施过程中本领域技术人员可以参见现有方法,本发明不予赘述)。Step 4. According to the optimized Gaussian mixture model method described in step 3, complete high-precision lane-level road mapping, realize detection of lane information, and obtain the initial detection result of the number of lanes in the road section. In the process of implementing high-precision lane-level road mapping, use existing methods to use all trajectories on the same road segment as an extraction unit (specifically, how to classify all trajectories on the same road segment into an extraction unit, currently there are There are many mature methods, those skilled in the art can refer to the existing methods during the specific implementation process, and the present invention will not repeat them).
假设给定一组从交叉口Intersection1到交叉口Intersection2的轨迹集合AT,从轨迹集合AT的一端开始,构建移动矩形窗口,如图6所示。移动矩形窗口的长度和宽度分别为rh和rw(矩形窗口的长和宽推荐定义为10m和30m,具体实施时本领域技术人员可自行预设取值),其中移动矩形窗口的长边平行于当前覆盖所有轨迹的中心线,移动矩形窗口的宽边则垂直于当前覆盖所有轨迹的中心线,矩形窗口长边的中心线垂直于其覆盖的所有轨迹数据的中心线,矩形窗口宽边的中线与其覆盖的轨迹数据的中心线重合,如何得到一段轨迹数据的中心线,目前已经有很多方法,具体实施过程中本领域技术人员可以参见现有方法,本发明不予赘述。Assume that a set of trajectory sets A T from intersection Intersection 1 to intersection Intersection 2 is given, and a moving rectangular window is constructed from one end of the trajectory set A T , as shown in Figure 6. The length and width of the moving rectangular window are rh and rw respectively (the length and width of the rectangular window are recommended to be defined as 10m and 30m, and those skilled in the art can preset the values during specific implementation), wherein the long side of the moving rectangular window is parallel to The center line of all tracks currently covered, the wide side of the moving rectangular window is perpendicular to the center line of all tracks currently covered, the center line of the long side of the rectangular window is perpendicular to the center line of all track data covered by it, and the center line of the wide side of the rectangular window How to obtain the centerline of a piece of trajectory data coincident with the centerline of the track data covered by it, there are many methods at present, those skilled in the art can refer to the existing methods in the specific implementation process, and the present invention will not repeat them.
实施例进一步提供的优选实现方式如下:The preferred implementation mode further provided by the embodiment is as follows:
将移动矩形窗口从轨迹集合AT的一端开始,按照矩形窗口的长边长度开始平移,依次利用高斯约束混合模型来探测每一个矩形窗口内覆盖的路段的车道数量及车道中心线。具体方法包括:根据构建好的矩形窗口,将矩形窗口内的所有轨迹点投影到矩形窗口的长边中心线上,得到投影后的轨迹数据集X=(x1,x2,…,xN),t=1,2,3,…,N,其中,xt表示投影后第t个轨迹点的纵坐标值,N为参加投影轨迹点的个数。按照步骤3所述,将轨迹数据集X代入相应计算公式(即公式17所示高斯约束混合模型),提取矩形窗口内路段的车道数量和车道中心线。假设从交叉口Intersection1到交叉口Intersection2的轨迹集合AT,矩形窗口一共进行了l次平移,每一次平移确定的车道数量记为Nlanef,f=1,2,…,l,作为道路路段车道数量初次探测结果。The moving rectangular window starts from one end of the trajectory set AT , and starts to translate according to the length of the long side of the rectangular window, and uses the Gaussian constraint mixture model to detect the number of lanes and the lane centerline of the road section covered in each rectangular window. The specific method includes: according to the constructed rectangular window, project all the trajectory points in the rectangular window onto the center line of the long side of the rectangular window to obtain the projected trajectory data set X=(x 1 ,x 2 ,…,x N ), t=1, 2, 3, ..., N, where x t represents the ordinate value of the tth trajectory point after projection, and N is the number of trajectory points participating in the projection. As described in step 3, the trajectory data set X is substituted into the corresponding calculation formula (that is, the Gaussian constrained mixture model shown in formula 17), and the number of lanes and the lane centerline of the road section in the rectangular window are extracted. Assuming that the trajectory set A T from the intersection Intersection 1 to the intersection Intersection 2 , the rectangular window has been translated l times in total, and the number of lanes determined by each translation is recorded as Nlane f , f=1,2,...,l, as the road The initial detection result of the number of lanes in the road segment.
步骤5,根据步骤4获取的道路路段车道数量初次探测结果,基于道路建设规则,提出车道数量优化策略,对初次探测结果进行修正,如图7所示,有路段Part1、Part2、Part3,其中Part1和Part3存在增设车道区域。大多数情况下,在两个交叉口之间的路段总是在靠近交叉口附近处会出现增设车道,而路段中间部分车道数量通常保持不变,因此本发明提出一种优化车道数量提取结果的方法,具体方法如下:Step 5: According to the initial detection result of the number of lanes in the road section obtained in step 4, based on the road construction rules, an optimization strategy for the number of lanes is proposed, and the initial detection result is corrected. As shown in Figure 7, there are road sections Part 1 , Part 2 , and Part 3 , where there are additional lane areas in Part 1 and Part 3 . In most cases, the road section between two intersections will always have additional lanes near the intersection, while the number of lanes in the middle of the road section usually remains unchanged. Therefore, the present invention proposes a method for optimizing the extraction results of the number of lanes. method, the specific method is as follows:
第一步:对于步骤4中某次平移确定的车道数量Nlanef,比较Nlanef+1和Nlanef、Nlanef+2,如果Nlanef和Nlanef+1是不同的,则用Nlanef替换Nlanef+1,f=1,2,…,l-2。Step 1: For the number of lanes Nlane f determined by a translation in step 4, compare Nlane f+1 with Nlane f and Nlane f+2 , if Nlane f and Nlane f+1 are different, replace Nlane with Nlane f f+1 , f=1,2,...,l-2.
第二步:根据Nlanef的值和分布对第一步的结果分类,例如如果Nlanee,Nlanee+1,Nlanee+2,…,Nlanee+c的值相同则被分为一类,其中e<l,e+c<l。假设存在s个类,记为Cg=<Nlg,ncg>,Nlg是类簇Cg的车道数量,ncg是Nlaneg中属于Cg,g=1,2,…,s的总数量。The second step: Classify the results of the first step according to the value and distribution of Nlane f , for example, if the values of Nlane e , Nlane e+1 , Nlane e+2 ,...,Nlane e+c are the same, they are classified into one category, where e<l, e+c<l. Suppose there are s classes, recorded as C g =<Nl g , nc g >, Nl g is the number of lanes of cluster C g , nc g is the number of lanes belonging to C g , g=1,2,...,s in Nlane g The total number.
第三步:比较Cg+1和Cg,如果Nlg+1不同于Nlg,且ncg+1<cv(cv是一个依赖于道路修建规则的阈值,其修改规则主要体现在城市道路在接近交叉口时,出现增设车道的缓冲区范围,例如:按照当前道路设计规定,车道增设的长度为50m左右,也即从位于交叉口处的路段,其新增车道的长度为50m,因此当车道数量判断的分割段设为10米,本发明推荐将cv设为5,具体实施时本领域技术人员可自行预设取值),令Cg的Nlg替换Cg+1的Nlg+1,g=1,2,…,s,完成车道数量结果的最终优化。车道数量探测结果如图8,车道数量探测优化如图9(其中图8的横坐标表示移动窗口进行滑动探测过程中的移动数量,纵坐标则表示每一次滑动探测过程的车道数量探测结果)。Step 3: Compare C g+1 and C g , if Nl g+1 is different from Nl g , and nc g+1 < cv (cv is a threshold value that depends on road construction rules, and its modification rules are mainly reflected in urban roads When approaching the intersection, there is a buffer area for adding lanes. For example, according to the current road design regulations, the length of the lane addition is about 50m, that is, the length of the new lane is 50m from the road section at the intersection, so When the division section of the lane quantity judgment is set to 10 meters, the present invention recommends that cv be set to 5, and those skilled in the art can preset the value voluntarily during specific implementation), so that the Nl g of C g replaces the Nl g of C g +1 +1 , g=1,2,…,s, complete the final optimization of the number of lanes. The detection result of the number of lanes is shown in Figure 8, and the detection optimization of the number of lanes is shown in Figure 9 (the abscissa in Figure 8 represents the number of movements during the sliding detection process of the moving window, and the vertical coordinate represents the detection result of the number of lanes in each sliding detection process).
步骤6,根据步骤5得到的修正后的车道数量,对其相对应的车道中心线进行修正。当某一段路段的车道数量被修正后,其对应的车道中心线则采用相邻原则也被修正。具体方法包括:In step 6, according to the corrected number of lanes obtained in step 5, the corresponding lane centerline is corrected. When the number of lanes in a section of road is corrected, the corresponding centerline of the lane is also corrected using the principle of adjacency. Specific methods include:
假设某一段路段La的车道数量被修正,那么寻找La前后相邻路段,如果La相邻路段Lb和Lc同时满足与La具有相同的车道数量,且这些路段修正前与修正后的车道数量并未发生变化,那么就将Lb与Lc的车道中心线连接,得到La最终的车道中心线;如果La相邻路段Lb或者Lc的车道数量修正前与修正后也发生变化,那么就根据La修正前提取的车道中心线位置,计算基于La修正前车道中心线位置推算La路段的道路中心线,(如何根据La修正前车道中心线位置推算La路段的道路中心线,目前已有成熟方法,具体不在赘述)按照La修正后车道宽度和车道数量重新定义La修正后的车道中心线位置,也即从根据La路段的道路中心线开始依次按照车道数量和车道宽度等距离平行于道路中心线得到La修正后每一个车道的车道中心线位置。Assuming that the number of lanes of a certain road segment La has been corrected, then the adjacent road segments before and after La are searched. If the road segments Lb and Lc adjacent to La have the same number of lanes as La at the same time, and the number of lanes of these road segments before and after correction is not the same If there is a change, then connect Lb with the lane centerline of Lc to obtain the final lane centerline of La; if the number of lanes of Lb or Lc adjacent to La also changes before and after correction, then extract according to La before correction The position of the center line of the lane, the calculation is based on the position of the center line of the lane before the correction of La to calculate the center line of the road in the La section. ) Redefine the position of the centerline of the lane after La correction according to the lane width and the number of lanes after La correction, that is, starting from the road centerline according to the La road section, the number of lanes and the lane width are equidistant parallel to the road centerline to obtain the La correction The lane centerline position of each lane.
基于本发明,可以方便地从GPS轨迹数据中获取待城市道路的车道信息,为未来智能导航及无人驾驶提供基础路网数据。Based on the present invention, it is possible to conveniently obtain the lane information of the urban road from the GPS trajectory data, and provide basic road network data for future intelligent navigation and unmanned driving.
具体实施时,本发明所提供方法可基于软件技术实现自动运行流程,也可采用模块化方式实现相应系统。During specific implementation, the method provided by the present invention can realize the automatic operation process based on software technology, and can also realize the corresponding system in a modular manner.
本发明提供一种基于众包时空大数据的车道级道路测图系统,包括以下模块,The present invention provides a lane-level road mapping system based on crowdsourcing spatiotemporal big data, which includes the following modules,
第一模块,用于建立轨迹向量的相似度评估模型,设va和vb是两个不同的轨迹向量,所述相似度评价模型如下,The first module is used to establish a similarity evaluation model of trajectory vectors, assuming v a and v b are two different trajectory vectors, and the similarity evaluation model is as follows,
其中,表示向量之间的相似度值,e为自然底数,ω1和ω2分别表示距离因子diffHd和角度因子diffθab的权重值,且ω1+ω2=1;距离因子diffHd和角度因子diffθab分别表示向量va和vb的距离差异和角度差异;in, Represents the similarity value between vectors, e is the natural base, ω 1 and ω 2 represent the weight values of distance factor diff Hd and angle factor diff θab respectively, and ω 1 +ω 2 =1; distance factor diff Hd and angle factor diff θab represents the distance difference and angle difference of vectors v a and v b respectively;
第二模块,用于基于融合经验知识的生长聚类方法进行轨迹优选,包括根据已有的高精度GPS轨迹数据与同步的低精度GPS轨迹数据,确定相似度评价模型的权重值ω1和ω2,提取轨迹优选的先验知识,基于众包轨迹数据之间的相似度采用生长聚类方式进行数据优选;The second module is used to optimize the trajectory based on the growth clustering method based on the fusion of empirical knowledge, including determining the weight values ω 1 and ω of the similarity evaluation model based on the existing high-precision GPS trajectory data and the synchronized low-precision GPS trajectory data 2. Extract the prior knowledge of trajectory optimization, and use the growth clustering method to optimize data based on the similarity between crowdsourced trajectory data;
第三模块,用于构建高斯约束混合模型,并使用EM算法求解模型参数;所述高斯约束混合模型定义如下,The third module is used to construct the Gaussian constraint mixture model, and use the EM algorithm to solve the model parameters; the Gaussian constraint mixture model is defined as follows,
其中,p(x)表示为高斯约束混合模型的综合概率值,x表示待计算样本值,在进行车道计算时,x代表判断窗口内轨迹点在其纵剖面上垂直投影的纵坐标值;k是高斯成分的数量,每一个高斯成分对应一个车道;ωj是第j个高斯成分的权重,对应车道的交通流量;参数μ1…μk是每一个高斯成分中轨迹的平均值,等于每个车道的中心线,μj表示μ1…μk参数内的任意一个值,j=1,2,…,k;σ是每一个高斯成分中轨迹的标准差;Among them, p(x) represents the comprehensive probability value of the Gaussian constrained mixture model, and x represents the sample value to be calculated. When calculating the lane, x represents the ordinate value of the vertical projection of the trajectory point in the judgment window on its longitudinal section; k is the number of Gaussian components, and each Gaussian component corresponds to a lane; ω j is the weight of the jth Gaussian component, corresponding to the traffic flow of the lane; the parameter μ 1 ...μ k is the average value of the trajectory in each Gaussian component, equal to each The center line of each lane, μ j represents any value in μ 1 ...μ k parameters, j=1,2,...,k; σ is the standard deviation of the trajectory in each Gaussian component;
所述高斯约束混合模型中高斯成分的数量k获取方式为,计算结构风险模型的值,以结构风险模型值最小为原则确定k;The method for obtaining the quantity k of Gaussian components in the Gaussian constrained mixture model is to calculate the value of the structural risk model, and determine k based on the principle that the value of the structural risk model is the smallest;
第四模块,用于根据第三模块所得结果,探测车道信息,得到道路路段车道数量初次探测结果;实现方式如下,The fourth module is used to detect lane information according to the results obtained in the third module, and obtain the initial detection result of the number of lanes in road sections; the implementation method is as follows,
将处于同一条路段上的所有轨迹作为一个提取单元,设给定一组从交叉口Intersection1到交叉口Intersection2的轨迹集合AT,从轨迹集合AT的一端开始,构建移动矩形窗口,其中移动矩形窗口的长边平行于当前覆盖所有轨迹的中心线,移动矩形窗口的宽边则垂直于当前覆盖所有轨迹的中心线,矩形窗口长边的中心线垂直于其覆盖的所有轨迹数据的中心线,矩形窗口宽边的中线与其覆盖的轨迹数据的中心线重合;Taking all the trajectories on the same road segment as an extraction unit, set a set of trajectories A T from the intersection Intersection 1 to the intersection Intersection 2 , and start from one end of the trajectory set A T to construct a moving rectangular window, where The long side of the moving rectangular window is parallel to the center line of all tracks currently covered, the wide side of the moving rectangular window is perpendicular to the center line of all tracks currently covered, and the center line of the long side of the rectangular window is perpendicular to the center of all track data it covers Line, the center line of the wide side of the rectangular window coincides with the center line of the covered trajectory data;
将移动矩形窗口从轨迹集合AT的一端开始,按照矩形窗口的长边长度开始平移,依次利用高斯约束混合模型来探测每一个矩形窗口内覆盖的路段的车道数量及车道中心线,包括根据移动矩形窗口,将移动矩形窗口内的所有轨迹点投影到矩形窗口的长边中心线上,得到投影后的轨迹数据集X=(x1,x2,…,xN),t=1,2,3,…,N,其中,xt表示投影后第t个轨迹点的纵坐标值,N为参加投影轨迹点的个数;将轨迹数据集X代入高斯约束混合模型,提取矩形窗口内路段的车道数量和车道中心线;假设从交叉口Intersection1到交叉口Intersection2的轨迹集合AT,矩形窗口一共进行了l次平移,每一次平移确定的车道数量记为Nlanef,f=1,2,…,l,作为道路路段车道数量初次探测结果;Start the moving rectangular window from one end of the trajectory set AT , and start to translate according to the length of the long side of the rectangular window, and then use the Gaussian constraint mixture model to detect the number of lanes and lane centerlines of the road sections covered in each rectangular window, including moving Rectangular window, project all trajectory points in the moving rectangular window onto the center line of the long side of the rectangular window, and obtain the projected trajectory data set X=(x 1 ,x 2 ,…,x N ), t=1,2 ,3,...,N, where x t represents the ordinate value of the tth trajectory point after projection, and N is the number of trajectory points participating in the projection; Substitute the trajectory data set X into the Gaussian constraint mixture model to extract the road section in the rectangular window The number of lanes and the centerline of the lanes; assuming the trajectory set A T from intersection Intersection 1 to intersection Intersection 2 , the rectangular window has been translated l times in total, and the number of lanes determined by each translation is recorded as Nlane f , f=1, 2,...,l, as the initial detection results of the number of lanes in the road segment;
第五模块,用于根据第四模块获取的道路路段车道数量初次探测结果,基于道路建设规则,对初次探测结果进行修正;The fifth module is used to correct the initial detection results based on the road construction rules according to the initial detection results of the number of lanes in the road section obtained by the fourth module;
第六模块,用于根据第五模块得到的修正后的车道数量,根据相邻情况对车道中心线进行修正。The sixth module is used to correct the centerline of the lane according to the adjacent situation according to the corrected number of lanes obtained by the fifth module.
各模块具体实现可参见相应步骤,本发明不予赘述。For the specific implementation of each module, reference may be made to the corresponding steps, which will not be described in detail in the present invention.
本文中所描述的具体实施例仅仅是对本发明精神作举例说明。本发明所属技术领域的技术人员可以对所描述的具体实施例做各种各样的修改或补充或采用类似的方式替代,但并不会偏离本发明的精神或超越所附权利要求书所定义的范围。The specific embodiments described herein are merely illustrative of the spirit of the invention. Those skilled in the art to which the present invention belongs can make various modifications or supplements to the described specific embodiments or replace them in similar ways, but they will not deviate from the spirit of the present invention or go beyond the definition of the appended claims range.
Claims (6)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610370700.9A CN105957342B (en) | 2016-05-30 | 2016-05-30 | Track grade road plotting method and system based on crowdsourcing space-time big data |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610370700.9A CN105957342B (en) | 2016-05-30 | 2016-05-30 | Track grade road plotting method and system based on crowdsourcing space-time big data |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105957342A CN105957342A (en) | 2016-09-21 |
CN105957342B true CN105957342B (en) | 2018-05-29 |
Family
ID=56910078
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610370700.9A Active CN105957342B (en) | 2016-05-30 | 2016-05-30 | Track grade road plotting method and system based on crowdsourcing space-time big data |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105957342B (en) |
Families Citing this family (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
BR112018006470A2 (en) * | 2015-09-30 | 2020-06-09 | Nissan Motor | displacement control method and displacement control apparatus |
CN108664016B (en) * | 2017-03-31 | 2020-09-15 | 腾讯科技(深圳)有限公司 | Method and device for determining lane center line |
CN109579839B (en) * | 2017-09-29 | 2020-11-03 | 阿里巴巴(中国)有限公司 | Parallel path identification method, parallel path similarity determination method and device |
CN107818577A (en) * | 2017-10-26 | 2018-03-20 | 滁州学院 | A kind of Parts Recognition and localization method based on mixed model |
CN110443285A (en) * | 2019-07-16 | 2019-11-12 | 浙江大华技术股份有限公司 | The determination method, apparatus and computer storage medium of similar track |
US11195027B2 (en) * | 2019-08-15 | 2021-12-07 | Toyota Motor Engineering And Manufacturing North America, Inc. | Automated crowd sourcing of road environment information |
CN110728735A (en) * | 2019-09-17 | 2020-01-24 | 武汉中海庭数据技术有限公司 | Road-level topological layer construction method and system |
CN110634291B (en) * | 2019-09-17 | 2020-12-29 | 武汉中海庭数据技术有限公司 | High-precision map topology automatic construction method and system based on crowdsourcing data |
CN110749329B (en) * | 2019-10-26 | 2021-08-17 | 武汉中海庭数据技术有限公司 | Lane level topology construction method and device based on structured road |
CN111288999B (en) * | 2020-02-19 | 2021-08-31 | 深圳大学 | A mobile terminal-based pedestrian road network attribute detection method, device and equipment |
CN111341103B (en) * | 2020-03-03 | 2021-04-27 | 鹏城实验室 | Lane information extraction method, device, device and storage medium |
CN111578964B (en) * | 2020-04-13 | 2022-01-07 | 河北德冠隆电子科技有限公司 | High-precision map road information rapid generation system and method based on space-time trajectory reconstruction |
CN111858801B (en) * | 2020-06-30 | 2024-03-22 | 北京百度网讯科技有限公司 | Road information mining method and device, electronic equipment and storage medium |
CN112150804B (en) * | 2020-08-31 | 2021-10-19 | 中国地质大学(武汉) | City multi-type intersection identification method based on MaskRCNN algorithm |
CN112115817B (en) * | 2020-09-01 | 2024-06-07 | 国交空间信息技术(北京)有限公司 | Remote sensing image road track correctness checking method and device based on deep learning |
CN112308961B (en) * | 2020-11-05 | 2022-06-10 | 湖南大学 | A Fast and Robust 3D Reconstruction Method for Robots Based on Hierarchical Gaussian Mixture Model |
CN112488217B (en) * | 2020-12-05 | 2022-07-29 | 武汉中海庭数据技术有限公司 | Zebra crossing correction method, electronic device and storage medium |
CN112733078B (en) * | 2020-12-29 | 2023-10-10 | 武汉中海庭数据技术有限公司 | Method and device for smooth connection among multiple paths of fragments of crowdsourcing data |
CN112683286A (en) * | 2021-03-16 | 2021-04-20 | 季华实验室 | Method and system for establishing topological road network map, storage medium and electronic equipment |
CN113453157B (en) * | 2021-08-31 | 2021-11-23 | 浙江宇视科技有限公司 | Time-space trajectory calibration method and device, storage medium and electronic equipment |
CN115507874B (en) * | 2022-06-09 | 2024-03-01 | 广东省智能网联汽车创新中心有限公司 | Lane matching method and device based on V2X |
CN115457767B (en) * | 2022-08-30 | 2023-08-29 | 同济大学 | Lane information extraction method based on crowdsourcing machine motor car track |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8116968B2 (en) * | 2008-12-23 | 2012-02-14 | National Chiao Tung University | Method for identification of traffic lane boundary |
CN103903019B (en) * | 2014-04-11 | 2017-12-15 | 北京工业大学 | A kind of automatic generation method of multilane track of vehicle space-time diagram |
US10013508B2 (en) * | 2014-10-07 | 2018-07-03 | Toyota Motor Engineering & Manufacturing North America, Inc. | Joint probabilistic modeling and inference of intersection structure |
CN104700617B (en) * | 2015-04-02 | 2016-03-16 | 武汉大学 | Based on the high precision track information extracting method of low precision GPS track data |
CN105138779B (en) * | 2015-08-31 | 2018-03-27 | 武汉大学 | Vehicle GPS space-time track big data method for optimizing and system |
CN105444770B (en) * | 2015-12-18 | 2018-05-29 | 上海交通大学 | Track level map generation and localization method based on smart mobile phone |
-
2016
- 2016-05-30 CN CN201610370700.9A patent/CN105957342B/en active Active
Also Published As
Publication number | Publication date |
---|---|
CN105957342A (en) | 2016-09-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105957342B (en) | Track grade road plotting method and system based on crowdsourcing space-time big data | |
US11681746B2 (en) | Structured prediction crosswalk generation | |
EP3271748B1 (en) | Guided geometry extraction for localization of a device | |
AU2019201834B2 (en) | Geometric fingerprinting for localization of a device | |
EP3237923B1 (en) | Localization of a device using multilateration | |
Yang et al. | Generating lane-based intersection maps from crowdsourcing big trace data | |
EP3238494B1 (en) | Selecting feature geometries for localization of a device | |
CN108171131B (en) | Improved MeanShift-based method for extracting Lidar point cloud data road marking line | |
CN110246159A (en) | The 3D target motion analysis method of view-based access control model and radar information fusion | |
Tang et al. | CLRIC: Collecting lane-based road information via crowdsourcing | |
WO2016103026A2 (en) | Extracting feature geometries for localization of a device | |
CN111006655A (en) | Multi-scene autonomous navigation positioning method for airport inspection robot | |
CN114357019A (en) | Method for monitoring data quality of road side sensing unit in intelligent networking environment | |
CN114509065B (en) | Map construction method, system, vehicle terminal, server and storage medium | |
Jang et al. | Road lane semantic segmentation for high definition map | |
CN111126363A (en) | Object recognition and distance measurement method and device for automatic driving vehicle | |
WO2020118623A1 (en) | Method and system for generating an environment model for positioning | |
CN117876612B (en) | Route fitting design method based on unmanned aerial vehicle oblique photography | |
Ezzat et al. | Extracting road turns and intersections from crowd source GPS tracks | |
Tian et al. | Scalable High-Definition Map Generation through Crowdsourcing | |
CN118640910A (en) | A ROS unmanned vehicle mapping and navigation method in unstructured environments | |
CN117948963A (en) | Map construction method, device, equipment and storage medium | |
Lu | Contributions to Lane Marking Based Localization for Intelligent Vehicles |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |