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

摘要:

权利要求书:

1.一种基于双层MPC的智能驾驶汽车轨迹规划与跟踪控制方法,其特征在于:其步骤是:首先根据对轨迹规划的需求,建立全局坐标系下的车辆运动学模型;然后,引入轨迹规划问题的代价函数和约束,包括了构建具有防止碰撞功能代价函数、状态偏差跟踪代价函数以及保证驾驶舒适性、安全性约束的避撞换道轨迹规划层:S1.建立全局坐标系下的车辆的运动学模型简化汽车运动,建立全局坐标系下的车辆的运动学模型,忽略掉了车辆在垂直方向的运动,给出其二维平面上的运动学方程如下:其中,ay代表车辆的侧向加速度,ax代表车辆纵向加速度, 代表车辆的航向角,vy代表车辆的侧向速度,vx代表车辆的纵向速度,X、Y代表车辆在全局坐标系下的位置坐标;

系统模型可以简化为:

T

以 为车辆的状态量,以u(t)=[ay ax]为控制量;

S2、建立带有避免换道过程碰撞代价函数的轨迹规划方法代价函数设计中的位置状态偏差的跟踪代价函数J1,其表达形式如下:其中,NP代表预测步长;WP代表系统状态的权重;Y代表换道轨迹中的自车实际侧向位置坐标;Yref代表目标车道中心线侧向位置坐标,当前道路单车道宽为W;

代价函数设计中的防止障碍车辆与自车碰撞的避撞代价函数J2,其表达形式如下:其中,X、Y代表自车全局坐标系下的纵、横向位置坐标;Nobs代表障碍物坐标点的数量;

Xobsk、Yobsk表第k个障碍物点在全局坐标系下的纵、横向位置坐标;WR表示障碍物与自车碰撞威胁的权重;ε代表一个很小的标量;

设计了如下的控制问题代价函数J3:

其中,NC代表控制步长;u代表当前时刻的待优化控制量;WC代表控制量的权重;

车辆的乘坐舒适性和驾驶的安全性约束如下:umin≤u(t+k)≤umax,k=0,1,…,NC‑1            (6)T T

控制量umin=[‑μg,‑μg];umax=[μg,μg],μ为路面的附着系数;

综合代价函数和约束条件:

s.t.umin≤u(t+k)≤umax,k=1,2,…,NC‑1根据下式求解当前控制量下的状态量,就获得所需的规划的轨迹信息:ξk+1=ξk+Δtf(ξk,uk)                (8);

将以上轨迹规划方法进行改进,扩展至混合路况,针对这种特殊的偶发性混合驾驶路况,在模型预测控制的框架下,构造了带有应急功能的MPC轨迹规划层:建立带有紧急工况规划的代价函数J∑作为常规规划代价函数和紧急规划代价函数的代价综合:J∑=min(Jnormal+Jurgency)               (9)各自的轨迹受制于自己的代价函数,常规工况规划代价函数Jnormal和紧急工况规划代价函数Jnormal,并保持各自的代价函数的独立性;

优化问题的约束如下

受等式约束:

受不等式约束:

根据研究车辆的转向性质和稳定性的关系,建立考虑车辆横摆和滑移的动力学模型;

然后,对建立的模型进行线性化和离散化,给出保证车辆操纵稳定性的道路环境约束、车辆执行机构约束以及稳定行驶约束,利用模型预测控制算法能够处理约束的能力,设计基于代价函数和约束的轨迹跟踪控制层:S1、根据研究车辆的转向性质和稳定性的关系,建立考虑车辆横摆和滑移的车辆动力学模型如下:其中,m代表车辆的质量,vx、vy分别代表车身坐标系下车辆质心处的纵向速度、侧向速度,代表车辆的横摆角,代表车辆的横摆角速度,δf代表车辆的前轮转向角,Iz代表车辆的转动惯量,lf和lr分别代表车辆质心到前、后轴的距离,Fyf和Fyr分别代表车辆前、后轴上的轮胎侧向力的合力,Fxf和Fxr分别代表车辆前、后轴上的轮胎纵向力的合力;

假设忽略耦合关系并且忽略掉前轮纵向驱动力对对车辆横摆运动作用,将上式简化为:运动控制中智能驾驶车辆的相对全局坐标表达式如下:其中X、Y分别代表车辆在相对全局坐标系下的纵、横向位置坐标;

将轮胎力等价为轮胎侧偏角的线性函数表达式:F=Cαα                   (16)其中,Cα代表轮胎线性区的侧偏刚度,α代表轮胎侧偏角;

得到的智能驾驶汽车前轮系统的轮胎侧向力表达式如下:其中,Cαf和Cαr分别代表前、后轮胎的侧偏刚度,β为质心侧偏角,一般可以 同样车辆的纵向力表达式为:Fxf=‑Clfλf

Fxr=‑Clrλr

(18)

其中,Clf和Clr分别代表前、后轮胎的纵向侧偏刚度,λf和λr分别代表前、后轮胎的滑移率;

S2、线性化与离散化

综合上式(13)‑(18),得到车辆在全局坐标系下的非线性模型表示为:该车辆的连续系统状态方程表示如下:

其中,状态量为 控制量为

对上式进行离散化处理,得到离散的状态空间方程:其中,A(k)=I+TA(t),B(k)=TB(t);

S3、安全驾驶约束

车速约束方式如下:

vmin≤v≤vmax                  (22)其中,vmin=0和vmax=1.1*vref分别代表当前驾驶道路最小、最大的驾驶速度,vref代表期望的车辆驾驶速度;

执行器的执行区间的约束:

其中,δfmax代表车辆的最大前轮转向角,也就是车辆转向执行机构的最大约束量,Δδfmax代表每一个控制步最大的前轮转向角变化量;

侧向加速度约束:

|ay|≤μg                   (24)车辆的横摆角速度限制范围:

轮胎的侧偏角限制:

|α|≤5°                    (26)S4、跟踪控制器

轨迹跟踪控制器在每个控制周期进行优化其中, 为轨迹规划层给出的参考轨迹,NP代表预测步长;NC代表控制步长;ε代表松弛变量;WP代表换道期望轨迹跟踪能力的加权;WR代表控制输入的加权;WS代表松弛变量的加权。