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

摘要:

权利要求书:

1.一种自动驾驶汽车驶离环形交叉口的极限轨迹,包括:从任一环道n最晚驶离转向点An,出口道的道路中心线或渠化线的端点B,以及点An、点B之间的极限轨迹AnB;

自动驾驶汽车,下称汽车,其左侧车头沿环道n中心线所在的圆曲线行驶,n=1,2…N,车头方向垂直于中心岛半径方向;

汽车驶出环岛的过程为非受限自由换道,即此过程不受其他汽车影响;

环道n最晚驶离转向点An位于自动驾驶汽车左侧车头,且位于环道n中心线所在的圆曲线;

极限轨迹AnB按照自动驾驶汽车换道或转弯行驶时所采用的五次多项式计算;

一种自动驾驶汽车驶离环形交叉口的极限轨迹的确定方法,其步骤如下:步骤一:将环形交叉口中心岛与环道线均视为正圆形的同心圆,中心岛的圆心为o,半径为r,单位:米;建立以中心岛圆心o为原点的直角坐标系,以自动驾驶汽车的目标出口道中心线为y轴,远离o点的方向为y轴正方向,与y轴正方向顺时针垂直90°的方向为x轴的正方向;

步骤二:自动驾驶汽车左侧车头沿环道n中心线所在的圆曲线在步骤一所述的直角坐标系中的方程为 其中,d为环道宽度,单位:米;

步骤三:以等角度间隔1°在汽车当前位置与y轴之间的环道n中心线所在的圆曲线上取点,任意点i的坐标为(xi,yi)的坐标,其中i=1,2,3…m,(xm,ym)为最晚驶离转向点An;

步骤四:出口道的道路中心线或渠化线的端点B在步骤一所述的直角坐标系中的坐标为(0,r+Nd);

步骤五:以环道n的中心线作为参考线,分别以参考线的切向向量和法向向量所在直线为坐标轴建立Frenet坐标系,采用五次多项式模型描述换道轨迹:式中,t代表换道过程中的某一时刻,单位:秒;s(t)、d(t)分别表示Frenet坐标系下纵向位移和横向位移关于时间t的函数,单位:米;pk、qk分别表示t的系数,k=0,1,2,3,4,5;

对s(t)函数进行二次求导:

式中, 表示t时刻汽车的纵向速度,单位:米/秒, 表示t时刻汽车的纵向加速度,单位:米/平方秒;

将汽车左侧车头驶离环道n中心线的时刻记为t0=0,带入s(t)函数,求得前三项系数:对d(t)函数进行二次求导:

式中, 表示t时刻汽车的横向速度,单位:米/秒, 表示t时刻汽车的横向加速度,单位:米/平方秒;

将汽车左侧车头驶离环道n中心线的时刻记为t0=0,带入d(t)函数,求得前三项系数:步骤六:以任意点i处汽车左侧车头驶离环道n中心线的时刻为t0,令i=1,通过直角坐标系与Frenet坐标系的转换求得(x1,y1)在Frenet坐标系下的纵向位移s(0),求得p0、p1和p2;

定义任意点i处出发的汽车左侧车头到达B点的时刻为换道结束时刻t1i,即i=1时,t1i=t11;令T=t11‑t0,其中T为换道时间,取值范围为[3,10],单位:秒;则B点在Frenet坐标系下的纵向位移为s(t11),目标出口道上汽车的纵向期望速度和纵向期望加速度为 和将t11时刻状态信息 带入s(t)函数,求得系数p3、p4和p5;

再通过直角坐标系与Frenet坐标系的转换求得(x1,y1)在Frenet坐标系下的横向位移d(0),求得q0、q1和q2;

B点在Frenet坐标系下的横向位移为d(t11),目标出口道上汽车的横向期望速度和期望加速度为 和将t11时刻状态信息 带入d(t)函数,求得系数q3、q4和q5,得到Frenet坐标系下的五次多项式换道轨迹;

步骤七:换道过程中,汽车受自身、道路等相关条件的约束,分别为:约束一:汽车自身约束

式中,vs为汽车的横向速度,单位:米/秒;vs,limit为横向速度极限,单位:米/秒;as为横向加速度,单位:米/平方秒;as,limit为横向加速度极限,单位:米/平方秒;vd为纵向速度,单位:米/秒;vd,limit为纵向速度极限,单位:米/秒;ad为纵向加速度,单位:米/平方秒;ad,‑limit为纵向减速度极限,单位:米/平方秒;ad,limit为纵向加速度极限,单位:米/平方秒;

约束二:道路约束

v≤vL,limit

式中,v为汽车横向速度与纵向速度矢量和,单位:米/秒;vL,limit为道路速度限制,单位:米/秒;

步骤八:分别令i=2,3,4…,重复步骤六直至在T的取值范围内轨迹方程无解,令m=i‑

1,此时的(xm,ym)即为环道n最晚驶离转向点An,求得的轨迹AnB即为自动驾驶汽车驶离环形交叉口的极限轨迹。