自动驾驶中车辆变道至目标车道前车之前的预测方法与流程

文档序号:20190074发布日期:2020-03-27 19:34阅读:来源:国知局

技术特征:

1.一种自动驾驶中车辆变道至目标车道前车之前的预测方法,其特征在于:包括以下步骤,

获取预变道车辆、车辆一、车辆二、车辆三当前采样周期的行驶状态数据;其中,所述车辆一为预变道车辆所在车道的前方第一辆车;所述车辆二为目标车道内位于预变道车辆前方的第一辆车;所述车辆三为目标车道内位于预变道车辆前方的第二辆车;

结合各车辆的所述行驶状态数据计算出所述预变道车辆变道至所述车辆二之前的意愿度λ,0≤λ≤1;

当所述意愿度超过意愿度阈值时,预测出所述预变道车辆将在未来时刻变道至所述车辆二之前。

2.如权利要求1所述的自动驾驶中车辆变道至目标车道前车之前的预测方法,其特征在于:所述预变道车辆向目标车道方向的横向速度小于零、且维持一定时间时,所述预变道车辆变道至目标车道的意愿度为零。

3.如权利要求1所述的自动驾驶中车辆变道至目标车道前车之前的预测方法,其特征在于:计算所述意愿度λ包括,

存在一个时间t∈[0,tthres],tthres为能够调整的标定量;

存在一个时间t1,该时间内预变道车辆的行驶速度大于车辆一的行驶速度;

存在一个时间t2,该时间内所述车辆三位于车辆一的前方;

存在一个时间t3,该时间内所述车辆一位于车辆二的前方;

存在一个时间t4,该时间内所述预变道车辆位于车辆二的前方;

当时间t1、时间t2、时间t3和时间t4四者在时间t内有交集、且预变道车辆的行驶速度大于车辆二的行驶速度时,计算所述意愿度λ考虑预变道车辆实际加速度、预变道车辆和车辆一之间沿车道线方向间隔距离和预变道车辆与车辆一之间相对速度的影响、车道拥堵程度的影响、车辆三和车辆一之间纵向距离的影响、车辆三与车辆一两者行驶速度比的影响;否则,所述意愿度λ为零。

4.如权利要求3所述的自动驾驶中车辆变道至目标车道前车之前的预测方法,其特征在于:计算所述意愿度λ包括,

计算预变道车辆实际加速度影响下的意愿度λ1;

计算预变道车辆和车辆一之间沿车道线方向间隔距离影响下的意愿度λ2;

计算预变道车辆与车辆一之间相对速度影响下的意愿度λ3;

计算车道拥堵程度影响下的意愿度λ4;

计算车辆三和车辆一之间纵向距离的影响下的意愿度λ5;

计算车辆三与车辆一两者行驶速度比影响下的意愿度λ6;

λ=max{λ1,λ2,λ3,λ4,λ5,λ6}(式一);

根据式一计算预变道车辆变道至车辆二之前的意愿度λ。

5.如权利要求4所述的自动驾驶中车辆变道至目标车道前车之前的预测方法,其特征在于:根据公式一计算所述意愿度λ1,

a表征预变道车辆的实际加速度;

k1表征预变道车辆实际加速度与意愿度λ1之间函数关系的直线斜率;

a1表征预变道车辆实际加速度所在加速度轴上的一个固定加速度值;

δλ表征预变道车辆的实际加速度超出加速度阈值持续一定时间的意愿度增量。

6.如权利要求4所述的自动驾驶中车辆变道至目标车道前车之前的预测方法,其特征在于:计算所述意愿度λ2包括,

计算l1=a+b、a=s1-s2+v1*tr+d;

a表征预变道车辆以行驶速度v2行驶时与车辆一需要保持的距离;

b表征预变道车辆以减速度ax从行驶速度v1减速至行驶速度v2的行驶距离;

l1为预变道车辆和车辆一之间的初始间距;

v1为预变道车辆的行驶速度;

v2为车辆一的行驶速度;

s1为预变道车辆制动至停止的制动距离;

s2为车辆一制动至停止的制动距离;

tr为预变道车辆的制动反应时间;

d为预变道车辆和车辆一均制动至停止时两者之间的安全停车距离;

当b=(l1-a)≤0时,意愿度λ2=1;

当b=(l1-a)>0,且v1≤v2时,意愿度λ2=0;

当b=(l1-a)>0,且v1>v2时,根据式二计算预变道车辆的减速度ax:

根据公式二计算所述意愿度λ2:

其中,a表征预变道车辆的预设舒适制动减速度athres与减速度ax的差值;

k2表征减速度athres与减速度ax的差值与意愿度λ2之间函数关系的直线斜率;

a1表征减速度athres与减速度ax的差值所在减速度轴上的一个固定减速度值。

7.如权利要求4所述的自动驾驶中车辆变道至目标车道前车之前的预测方法,其特征在于:根据公式三计算所述意愿度λ3,

其中,x表征预变道车辆与车辆一的相对速度;

k3表征预变道车辆与车辆一的相对速度与意愿度λ3之间函数关系的直线斜率;

x1表征预变道车辆与车辆一的相对速度所在速度轴上的一个固定速度值。

8.如权利要求4所述的自动驾驶中车辆变道至目标车道前车之前的预测方法,其特征在于:根据公式四计算所述意愿度λ4,

其中,ρ1表征预变道车辆所在车道前方拥堵程度;

ρ2表征车辆二所在车道前方拥堵程度。

9.如权利要求4所述的自动驾驶中车辆变道至目标车道前车之前的预测方法,其特征在于:计算所述意愿度λ5包括,

计算a=s1-s2+v1*tr+d

a表征预变道车辆以行驶速度v2行驶时需要与车辆一保持的距离;

v1为预变道车辆的行驶速度;

v2为车辆一的行驶速度;

s1为预变道车辆制动至停止的制动距离;

s2为车辆一制动至停止的制动距离;

tr为预变道车辆的制动反应时间;

d为预变道车辆和车辆一均制动至停止时两者之间的安全停车距离;

l1为预变道车辆和车辆一之间的初始间距;

当l1>a+δ1时,λ5=0;

当l1≤a+δ1时,根据公式五计算所述意愿度λ5,

其中,δ1表征一个固定的距离值;

e表征车辆一与车辆三之间的沿车道线距离;

k4表征车辆一与车辆三之间沿车道线距离与意愿度λ5之间函数关系的直线斜率;

e1和e2表征车辆一与车辆三之间沿车道线距离所在距离轴上的两个固定距离值。

10.如权利要求4所述的自动驾驶中车辆变道至目标车道前车之前的预测方法,其特征在于:计算所述意愿度λ6包括,

计算a=s1-s2+v1*tr+d

a表征预变道车辆以行驶速度v2行驶时需要与车辆一保持的距离;

v1为预变道车辆的行驶速度;

v2为车辆一的行驶速度;

s1为预变道车辆制动至停止的制动距离;

s2为车辆一制动至停止的制动距离;

tr为预变道车辆的制动反应时间;

d为预变道车辆和车辆一均制动至停止时两者之间的安全停车距离;

l1为预变道车辆和车辆一之间的初始间距;

当l1>a+δ2时,λ6=0;

当l1≤a+δ2时,根据公式六计算所述意愿度λ6,

其中,δ2表征一个固定的距离值;

f表征车辆三行驶速度与车辆一行驶速度的比值;

f1和f2表征车辆三和车辆一两者行驶速度比所在轴上的两个固定值;

k5表征车辆三与车辆一行驶速度比与意愿度λ6之间函数关系的直线斜率;

λ*表征大于零小于等于1的一个固定值。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1