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

摘要:

权利要求书:

1.一种基于贝塞尔曲线的转向路段路径规划方法,其特征在于,所述转向路段包括车辆转向前的第一条道路和转向后的第二条道路,以三条贝塞尔曲线规划所述车辆的转向路径,第一条贝塞尔曲线位于所述第一条道路,与第一条贝塞尔曲线连接的第二条贝塞尔曲线位于所述第一条道路和所述第二条道路的重叠区域,与所述第二条贝塞尔曲线连接的第三条贝塞尔曲线位于所述第二条道路,所述方法包括:步骤1,确定路径规划的起始状态和终止状态;其中,所述起始状态包括所述车辆的起始位置的横纵坐标和所述车辆在所述起始位置的横摆角度,所述终止状态包括所述车辆的终止位置的横纵坐标和所述车辆在所述终止位置的横摆角度;

步骤2,基于所述车辆的起始位置和所述终止位置以及所述第一条道路和所述第二条道路的边界建立第一四边形模型,收缩所述第一四边形模型的边,以收缩后的第二四边形模型为走廊模型,包括在所述第一条道路内的第一走廊,在所述第二条道路内的第二走廊,所述第一走廊和所述第二走廊在转弯处重叠,收缩宽度为Rs,其中其中,Lw为所述车辆的宽度,Lx为所述车辆的轴距,LR为所述车辆的后悬长度;

所述第一走廊的四条边的表达式为:a11x+b11y+c11=0,a12x+b12y+c12=0,a13x+b13y+c13=0,a14x+b14y+c14=0;

所述第二走廊的四条边的表达式为:a21x+b21y+c21=0,a22x+b22y+c22=0,a23x+b23y+c23=0,a24x+b24y+c24=0:基于所述车辆的起始位置和所述终止位置、所述第一条道路和所述第二条道路的边界以及收缩宽度Rs的值,可以确定系数a11、b11、c11、a12、b12、c12、a13、b13、c13、a14、b14、c14以及系数a21、b21、c21、a22、b22、c22、a23、b23、c23、a24、b24、c24的值;

将所述走廊模型记为T1和T2:

步骤3,建立优化模型,所述优化模型包括:决策变量、目标函数和约束条件;其中,所述决策变量为所述贝塞尔曲线的控制点坐标,所述贝塞尔曲线为五次贝塞尔曲线,所述控制点坐标包括Pij(xi,j,yi,j),i=1,2,3,j=0,1,...5,其中,Pij代表第i条曲线的第j+1个控制点,(xi,j,yi,j)表示第i条曲线的第j+1个控制点的坐标;所述目标函数为所述三条贝塞尔曲线的总长度;所述约束条件包括起始位置约束和终止位置约束、曲线连接处的位置连续约束和横摆角连续约束、避障约束;基于所述决策变量、目标函数和约束条件计算所述三条贝塞尔曲线的总长度最短时的控制点坐标值,并根据控制点坐标与所述贝塞尔曲线之间的关系,得到所述三条贝塞尔曲线,其中,所述控制点坐标与所述贝塞尔曲线之间的关系为:其中,s∈(0,1)为连续变量;

步骤4,以步骤3中得到的所述三条贝塞尔曲线的轨迹作为所述车辆的转向路径;所述目标函数的表达式为:

其中,

矩阵M满足:

矩阵Q满足:

所述起始位置约束和终止位置约束为:其中,xini和yini分别为所述车辆的起始位置的横纵坐标,xter和yter分别为所述车辆的终止位置的横纵坐标;

所述曲线连接处的位置连续约束为:Pi,5=Pi+1,0,i=1,2所述曲线连接处的横摆角连续约束为:Pi,5‑Pi,4=Pi+1,1‑Pi+1,0,i=1,2所述避障约束包括:

第一避障约束,限制所述车辆基于第一贝塞尔曲线行驶至所述第一走廊与所述第二走廊的重叠区域,并且不和所述第一走廊的边界发生碰撞:第二避障约束,限制所述车辆基于第二贝塞尔曲线穿过所述第一走廊与所述第二走廊的重叠区域,并且不和两条走廊的边界发生碰撞:第三避障约束,限制所述车辆基于第三贝塞尔曲线穿过所述第二走廊到达所述终止位置,并且不和所述第二走廊的边界发生碰撞:

2.根据权利要求1所述的方法,其特征在于,还包括:建立非线性规划模型,将步骤4中所述车辆的转向路径作为初始解,根据所述非线性规划模型得到最终的转向路径,其中所述非线性规划模型包括第二决策变量、第二目标函数和第二约束条件,其中,所述第二决策变量与所述步骤3中的所述决策变量相同,所述第二目标函数与所述步骤3中的所述目标函数相同,所述第二约束条件包括所述步骤3中的所述起始位置约束和终止位置约束、所述曲线连接处的位置连续约束和横摆角连续约束,还包括:起始横摆角约束和终止横摆角约束、所述曲线连接处的曲率连续约束、曲率最大约束和优化避障约束。

3.根据权利要求2所述的方法,其特征在于,所述起始横摆角约束和终止横摆角约束为:

其中,θini为所述车辆在所述起始位置的横摆角,θter为所述车辆在所述终止位置的横摆角。

4.根据权利要求2所述的方法,其特征在于,所述曲线连接处的曲率连续约束为:Pi,5‑2Pi,4+Pi,3=Pi+1,2‑2Pi+1,1+Pi+1,0,i=1,2所述曲率最大约束为:

κi,j(s)≤κmax,s∈(0,1)其中,κmax为车辆的最大曲率值;

5.根据权利要求2所述的方法,其特征在于,所述优化避障约束包括:第一优化避障约束:

第二优化避障约束:

第三优化避障约束:

其中,(xf,yf)和(xr,yr)分别为用两个包络圆覆盖车辆轮廓时所述两个包络圆的圆心,通过下式计算得到:

其中,Lx为车辆的轴距,Lf为车辆的前悬长度,Lr为车辆的后悬长度。