利索能及
我要发布
收藏
专利号: 2024103321455
申请人: 山东科技大学
专利类型:发明专利
专利状态:已下证
更新日期:2025-10-27
缴费截止日期: 暂无
联系人

摘要:

权利要求书:

1.一种自动驾驶车辆换道决策方法,其特征在于,包括以下步骤:S1、选用一辆搭载激光雷达、摄像头、毫米波雷达的换道车辆进行数据采集;

S2、根据S1获得的数据,得到换道车辆与周边车辆之间的距离,换道车辆的速度、横向加速度和纵向加速度,周边车辆的速度和加速度;

S3、根据激光雷达的id以及摄像头采集的图像进行联合标定,将换道车辆的轨迹信息提取出来,对提取的换道车辆轨迹通过对称指数移动平均法进行平滑处理,通过换道车辆的车辆行为记录模块对车辆行为倾向进行筛选分类,分为左换道、右换道、车道保持、减速四个行为倾向,形成训练数据集;

S4、基于Transformer构建车辆行为倾向识别模型,使用训练数据集对该模型进行学习训练,采用特异度、真正率、假正率、对准确率四个指标灵敏度进行评价,对训练好的模型使用随机搜索的方法进行参数优化,使用优化好的车辆行为倾向识别模型对车辆的自动驾驶行为倾向进行实时判断;若行为倾向为左换道或右换道,则执行S5;

S5、构建最小安全距离模型,使用该模型对换道行为进行安全性判别,如果满足安全距离,将执行换道决策,如果不满足安全距离,将执行车道保持或者减速决策;

其中,在S4中,该模型的输入序列为X,X=(batch size,pad size,d model),batch size为一次输入的换道车辆数量,pad size为轨迹点的数量,d model为轨迹点的特征参数数量,X的表达式为:T

X=[x1,x2,x3,…,xN];

T

xi=[t1,t2,t3,…,tn];

tj=[vm,am,vm1,am1,Δxm1,Δym1,vm2,am2,Δxm2,Δym2,vm3,am3,Δxm3,Δym3];

其中,N为换道车辆的数量,xi为第i个换道车辆n个轨迹点的特征,i∈(1,N),tj为第j个轨迹点的特征,j∈(1,n),n为轨迹点的数量;vm为换道车辆速度,am为换道车辆加速度,vm1为当前车道前方车辆速度,am1为当前车道前方车辆加速度,Δxm1为换道车辆与前方车辆的纵向相对距离,Δym1为换道车辆与前方车辆的横向相对距离,vm2为目标车道前车车辆速度,am2为目标车道前车车辆加速度,Δxm2为换道车辆与目标车道前车车辆的纵向相对距离,Δym2为换道车辆与左前方车辆的横向相对距离,vm3为目标车道后车车辆速度,am3为目标车道后车车辆加速度,Δxm3为换道车辆与左后方车辆的纵向相对距离,Δym3为换道车辆与左后方车辆的横向相对距离。

2.根据权利要求1所述的一种自动驾驶车辆换道决策方法,其特征在于,在S3中,对数指数移动平均法的表达式为:Δ=T/d;

D=min{3Δ,t‑1,NM‑t};

其中,xM(t)为换道车辆M在t时刻的原始值, 为换道车辆M在t时刻的拟合值,D为考虑边界数据平滑窗口,Δ为平滑宽度,T为移动平均幅度,d数据时间间隔,NM为车辆M出现的帧数,T根据拟合参数不同,取值不同,当x为位置数据时T=0.5s,当x为车速数据时T=1s。

3.根据权利要求1所述的一种自动驾驶车辆换道决策方法,其特征在于,在S4中,所述车辆行为倾向识别模型包括输入单元、编码器、解码器和输出单元,所述输入单元包括位置编码层,编码器依次由多头注意力层、残差连接和归一化层、前馈神经网络层和残差连接和归一化层构成;

