CN114633747A - 一种基于变道场景数据的典型变道轨迹确定方法、装置及计算机存储介质 - Google Patents
一种基于变道场景数据的典型变道轨迹确定方法、装置及计算机存储介质 Download PDFInfo
- Publication number
- CN114633747A CN114633747A CN202210131679.2A CN202210131679A CN114633747A CN 114633747 A CN114633747 A CN 114633747A CN 202210131679 A CN202210131679 A CN 202210131679A CN 114633747 A CN114633747 A CN 114633747A
- Authority
- CN
- China
- Prior art keywords
- track
- lane
- speed
- trajectory
- lane change
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/18—Propelling the vehicle
- B60W30/18009—Propelling the vehicle related to particular drive situations
- B60W30/18163—Lane change; Overtaking manoeuvres
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F18/00—Pattern recognition
- G06F18/20—Analysing
- G06F18/23—Clustering techniques
- G06F18/232—Non-hierarchical techniques
- G06F18/2321—Non-hierarchical techniques using statistics or function optimisation, e.g. modelling of probability density functions
- G06F18/23213—Non-hierarchical techniques using statistics or function optimisation, e.g. modelling of probability density functions with fixed number of clusters, e.g. K-means clustering
Landscapes
- Engineering & Computer Science (AREA)
- Data Mining & Analysis (AREA)
- Physics & Mathematics (AREA)
- Mechanical Engineering (AREA)
- Transportation (AREA)
- Automation & Control Theory (AREA)
- Theoretical Computer Science (AREA)
- Evolutionary Computation (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Biology (AREA)
- Bioinformatics & Computational Biology (AREA)
- General Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Bioinformatics & Cheminformatics (AREA)
- Artificial Intelligence (AREA)
- Human Computer Interaction (AREA)
- Life Sciences & Earth Sciences (AREA)
- Probability & Statistics with Applications (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Traffic Control Systems (AREA)
Abstract
一种基于变道场景数据的典型变道轨迹确定方法、装置及计算机存储介质,涉及自动驾驶技术领域。解决了现有变道轨迹的提取技术存在的轨迹公共特征的提取率较低以及由于特征提取时考虑的因素不够充分导致获得的变道轨迹应用于自动转向控制或者自动驾驶中失去了实际落地应用的能力的问题。所述方法中,基于自动驾驶车辆采集的变道场景数据提取表征变道轨迹的参数,并基于所述参数获得轨迹表达;然后对变道轨迹进行分割成若干子轨迹;针对每条子轨迹的参数特征进行转换,汇总后获得变道轨迹数据集;针对该数据集进行聚类获得典型的变道轨迹。本发明是根据实际变道场景获得的变道轨迹,应用于自动驾驶技术领域更可靠。
Description
技术领域
本发明涉及自动驾驶技术领域,具体涉及到变道场景的轨迹确定技术。
背景技术
在自动驾驶技术领域中,车辆行驶过程中的轨迹控制与规划是车辆可靠、安全、稳定运行的关键。而变道作为车辆行驶过程的基本动作,研究典型车辆变道轨迹对自动驾驶车辆转向控制研究以及自动驾驶功能开发具有重要作用。
目前,现有变道轨迹的提取技术一般采用线性拟合以及聚类的方法来提取典型变道轨迹,这类技术往往会忽略变道轨迹的局部变化信息,实现不了轨迹公共特征的有效提取。同时现有技术提取典型的变道轨迹是往往单单考虑车辆变道过程中位置特征信息,忽略了变道时间、车辆速度、转角等特征对变道轨迹的影响,无法有效提取具有典型特征的变道轨迹,使得研发出来自动转向控制以及自动驾驶功能不具备典型性,失去实际落地应用的能力。
发明内容
本发明解决了现有变道轨迹的提取技术存在的轨迹公共特征的提取率较低以及由于特征提取时考虑的因素不够充分导致获得的变道轨迹应用于自动转向控制或者自动驾驶中失去了实际落地应用的能力的问题。
本发明所述的一种基于变道场景数据的典型变道轨迹确定方法包括:
轨迹参数提取与轨迹表达的步骤:基于自动驾驶车辆采集的变道场景数据提取表征变道轨迹的参数,并基于所述参数获得轨迹表达;
变道轨迹分割步骤:将每条变道轨迹分割成N等段的N个片段,每个片段为一个子轨迹;
子轨迹参数特征转换步骤:从每一个子轨迹中提取轨迹参数,并将所述轨迹参数进行特征转换,获得第m条轨迹中的第n个子轨迹的参数特征为:
TS'mn=[Angel'mn,Speed'mn,Position_X'mn,Position_Ym'n],
其中,Angel`mn表示第m条轨迹中的第n个子轨迹的方向盘转角,Speed`mn表示第m条轨迹中的第n个子轨迹的车速,Position_X`mn表示第m条轨迹中的第n个子轨迹的横向距离跨度,Position_Y`mn表示第m条轨迹中的第n个子轨迹的纵向距离跨度;将特征转换后的数据汇总获得变道轨迹数据集;
轨迹聚类步骤:利用k-means算法对所述变道轨迹数据集进行聚类,以类中心来反应典型的轨迹特征,从而完成到典型的变道轨迹的提取与确定。
进一步地,所述表征变道轨迹的参数包括:方向盘转角Angle、车速Speed、本车纵向位置Position_X、本车横向位置Position_Y四个参数。
进一步地,所述基于所述轨迹表达为:TD={TR1,TR1,......,TRM},M为所有变道轨迹数据总量,TR1表示第1条变道轨迹,TR2表示第2条变道轨迹,......,TRM表示第M条变道轨迹。
进一步地,所述变道轨迹数据集DR为:
其中:TS11为第1条变道轨迹中第1个轨迹片段的轨迹,以此类推;
其中第m条变道轨迹中的第n个片段的轨迹表示为:
TSmn=[Condm,(n-1)j/N+1,Condm,(n-1)j/N+2,......,Condm,nj/N],
其中,1≤n≤N,1≤m≤M,其中Condm,(n-1)j/N+1为第m条变道轨迹中的第n个片段中时刻(n-1)j/N+1的特征。
进一步地,所述Angel`mn是根据
<Angelm,(n-1)j/N+1,Angelm,(n-1)j/N+2,......,Angelm,nj/N>
中的最大值;
<Angelm,(n-1)j/N+1,Angelm,(n-1)j/N+2,......,Angelm,nj/N>
中的最小值;
<Speedm,(n-1)j/N+1,Speedm,(n-1)j/N+2,......,Speedm,nj/N>
中的最大值;
<Speedm,(n-1)j/N+1,Speedm,(n-1)j/N+2,......,Speedm,nj/N>
中的最小值;
<Speedm,(n-1)j/N+1,Speedm,(n-1)j/N+2,......,Speedm,nj/N>的均值;
Position_X`mn和Position_Y`mn是通过
获得的,其中:
<Position_Xm,(n-1)j/N+1,Position_Xm,(n-1)j/N+2,......,Position_Xm,nj/N>
中的最大值,
<Position_Xm,(n-1)j/N+1,Position_Xm,(n-1)j/N+2,......,Position_Xm,nj/N>
中的最小值,
<Position_Xm,(n-1)j/N+1,Position_Xm,(n-1)j/N+2,......,Position_Xm,nj/N>
中的最大值,
<Position_Xm,(n-1)j/N+1,Position_Xm,(n-1)j/N+2,......,Position_Xm,nj/N>
中的最小值。
进一步地,所述利用k-means算法对所述变道轨迹数据集进行聚类,以类中心来反应典型的轨迹特征的方法为:从特征转换的轨迹特征变道轨迹数据集中随机选择k个样本作为初始的k个质心向量:
{μ1,μ2,...,μk};
重复下列过程直至收敛:
A)将类簇划分为Cj,j=1,2,3,…,k,k为类簇总数;
B)针对每一条变道轨迹TRi到各个质心
μj,j=1,2,3,...,k,
其中i=1,2,3,…,M,然后进一步获得各个质心间的距离dij,将TRi类
别标注为最小dij所对应的Cj;
对于j=1,2,3,...,k,对Cj中所有的变道轨迹数据重新计算新的质心;
如果所有的k个质心向量未发生变化,表示数据收敛,则转到下一步骤,否则返回步骤A)继续;
获得C={C1,C2,…,Ck}以及对应质心{μ1,μ2,...,μk},所述质心即为本发明所提取的典型的变道轨迹特征。
进一步地,所述各个质心间的距离dij是通过下述方法获得的:
a)首先定义方向盘转角、车速、本车纵向位置、本车横向位置特征的权重向量为:
W={WAngel,WSpeed,WPosition_X,WPosition_Y}
其中:各个特征的权重取值均大于或等于零并且满足
WAngel+WSpeed+WPosition_X+WPosition_Y=1,
b)计算两轨迹之间的距离,假设待计算的两个轨迹分别为TR1和TR2:
TR1=[TS11,TS12,.......,TS1N],TR2=[TS21,TS22,.......,TS2N],
则两轨迹的距离为:
其中:
上述一种基于变道场景数据的典型变道轨迹确定方法是能够采用计算机软件实现的技术方案,因此下面,基于同一个设计思路,采用计算机软件实现的方案的装置描述方式为:
一种基于变道场景数据的典型变道轨迹确定装置包括如下模块:
轨迹参数提取与轨迹表达模块:用于基于自动驾驶车辆采集的变道场景数据提取表征变道轨迹的参数,并基于所述参数获得轨迹表达;
变道轨迹分割模块:用于将每条变道轨迹分割成N等段的N个片段,每个片段为一个子轨迹;
子轨迹参数特征转换模块:用于从每一个子轨迹中提取轨迹参数,并将所述轨迹参数进行特征转换,获得第m条轨迹中的第n个子轨迹的参数特征为:
TS'mn=[Angel'mn,Speed'mn,Position_X'mn,Position_Ym'n],
其中,Angel`mn表示第m条轨迹中的第n个子轨迹的方向盘转角,Speed`mn表示第m条轨迹中的第n个子轨迹的车速,Position_X`mn表示第m条轨迹中的第n个子轨迹的横向距离跨度,Position_Y`mn表示第m条轨迹中的第n个子轨迹的纵向距离跨度;将特征转换后的数据汇总获得变道轨迹数据集;
轨迹聚类模块:用于利用k-means算法对所述变道轨迹数据集进行聚类,以类中心来反应典型的轨迹特征,从而完成到典型的变道轨迹的提取与确定。
进一步地,所述子轨迹参数特征转换模块进一步包括如下单元:Angel`mn转换单元、Speed`mn转换单元、Position_X`mn和Position_Y`mn,其中:
Angel`mn转换单元,用于采用
<Angelm,(n-1)j/N+1,Angelm,(n-1)j/N+2,......,Angelm,nj/N>
中的最大值;
<Angelm,(n-1)j/N+1,Angelm,(n-1)j/N+2,......,Angelm,nj/N>
中的最小值;
Speed`mn转换单元,用于采用
实现转换,其中:
<Speedm,(n-1)j/N+1,Speedm,(n-1)j/N+2,......,Speedm,nj/N>
中的最大值;
<Speedm,(n-1)j/N+1,Speedm,(n-1)j/N+2,......,Speedm,nj/N>
中的最小值;
<Speedm,(n-1)j/N+1,Speedm,(n-1)j/N+2,......,Speedm,nj/N>的均值;
Position_X`mn和Position_Y`mn转换单元,用于通过
实现转换,其中:
<Position_Xm,(n-1)j/N+1,Position_Xm,(n-1)j/N+2,......,Position_Xm,nj/N>中的最大值,
<Position_Xm,(n-1)j/N+1,Position_Xm,(n-1)j/N+2,......,Position_Xm,nj/N>中的最小值,
<Position_Xm,(n-1)j/N+1,Position_Xm,(n-1)j/N+2,......,Position_Xm,nj/N>中的最大值,
<Position_Xm,(n-1)j/N+1,Position_Xm,(n-1)j/N+2,......,Position_Xm,nj/N>中的最小值。
进一步地,所述轨迹聚类模块进一步包括如下单元:
提取质心向量单元:用于从特征转换的轨迹特征变道轨迹数据集中随机选择k个样本作为初始的k个质心向量:
{μ1,μ2,...,μk};
聚类收敛单元:用于重复下列过程直至收敛:
A)将类簇划分为Cj,j=1,2,3,…,k,k为类簇总数;
B)针对每一条变道轨迹TRi到各个质心
μj,j=1,2,3,...,k,
其中i=1,2,3,…,M,然后进一步获得各个质心间的距离dij,将TRi类别标注为最小dij所对应的Cj;
对于j=1,2,3,...,k,对Cj中所有的变道轨迹数据重新计算新的质心;
如果所有的k个质心向量未发生变化,表示完成数据收敛,否则继
续;
典型的变道轨迹特征获取单元,用于C={C1,C2,…,Ck}以及对应质心{μ1,μ2,...,μk},所述质心即为本发明所提取的典型的变道轨迹特征。
进一步地,所述聚类收敛单元中进一步包括质心间的距离dij获取子单元,所述子单元包括:
特征权重定义子单元:用于定义方向盘转角、车速、本车纵向位置、本车横向位置特征的权重向量为:
W={WAngel,WSpeed,WPosition_X,WPosition_Y}
其中:各个特征的权重取值均大于或等于零并且满足
WAngel+WSpeed+WPosition_X+WPosition_Y=1,
距离计算子单元:用于计算两轨迹之间的距离,假设待计算的两个轨迹分别为TR1和TR2:
TR1=[TS11,TS12,.......,TS1N],TR2=[TS21,TS22,.......,TS2N],
则两轨迹的距离为:
其中:
本发明还要求保护一种计算机可读存储介质,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现本发明所述的任意一种基于变道场景数据的典型变道轨迹确定方法。
本发明首先基于大量的变道场景数据中提取对变道轨迹具有相关影响的数据参数作为变道轨迹特征,包括车速、转角、位置特征等特征信息,并考虑变道的时间特性对一个完整的轨迹进行分割,用于突出变道轨迹的局部特性,可满足自动变道算法开发需求。
本发明利用了局部特征转换以及特征加权的距离度量方式,最后通过k-means聚类方法实现典型变道轨迹的提取,提高了典型变道轨迹生成的科学合理性,使得基于本发明所述方法获得的轨迹应用于自动转向控制技术中可靠性更高。
附图说明
图1为本发明所述的基于变道场景数据的典型变道轨迹确定流程。
图2是变道轨迹及参数表达示意图。
图3本发明中,变道轨迹分割示意图。
实施方式
下面结合附图对本发明所要求保护的一种基于变道场景数据的典型变道轨迹确定方法进行举例说明。
实施方式一.参见图1说明本实施方式,本实施方式所述的一种基于变道场景数据的典型变道轨迹确定方法包括如下步骤:
轨迹参数提取与轨迹表达的步骤:基于自动驾驶车辆采集的变道场景数据提取表征变道轨迹的参数,并基于所述参数获得轨迹表达;
变道轨迹分割步骤:将每条变道轨迹分割成N等段的N个片段,每个片段为一个子轨迹;
子轨迹参数特征转换步骤:从每一个子轨迹中提取轨迹参数,并将所述轨迹参数进行特征转换,获得第m条轨迹中的第n个子轨迹的参数特征为:
TS'mn=[Angel'mn,Speed'mn,Position_X'mn,Position_Ym'n],
其中,Angel`mn表示第m条轨迹中的第n个子轨迹的方向盘转角,Speed`mn表示第m条轨迹中的第n个子轨迹的车速,Position_X`mn表示第m条轨迹中的第n个子轨迹的横向距离跨度,Position_Y`mn表示第m条轨迹中的第n个子轨迹的纵向距离跨度;将特征转换后的数据汇总获得变道轨迹数据集;
轨迹聚类步骤:利用k-means算法对所述变道轨迹数据集进行聚类,以类中心来反应典型的轨迹特征,从而完成到典型的变道轨迹的提取与确定。
本实施方式中所述的方案包括轨迹参数提取与轨迹表达、变道轨迹分割、子轨迹参数特征转换、轨迹聚类过程,获得典型的变道轨迹。
本实施方式中将变道轨迹分割成N等段的N个片段,参见图3所示,这种轨迹的分割能够有效突出变道轨迹的局部特征,同时又不会丢失轨迹的全局特征,因此对于所有的变道轨迹数据进行特定的N等段分割,从而得到各个片段轨迹特征数据。
实施方式二.本实施方式是对实施方式一所述一种基于变道场景数据的典型变道轨迹确定方法的进一步限定,本实施方式中,所述表征变道轨迹的参数包括:方向盘转角Angle、车速Speed、本车纵向位置Position_X、本车横向位置Position_Y四个参数。
本实施方式对变道轨迹参数做了解释说明。本实施方式的变道轨迹参数考虑到了四个参数,参见图2所示,其中:本车纵向位置指沿车道方向车辆当前所在位置相对变道起始时刻的位移,本车横向位置指垂直于车道方向车辆当前所在位置相对变道起始时刻的位移。
实施方式三.本实施方式是对实施方式一所述一种基于变道场景数据的典型变道轨迹确定方法的进一步限定,本实施方式中,所述基于所述轨迹表达为:TD={TR1,TR2,......,TRM},M为所有变道轨迹数据总量,TR1表示第1条变道轨迹,TR2表示第2条变道轨迹,......,TRM表示第M条变道轨迹。
本实施方式中,所述变道轨迹表达为:
Trajectory=[Cond1,Cond2,......,Condj],
其中,j表示变道轨迹的结束时刻,其中Condi表示时刻i的轨迹特征
Condi=<Anglei,Speedi,Position_Xi,Position_Yi>,
其中Anglei表示时刻i的方向盘转角,Speedi表示时刻i的车速,Position_Xi表示时刻i的本车横向位置,Position_Yi表示时刻i的本车纵向位置。
本实施方式中j表示变道轨迹的结束时刻,实际就是表示变道轨迹的长度。
本实施方式中,对一个完整的变道轨迹采用数学表达式的方式进行描述,便于后期对数据进行处理。
实施方式四.本实施方式是对实施方式一所述一种基于变道场景数据的典型变道轨迹确定方法的进一步限定,本实施方式中,所述变道轨迹数据集DR为:
其中:TS11为第1条变道轨迹中第1个轨迹片段的轨迹,以此类推;
其中第m条变道轨迹中的第n个片段的轨迹表示为:
TSmn=[Condm,(n-1)j/N+1,Condm,(n-1)j/N+2,......,Condm,nj/N],
其中,1≤n≤N,1≤m≤M,其中Condm,(n-1)j/N+1为第m条变道轨迹中的第n个片段中时刻(n-1)j/N+1的特征。
实施方式五.本实施方式是对实施方式一所述一种基于变道场景数据的典型变道轨迹确定方法的进一步限定,本实施方式中,所述Angel`mn是根据
<Angelm,(n-1)j/N+1,Angelm,(n-1)j/N+2,......,Angelm,nj/N>
中的最大值;
<Angelm,(n-1)j/N+1,Angelm,(n-1)j/N+2,......,Angelm,nj/N>
中的最小值;
<Speedm,(n-1)j/N+1,Speedm,(n-1)j/N+2,......,Speedm,nj/N>
中的最大值;
<Speedm,(n-1)j/N+1,Speedm,(n-1)j/N+2,......,Speedm,nj/N>
中的最小值;
<Speedm,(n-1)j/N+1,Speedm,(n-1)j/N+2,......,Speedm,nj/N>
的均值;
Position_X`mn和Position_Y`mn是通过
获得的,其中:
<Position_Xm,(n-1)j/N+1,Position_Xm,(n-1)j/N+2,......,Position_Xm,nj/N>
中的最大值,
<Position_Xm,(n-1)j/N+1,Position_Xm,(n-1)j/N+2,......,Position_Xm,nj/N>
中的最小值;
<Position_Xm,(n-1)j/N+1,Position_Xm,(n-1)j/N+2,......,Position_Xm,nj/N>
中的最大值,
<Position_Xm,(n-1)j/N+1,Position_Xm,(n-1)j/N+2,......,Position_Xm,nj/N>
中的最小值。
实施方式六.本实施方式是对实施方式一所述一种基于变道场景数据的典型变道轨迹确定方法的进一步限定,本实施方式中,所述利用k-means算法对所述变道轨迹数据集进行聚类,以类中心来反应典型的轨迹特征的方法为:从特征转换的轨迹特征变道轨迹数据集中随机选择k个样本作为初始的k个质心向量:
{μ1,μ2,...,μk};
重复下列过程直至收敛:
A)将类簇划分为Cj,j=1,2,3,…,k,k为类簇总数;j为公示的中间变量,
B)针对每一条变道轨迹TRi到各个质心
μj,j=1,2,3,...,k,
其中i=1,2,3,…,M,然后进一步获得各个质心间的距离dij,将TRi类
别标注为最小dij所对应的Cj;
对于j=1,2,3,...,k,对Cj中所有的变道轨迹数据重新计算新的质心;
如果所有的k个质心向量未发生变化,表示数据收敛,则转到下一步骤,否则返回步骤A)继续;
获得C={C1,C2,…,Ck}以及对应质心{μ1,μ2,...,μk},所述质心即为本发明所提取的典型的变道轨迹特征。
实施方式七.本实施方式是对实施方式一所述一种基于变道场景数据的典型变道轨迹确定方法的进一步限定,本实施方式中,所述各个质心间的距离dij是通过下述方法获得的:
a)首先定义方向盘转角、车速、本车纵向位置、本车横向位置特征的权重向量为:
W={WAngel,WSpeed,WPosition_X,WPosition_Y}
其中:各个特征的权重取值均大于或等于零并且满足
WAngel+WSpeed+WPosition_X+WPosition_Y=1,
b)计算两轨迹之间的距离,假设待计算的两个轨迹分别为TR1和TR2:
TR1=[TS11,TS12,.......,TS1N],TR2=[TS21,TS22,.......,TS2N],
则两轨迹的距离为:
其中:
上述各个实施方式,是对本发明所要求保护的技术方案的举例说明,不限制本发明的保护范围,上述各个实施方式所记载的技术特征的合理组合也属于本发明所要求保护的技术方案。
Claims (12)
1.一种基于变道场景数据的典型变道轨迹确定方法,其特征在于,所述方法包括:
轨迹参数提取与轨迹表达的步骤:基于自动驾驶车辆采集的变道场景数据提取表征变道轨迹的参数,并基于所述参数获得轨迹表达;
变道轨迹分割步骤:将每条变道轨迹分割成N等段的N个片段,每个片段为一个子轨迹;
子轨迹参数特征转换步骤:从每一个子轨迹中提取轨迹参数,并将所述轨迹参数进行特征转换,获得第m条轨迹中的第n个子轨迹的参数特征为:
TS'mn=[Angel'mn,Speed'mn,Position_X'mn,Position_Y′mn],
其中,Angel`mn表示第m条轨迹中的第n个子轨迹的方向盘转角,Speed`mn表示第m条轨迹中的第n个子轨迹的车速,Position_X`mn表示第m条轨迹中的第n个子轨迹的横向距离跨度,Position_Y`mn表示第m条轨迹中的第n个子轨迹的纵向距离跨度;将特征转换后的数据汇总获得变道轨迹数据集;
轨迹聚类步骤:利用k-means算法对所述变道轨迹数据集进行聚类,以类中心来反应典型的轨迹特征,从而完成到典型的变道轨迹的提取与确定。
2.根据权利要求1所述的一种基于变道场景数据的典型变道轨迹确定方法,其特征在于,所述表征变道轨迹的参数包括:方向盘转角Angle、车速Speed、本车纵向位置Position_X、本车横向位置Position_Y四个参数。
3.根据权利要求1所述的一种基于变道场景数据的典型变道轨迹确定方法,其特征在于,所述基于所述轨迹表达为:TD={TR1,TR2,......,TRM},M为所有变道轨迹数据总量,TR1表示第1条变道轨迹,TR2表示第2条变道轨迹,......,TRM表示第M条变道轨迹。
5.根据权利要求1所述的一种基于变道场景数据的典型变道轨迹确定方法,其特征在于,所述Angel`mn是根据
<Angelm,(n-1)j/N+1,Angelm,(n-1)j/N+2,......,Angelm,nj/N>
中的最大值;
<Angelm,(n-1)j/N+1,Angelm,(n-1)j/N+2,......,Angelm,nj/N>
中的最小值;
<Speedm,(n-1)j/N+1,Speedm,(n-1)j/N+2,......,Speedm,nj/N>
中的最大值;
<Speedm,(n-1)j/N+1,Speedm,(n-1)j/N+2,......,Speedm,nj/N>
中的最小值;
<Speedm,(n-1)j/N+1,Speedm,(n-1)j/N+2,......,Speedm,nj/N>
的均值;
Position_X`mn和Position_Y`mn是通过
获得的,其中:
<Position_Xm,(n-1)j/N+1,Position_Xm,(n-1)j/N+2,......,Position_Xm,nj/N>
中的最大值,
<Position_Xm,(n-1)j/N+1,Position_Xm,(n-1)j/N+2,......,Position_Xm,nj/N>
中的最小值;
<Position_Xm,(n-1)j/N+1,Position_Xm,(n-1)j/N+2,......,Position_Xm,nj/N>
中的最大值,
<Position_Xm,(n-1)j/N+1,Position_Xm,(n-1)j/N+2,......,Position_Xm,nj/N>
中的最小值。
6.根据权利要求1所述的一种基于变道场景数据的典型变道轨迹确定方法,其特征在于,所述利用k-means算法对所述变道轨迹数据集进行聚类,以类中心来反应典型的轨迹特征的方法为:从特征转换的轨迹特征变道轨迹数据集中随机选择k个样本作为初始的k个质心向量:
{μ1,μ2,...,μk};
重复下列过程直至收敛:
A)将类簇划分为Cj,j=1,2,3,…,k,k为类簇总数;
B)针对每一条变道轨迹TRi到各个质心
μj,j=1,2,3,...,k,
其中i=1,2,3,…,M,然后进一步获得各个质心间的距离dij,将TRi类别标注为最小dij所对应的Cj;
对于j=1,2,3,...,k,对Cj中所有的变道轨迹数据重新计算新的质心;
如果所有的k个质心向量未发生变化,表示数据收敛,则转到下一步骤,否则返回步骤A)继续;
获得C={C1,C2,…,Ck}以及对应质心{μ1,μ2,...,μk},所述质心即为本发明所提取的典型的变道轨迹特征。
7.根据权利要求6所述的一种基于变道场景数据的典型变道轨迹确定方法,其特征在于,所述各个质心间的距离dij是通过下述方法获得的:
a)首先定义方向盘转角、车速、本车纵向位置、本车横向位置特征的权重向量为:
W={WAngel,WSpeed,WPosition_X,WPosition_Y}
其中:各个特征的权重取值均大于或等于零并且满足
WAngel+WSpeed+WPosition_X+WPosition_Y=1,
b)计算两轨迹之间的距离,假设待计算的两个轨迹分别为TR1和TR2:
TR1=[TS11,TS12,.......,TS1N],TR2=[TS21,TS22,.......,TS2N],
则两轨迹的距离为:
其中:
8.一种基于变道场景数据的典型变道轨迹确定装置,其特征在于,所述装置包括如下模块:
轨迹参数提取与轨迹表达模块:用于基于自动驾驶车辆采集的变道场景数据提取表征变道轨迹的参数,并基于所述参数获得轨迹表达;
变道轨迹分割模块:用于将每条变道轨迹分割成N等段的N个片段,每个片段为一个子轨迹;
子轨迹参数特征转换模块:用于从每一个子轨迹中提取轨迹参数,并将所述轨迹参数进行特征转换,获得第m条轨迹中的第n个子轨迹的参数特征为:
TS'mn=[Angel'mn,Speed'mn,Position_X'mn,Position_Y′mn],
其中,Angel`mn表示第m条轨迹中的第n个子轨迹的方向盘转角,Speed`mn表示第m条轨迹中的第n个子轨迹的车速,Position_X`mn表示第m条轨迹中的第n个子轨迹的横向距离跨度,Position_Y`mn表示第m条轨迹中的第n个子轨迹的纵向距离跨度;将特征转换后的数据汇总获得变道轨迹数据集;
轨迹聚类模块:用于利用k-means算法对所述变道轨迹数据集进行聚类,以类中心来反应典型的轨迹特征,从而完成到典型的变道轨迹的提取与确定。
9.根据权利要求8所述的一种基于变道场景数据的典型变道轨迹确定装置,其特征在于,所述子轨迹参数特征转换模块进一步包括如下单元:Angel`mn转换单元、Speed`mn转换单元、Position_X`mn和Position_Y`mn转换单元,其中:
Angel`mn转换单元,用于采用
<Angelm,(n-1)j/N+1,Angelm,(n-1)j/N+2,......,Angelm,nj/N>
中的最大值;
<Angelm,(n-1)j/N+1,Angelm,(n-1)j/N+2,......,Angelm,nj/N>
中的最小值;
Speed`mn转换单元,用于采用
实现转换,其中:
<Speedm,(n-1)j/N+1,Speedm,(n-1)j/N+2,......,Speedm,nj/N>
中的最大值;
<Speedm,(n-1)j/N+1,Speedm,(n-1)j/N+2,......,Speedm,nj/N>
中的最小值;
<Speedm,(n-1)j/N+1,Speedm,(n-1)j/N+2,......,Speedm,nj/N>
的均值;
Position_X`mn和Position_Y`mn转换单元,用于通过
实现转换,其中:
<Position_Xm,(n-1)j/N+1,Position_Xm,(n-1)j/N+2,......,Position_Xm,nj/N>
中的最大值,
<Position_Xm,(n-1)j/N+1,Position_Xm,(n-1)j/N+2,......,Position_Xm,nj/N>
中的最小值;
<Position_Xm,(n-1)j/N+1,Position_Xm,(n-1)j/N+2,......,Position_Xm,nj/N>
中的最大值,
<Position_Xm,(n-1)j/N+1,Position_Xm,(n-1)j/N+2,......,Position_Xm,nj/N>
中的最小值。
10.根据权利要求8所述的一种基于变道场景数据的典型变道轨迹确定装置,其特征在于,所述轨迹聚类模块进一步包括如下单元:
提取质心向量单元:用于从特征转换的轨迹特征变道轨迹数据集中随机选择k个样本作为初始的k个质心向量:
{μ1,μ2,...,μk};
聚类收敛单元:用于重复下列过程直至收敛:
A)将类簇划分为Cj,j=1,2,3,…,k,k为类簇总数;
B)针对每一条变道轨迹TRi到各个质心
μj,j=1,2,3,...,k,
其中i=1,2,3,…,M,然后进一步获得各个质心间的距离dij,将TRi类别标注为最小dij所对应的Cj;
对于j=1,2,3,...,k,对Cj中所有的变道轨迹数据重新计算新的质心;
如果所有的k个质心向量未发生变化,表示完成数据收敛,否则继续;
典型的变道轨迹特征获取单元,用于C={C1,C2,…,Ck}以及对应质心{μ1,μ2,...,μk},所述质心即为本发明所提取的典型的变道轨迹特征。
11.根据权利要求10所述的一种基于变道场景数据的典型变道轨迹确定装置,其特征在于,所述聚类收敛单元中进一步包括质心间的距离dij获取子单元,所述子单元包括:
特征权重定义子单元:用于定义方向盘转角、车速、本车纵向位置、本车横向位置特征的权重向量为:
W={WAngel,WSpeed,WPosition_X,WPosition_Y}
其中:各个特征的权重取值均大于或等于零并且满足
WAngel+WSpeed+WPosition_X+WPosition_Y=1,
距离计算子单元:用于计算两轨迹之间的距离,假设待计算的两个轨迹分别为TR1和TR2:
TR1=[TS11,TS12,.......,TS1N],TR2=[TS21,TS22,.......,TS2N],
则两轨迹的距离为:
其中:
12.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现如权利要求1至7任一项所述的基于变道场景数据的典型变道轨迹确定方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210131679.2A CN114633747B (zh) | 2022-02-14 | 2022-02-14 | 一种基于变道场景数据的典型变道轨迹确定方法、装置及计算机存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210131679.2A CN114633747B (zh) | 2022-02-14 | 2022-02-14 | 一种基于变道场景数据的典型变道轨迹确定方法、装置及计算机存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114633747A true CN114633747A (zh) | 2022-06-17 |
CN114633747B CN114633747B (zh) | 2025-04-04 |
Family
ID=81946148
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210131679.2A Active CN114633747B (zh) | 2022-02-14 | 2022-02-14 | 一种基于变道场景数据的典型变道轨迹确定方法、装置及计算机存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114633747B (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102013223428A1 (de) * | 2013-11-18 | 2015-05-21 | Robert Bosch Gmbh | Verfahren und Fahrerassistenzeinrichtung zur Unterstützung von Spurwechseln bzw. Überholmanövern eines Kraftfahrzeugs |
CN106926844A (zh) * | 2017-03-27 | 2017-07-07 | 西南交通大学 | 一种基于实时环境信息的动态自动驾驶换道轨迹规划方法 |
CN110609881A (zh) * | 2019-08-28 | 2019-12-24 | 中山大学 | 车辆轨迹偏离检测方法、系统和存储介质 |
CN110796374A (zh) * | 2019-10-30 | 2020-02-14 | 常州工学院 | 具有典型变道和转弯工况的城市综合行驶工况的构建方法 |
DE102019216235A1 (de) * | 2019-10-22 | 2021-04-22 | Zf Friedrichshafen Ag | Verfahren zum Vorhersagen der Bewegung eines Fahrzeugs und zumindest eines weiteren Fahrzeugs |
CN113807009A (zh) * | 2021-08-31 | 2021-12-17 | 东南大学 | 一种微观换道轨迹的分段提取方法 |
CN114022628A (zh) * | 2021-11-05 | 2022-02-08 | 武汉中海庭数据技术有限公司 | 一种车道级引导线提取方法及提取系统 |
-
2022
- 2022-02-14 CN CN202210131679.2A patent/CN114633747B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102013223428A1 (de) * | 2013-11-18 | 2015-05-21 | Robert Bosch Gmbh | Verfahren und Fahrerassistenzeinrichtung zur Unterstützung von Spurwechseln bzw. Überholmanövern eines Kraftfahrzeugs |
CN106926844A (zh) * | 2017-03-27 | 2017-07-07 | 西南交通大学 | 一种基于实时环境信息的动态自动驾驶换道轨迹规划方法 |
CN110609881A (zh) * | 2019-08-28 | 2019-12-24 | 中山大学 | 车辆轨迹偏离检测方法、系统和存储介质 |
DE102019216235A1 (de) * | 2019-10-22 | 2021-04-22 | Zf Friedrichshafen Ag | Verfahren zum Vorhersagen der Bewegung eines Fahrzeugs und zumindest eines weiteren Fahrzeugs |
CN110796374A (zh) * | 2019-10-30 | 2020-02-14 | 常州工学院 | 具有典型变道和转弯工况的城市综合行驶工况的构建方法 |
CN113807009A (zh) * | 2021-08-31 | 2021-12-17 | 东南大学 | 一种微观换道轨迹的分段提取方法 |
CN114022628A (zh) * | 2021-11-05 | 2022-02-08 | 武汉中海庭数据技术有限公司 | 一种车道级引导线提取方法及提取系统 |
Also Published As
Publication number | Publication date |
---|---|
CN114633747B (zh) | 2025-04-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Wang et al. | Lanenet: Real-time lane detection networks for autonomous driving | |
CN104197897B (zh) | 一种基于车载激光扫描点云的城区道路标线自动分类方法 | |
CN108917761A (zh) | 一种无人车在地下车库中的精确定位方法 | |
Guindel et al. | Fast joint object detection and viewpoint estimation for traffic scene understanding | |
CN106877875A (zh) | 一种基于阈值结合算法的车辆运行轨迹压缩方法 | |
CN104268862A (zh) | 一种自主车三维地形可通行性分析方法 | |
CN104036287A (zh) | 一种基于人类运动显著轨迹的视频分类方法 | |
CN105760849A (zh) | 基于视频的目标对象行为数据获取方法及装置 | |
Zhou et al. | MonoEF: Extrinsic parameter free monocular 3D object detection | |
CN100466010C (zh) | 异类交通信息实时融合方法 | |
CN106295564A (zh) | 一种邻域高斯结构和视频特征融合的动作识别方法 | |
CN109359690A (zh) | 基于卡口数据的车辆出行轨迹识别方法 | |
CN107122712A (zh) | 基于卷积神经网络和双向局部特征聚合描述向量的掌纹图像识别方法 | |
CN107274668A (zh) | 一种基于车辆检测的道路拥堵建模方法 | |
CN114860700A (zh) | 缺失轨迹填补方法及系统 | |
CN116523970B (zh) | 基于二次隐式匹配的动态三维目标跟踪方法及装置 | |
CN103679213B (zh) | 一种3d手势识别方法 | |
Gad et al. | Real-time lane instance segmentation using SegNet and image processing | |
CN106326335A (zh) | 一种基于显著属性选择的大数据归类方法 | |
CN101794383B (zh) | 基于隐马尔科夫模型的拥塞交通场景的视频车辆检测方法 | |
Sai et al. | Automatic License Plate Recognition using YOLO4 and TESSERACT OCR | |
CN102831445B (zh) | 基于语义Hough变换和偏最小二乘法的目标检测方法 | |
CN113903173B (zh) | 一种基于有向图结构和lstm的车辆轨迹特征提取方法 | |
CN102867174B (zh) | 一种人脸特征定位方法及装置 | |
CN114633747A (zh) | 一种基于变道场景数据的典型变道轨迹确定方法、装置及计算机存储介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant |