欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2021100496098
申请人: 长沙理工大学
专利类型:发明专利
专利状态:未下证
专利领域: 一般车辆
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种自动驾驶交叉口车辆进入时刻与行驶轨迹控制方法,其特征在于,该方法包括如下步骤:

步骤1:采集交叉口信息作为控制模型的输入条件,包括交叉口的类型、大小、各方向进口道和出口道的车道数、车道宽度;采集车辆信息,包括当前时刻车辆所在位置到交叉口停车线的距离sc,其中c表示车辆,c∈C,C表示车辆的集合,当前时刻车辆的速度,根据sc对车辆进入交叉口的次序进行排序,车辆按次序以先到先服务的规则依次进入交叉口;

步骤2:在交叉口建立直角坐标系,确定车辆通过进口道和出口道的位置点坐标,根据进口道位置点和出口道位置点,建立方程刻画车辆在交叉口内部的行车路径,路径间的交点为冲突点,通过路径方程确定各冲突点的坐标,根据距离公式计算每条轨迹上进口道位置点到冲突点的距离;

步骤3:设置速度控制区域,针对每辆车计算速度控制区域的长度,车辆进入速度控制区域后不再变换车道,在速度控制区域内调整车速;

步骤4:将车辆分为有前车和无前车两类,车辆为每条进口车道第一辆车时,建立控制模型,在满足冲突点时间制约地条件下,车辆以尽可能大的速度到达冲突点,确定车辆进入交叉口的时间及行驶轨迹,当车辆通过冲突点后更新冲突点的时间;

步骤5:车辆在进口车道上有前车时,前车和冲突点对车辆均有制约,为了确保行车安全,兼顾效率,后车尽可能以前车进入交叉口的时间到达交叉口,且车速不能大于前车车速,建立控制模型,确定车辆进入交叉口的时间及行驶轨迹,当车辆通过冲突点后更新冲突点的时间。

2.根据权利要求1所述的一种自动驾驶交叉口车辆进入时刻与行驶轨迹控制方法,其特征在于,所述步骤3包括如下步骤:步骤31:车辆在各自的速度控制区域内调整速度,不换道行驶;速度控制线外车辆匀速行驶速度为VM,车辆行驶到速度控制线内减速,速度控制区域为以aL的最大舒适减速度将速度从VM减到0,到达停车线或队尾的距离,用Lc表示,由公式(1)计算:式中:VM表示速度控制线外车辆匀速行驶的速度,aL表示最大舒适减速度,Lc表示速度控制线的长度,c表示车辆,c∈C,C表示车辆集合,当车辆c同一车道上无前车时,Lc从停车线算起,当车辆c同一车道上有前车时,Lc从前车车尾算起;

所述步骤4,包括如下步骤:

步骤41:根据同一车道上车辆是否有前车,将车辆分为两类,第一类,同一车道上没有前车,即车辆为当前车道第一辆车时,只有冲突点的时间制约车辆,当车辆到达冲突点的时刻大于等于冲突点的时刻时,车辆能顺利通过冲突点,否则,车辆不能顺利通过冲突点,需要根据冲突点的时间调整车速或者停车等待;第二类,同一车道上有前车时,在控制车辆行驶轨迹时需要同时考虑前车和冲突点的约束;

步骤42:对于无前车的情况,即车辆为当前车道的第一辆车,只有冲突点制约车辆进入交叉口,根据冲突点的时间调整车速,再计算车辆通过交叉口停车线的时间和速度,为后车控制提供依据; 表示第n辆车以VM的速度匀速行驶到冲突点pi所花费的时间,由公式(2)计算:

式中:C1表示各方向进口道第一辆车的集合,Ln,pi表示车辆n从速度控制线到冲突点pi的距离;

(m)

当车辆通过每个冲突点后,更新冲突点的时间,车辆n只能在Tpi 之后通过该冲突点才(m)

能确保安全,车辆通过该冲突点的时间要大于等于更新后的冲突点时间,Tpi 表示第m辆车(m)

通过冲突点pi更新后的时间,Tpi 由公式(3)计算:(m)

Tpi =Tm,pi+τ           (3)式中:Tm,pi表示第m辆车到达冲突点pi时刻,τ表示安全时间间隔;

当 时,说明车辆n以VM的速度匀速行驶到冲突点的时刻晚于冲突点的时刻,此时车辆以VM速度匀速行驶能安全通过冲突点pi,行驶到达停车线的时间Tn,sl由公式(4)计算,车尾通过停车线的时间用T′n,sl表示,由公式(5)计算;

式中:dc表示车辆长度和最小车头间距之和,Ln,sl表示车辆n速度控制线到停车线的距离;