将输入序列X在输入单元进行相对位置编码,公式为:

其中,pos为数据在序列中的位置索引,PE为二维张量,dmodel为数据的特征数量,s为数据的特征位置;

在编码器中,首先通过多头注意力层,将经过位置编码的输入序列X线性投影到三个不同的空间,分别得到一组查询向量qi、一组键向量ki和一组值向量vi,经过不同的权重矩阵分别计算得到查询矩阵Q、键矩阵K和值矩阵V,其表达式为:Q

Q=XW;

K

K=XW;

V

V=XW;

Q K V

其中,W为查询矩阵Q的权重矩阵,W为键矩阵K的权重矩阵,W为值矩阵V的权重矩阵;

对Q和K通过缩放点积注意力评分函数算出权重a(Q,K),公式为:其中,T表示转置,dK为输入矩阵K的特征维度;

使用softmax函数对所有权重归一化,将权重和相应的Q、V进行加权求和,得到注意力值Attention(Q,K,V),公式为:使用多头注意力机制建立多个子空间,首先将Q、K、V经过线性变换后,并行执行m次的缩放点积注意力机制,然后,将m次的缩放点积注意结果加以连接,经过线性变换,转换为预期的维度,得到多头注意力最终值,公式为:o

MultiHead(Q,K,V)=Concat(head1,…,headm)W;

o

其中, 分别是第s个多头注意力头的查询、键、值矩阵的权重矩阵,W 是输出的权重矩阵,heads为第s个多头注意力头的输出值,s∈(1,m),m为多头注意力头的数量,MultiHead(Q,K,V)为多头注意力最终值;

将多头注意力最终值MultiHead(Q,K,V)输入到残差连接和归一化层,改善梯度消失问题,得到X',其表达式为:X'=X+MultiHead(Q,K,V);

将X'输入到前馈神经网络层中,得到FFN(X'),前馈神经网络层由两个线性变化和线性激活函数构成,线性激活函数采用Relu激活函数,其表达式为:FFN(X')=max(0,X'Wl+bl)W2+b2;

其中,Wl为第l层隐藏层的权重矩阵,bl为第l层隐藏层的偏置向量,W2为第2层隐藏层的权重矩阵,b2为第2层隐藏层的偏置向量;

将FFN(X')输入到残差连接和归一化层,得到X”,其表达式为:X”=X'+FFN(X');

将X”输入到解码器中多头注意力层,经解码器输出的数据,在输出单元中先经过一次线性变换,然后通过Softmax操作得到输出结果。

4.根据权利要求1所述的一种自动驾驶车辆换道决策方法,其特征在于,在S5中,构建最小安全距离模型,设M为换道车辆、M1为换道车辆当前车道前方车辆、M2为换道车辆目标车道前方车辆、M3为换道车辆目标车道后方车辆、M4为换道车辆当前车道后方车辆;

换道车辆M车与换道车辆当前车道前方车辆M1不发生任何碰撞的最小安全距离MSS(M,M1)表示为:aM(t)为M车在t时刻的加速度, 为M1车在t时刻的加速度;vM(0)为M车初始时刻的速度, 为M1车初始时刻的速度;LfM为M车的重心位置距车辆前端的距离;BM为M车的宽度;θ(t)为t时刻M车的轨迹切线方向与车道线方向的夹角;t1为换道车辆M开始施加横向加速的时间,t2为换道车辆到达碰撞点的时间;

换道车辆M车与换道车辆目标车道前方车辆M2不发生任何碰撞的最小安全距离MSS(M,M2)表示为:其中, 为M2车在t时刻的加速度, 为M2车初始时刻的速度,t4为换道车辆完成换道行为的时间;

换道车辆M车与换道车辆目标车道后方车辆M3不发生任何碰撞的最小安全距离MSS(M,M3)表示为:其中, 为M3车在t时刻的加速度, 为M3车初始时刻速度。