步骤43: 表示第n辆车进入速度控制区域后以aL的最大舒适减速度从VM立即减速到vmin后匀速行驶到冲突点pi花费的时间,由公式(6)计算:式中:vmin为车辆行驶的最小速度,aL最大舒适减速度;

当 时,表示车辆以最小速度行驶消磨最多的时间,到达冲突点的时刻仍然早于冲突点的时刻,此时如果不停车,则不能安全通过冲突点,车辆n必须在停车线停车等待;车辆以最快速度到达停车线停车,减少对路段上后车的影响,到达停车线的时刻Tn,sl由公式(7)计算:

车辆从停车线以aU的最大舒适加速度启动进入交叉口,行驶到冲突点的距离用Ln,sl,pi表示,车辆在交叉口等待的时间tn,w,由公式(8)计算:式中:tn,w表示车辆在停车线等待的时间,aU表示最大舒适加速度,Ln,sl,pi表示车辆n从停车线sl位置点到冲突点pi的距离,车尾通过停车线的时间T′n,sl由公式(9)计算:步骤44:当 区间时,车辆n可以通过调整车速,使得车辆尽(m)

可能在冲突点时刻Tpi 后通过冲突点,且车辆通过冲突点的速度尽可能接近VM,速度调整如情况1和情况2所示:

(m)

情况1:调整速度后,到达冲突点的时刻等于冲突点时刻Tn,pi=Tpi ,到达冲突点的车速vn,pi=VM,则可能存在匀速行驶阶段,通过公式(10)‑(15)计算v′、vn,pi、各阶段行驶结束的时刻T1、T2、T3、T4、Tn,pi:‑aL≤a‑,a+≤aU               (13)vmin≤v′≤vn,pi=VM              (14)(m)

0<T1<T2≤T3<T4≤Tn,pi=Tpi             (15)式中:T1、T2、T3、T4、Tn,pi表示每个行驶阶段结束的时刻,v′为中间变量,表示减速的最终速度,a‑表示减速度大小、a+表示加速度大小,vmin表示规定车辆在速度调整阶段的最小速度,vn,pi表示到达冲突点的车速;

以速度波动最小为最佳方案,如公式(16)约束:min(VM‑v′)                  (16)最终得到距离与时间的函数和速度与时间的函数如公式(17)‑(18)所示:式中:sn(t)表示车辆n在t时刻与出发点的距离,vn(t)表示车辆n在t时刻的速度;

情况2:当车辆进入速度控制区域,通过速度调整,到达冲突点的车速可能达不到VM,此时车辆在行驶过程中不存在以VM匀速行驶阶段,通过公式(13)、(19)‑(23)计算vn,pi、中间变量v″和每个阶段的行驶时间T6、Tn,pi:v″=VM‑a‑·T6              (20)vn,pi=v″+a+·(Tn,pi‑T6)           (21)vmin≤v″≤vn,pi<VM               (22)(m)

0<T6≤Tn,pi=Tpi              (23)式中:T6、Tn,pi表示每个行驶阶段结束的时刻,v″为中间变量,表示减速的最终速度,vn,pi表示到达冲突点的车速;情况2中当T6=Tn,pi时,示车辆n没有匀加速行驶阶段;

以车辆到达冲突点的速度最大为目标,满足公式(24)约束:min(VM‑vn,pi)               (24)最终得到距离与时间的函数和速度与时间的函数如公式(25)‑(26)所示:步骤45:根据车辆到达冲突点的速度vn,pi和时间Tn,pi,以及停车线位置点到冲突点的距离Ln,sl,pi,计算到达停车线的时间Tn,sl、车尾通过停车线的时间T′n,sl和速度vn,sl,为后车速度控制提供依据。

3.根据权利要求2所述的一种自动驾驶交叉口车辆进入时刻与行驶轨迹控制方法,其特征在于,所述步骤5包括如下步骤:步骤51:对于有前车的情况,前车对后车制约,由于车辆在速度控制区域不换道,后车不可能越过前车提前进入交叉口,因此首先考虑前车对后车的制约;tn,sl,pi表示第n辆车从停车线到冲突点pi的时间,由公式(27)计算:(m)

当T′n‑1,sl+tn‑1,sl,pi≥Tpi 时,说明第n‑1辆车到达冲突点的时刻大于等于冲突点的时(m)

刻Tpi ,第n‑1辆车能顺利通过冲突点,此时,为了提高通行效率,降低控制延误,同车道的第n辆车应尽可能追赶第n‑1辆车,以第n‑1辆车车尾进入行车线的时刻到达停车线,且速度(m)

与第n‑1辆车保持一致,T′n,sl表示第n辆车车尾通过停车线的时刻,Tpi 表示冲突点pi的时间;

δ表示车身通过停车线的时间,车辆长度用dc表示,车辆以vn,sl的速度通过停车线进入交叉口,当vn,sl=VM时,匀速通过,当vn,sl<VM,由于dc为车辆长度,距离很短,认为不存在加速到VM后匀速的阶段,一直匀加速行驶,δ由公式(28)计算:表示第n辆车以VM的速度匀速行驶到停车线所花费的时间,由公式(29)计算;

表示第n辆车进入速度控制区域后以最大舒适减速度aL从VM立即减速到vmin后匀速行驶到停车线花费的时间,由公式(30)计算:当 时,表示第n辆车以VM匀速行驶,也追不到第n‑1辆车,则车辆n以VM行驶,其中μ表示前后车安全时间间隔;

当 时,表示第n辆车以aL的减速度从VM立即减速到vmin的时间早于第n‑1辆车进入交叉口的时间,这种情况下车辆n必须停车;

当 时,车辆n可以通过调整车速,使得行驶到停车线的时刻尽可能接近前车车尾通过停车线的时刻,且车速等于前车车速;

车辆从当前位置开始以VM匀速行驶,以舒适减速度a‑减速行驶,速度减到与前车速度v″′后匀速行驶,再加速行驶到停车线,速度增加到vn,sl,再以vn,sl匀速行驶,由公式(13)、(31)‑(36)计算T8、T9、T10、T11、Tn,sl、加速度a‑、a+、中间变量v″′;

v″′=VM‑a‑·(T9‑T8)          (32)vn,sl=v″′+a+·(T11‑T10)       (33)vmin≤v″′≤vn,sl≤vn‑1,sl          (34)

0≤T12<T13≤T14<T15≤Tn,sl         (35)Tn,sl≥T′n‑1,sl+μ             (36)式中:T8、T9、T10、T11、Tn,sl表示每个行驶阶段结束的时刻,v″′为中间变量,表示减速后的速度,规定车辆在速度调整阶段的最小速度为vmin,则减速后的速度v″′大于等于最小速度vmin;μ表示前后车安全时间间隔,T8=0表示车辆n没有以VM匀速行驶阶段;T9=T10表示车辆n没有以v″′匀速行驶阶段;T11=Tn,sl表示车辆n没有以vn,sl匀速行驶阶段;

在速度vn,sl尽可能接近vn‑1,sl的前提下,速度波动最小为目标,满足公式(37)约束:α·min(vn‑1,sl‑vn,sl)+β·min(VM‑v″′)          (37)式中,α、β表示权重系数;

得到距离与时间的函数和速度与时间的函数如公式(38)‑(39)所示:(m)

当T′n‑1,sl+tn‑1,sl,pi<Tpi 时,说明第n‑1辆车不能通过冲突点,则需要在交叉口停车等待,则后车减速行驶到前车车尾时速度为0;

(m)

步骤52:当T′n‑1,sl+t′n‑1,sl,pi≥Tpi 且 时,说明第n‑1辆车不受冲突点的约束,能在T′n‑1,sl时刻进入交叉口,且车辆n能够通过调整速度在T′n‑1,sl+μ的时刻以与n‑1辆车相同的速度vn,sl≤vn‑1,sl到达停车线,继续判断车辆n是否能通过制约车辆n的冲突点,同一车道上的车辆转向不一定相同,根据车辆n‑1与车辆n的转向是否相同,可以分为情况3和情况4两种情况:情况3:车辆n‑1与车辆n的转向相同时,在交叉口内部的行驶轨迹相同,制约车辆n和车辆n‑1的冲突点相同,车辆n‑1不受冲突点时刻的制约,则第n辆车同样不受冲突点时刻制约,能紧跟前车通过交叉口;

情况4:车辆n‑1与车辆n的转向不相同时,在交叉口内部的行驶轨迹不相同,制约车辆n和车辆n‑1的冲突点不相同,需进一步判断车辆n能否不停车进入交叉口;

表示第n辆车通过停车线后以aL的减速度从vn,sl立即减速到vmin,匀速行驶到冲突点花费的时间,由公式(40)计算:Ln,,sl,pi表示车辆n从停车线位置点到冲突点pi的距离,(m)

Tpi 表示冲突点pi的时间,当 时,表示第n辆车以最大消耗时间行驶到冲突点,仍然早于冲突点的时间,则必须在停车线停车等待;

表示车辆n在速度vn,sl以最大舒适加速度aU立即增加到VM后匀速花费的时间,(m)

当 时,说明车辆可以调整车速在Tpi 时刻通过冲突点,转至步骤4继续计算车辆通过冲突点的车速。