1.一种基于ESO的车辆轨迹跟踪预测控制方法,其特征在于,包括如下步骤:
1)根据二自由度前轮主动转向车辆在行驶过程中的受力分析,利用魔术公式,建立二自由度前轮主动转向车辆动力学模型;
二自由度前轮主动转向车辆的动力学模型表述为以下形式:式中,m表示整车质量,a,b分别表示质心距离前、后轮的距离,δ
2)基于所述的车辆动力学模型设计轨迹跟踪误差模型;
将式(1)所建立的车辆动力学模型写作由状态量将式(2)在t时刻参考轨迹上的期望点(ξ简化并整理得到轨迹跟踪误差模型:式中,
3)基于所述的轨迹跟踪误差模型设计扩张状态观测器;
由于系统在离散化中省略了其高阶项,以及系统在模型简化存在的误差,设计扩张状态观测器用以估计系统的状态量以及综合扰动,来补偿反馈给MPC,根据存在的未知干扰,得到存在干扰未知项的模型:将带干扰未知项的轨迹更正车辆误差模型写作状态空间形式:式中,f(t)=[d
再对式(5)中带干扰未知项时变模型以T为离散化周期进行离散化:ξ
式中,T为离散化周期,A(k)=I+TA(t),B(k)=TB(t),D将式(6)中的f(k)作为扩张状态观测器中的待扩张状态量进行估计,并结合式(4)的轨迹跟踪误差模型,根据扩张状态观测器理论,将f(k)作为新的状态进行扩张,形式如下:对于上述扩张的系统,设计ESO:式中,Z(k)=[z
式中,z
4)基于扩张状态观测器扰动补偿设计车辆轨迹跟踪预测控制器;
系统离散预测模型如式(8)所示,定义新状态式中,
并且为了简化计算,假设:
假设系统的预测时域为N
Y(k)=ψ(k)λ(k|k)+Θ(k)ΔU(k)+W(k)f(k) (11)式中,
为了对控制增量进行精确约束,把控制增量作为代价函数的状态量,给定以下形式的优化代价函数J(k):式中,Q是输出量的权重矩阵,R是控制量增量的权重矩阵;
并给出控制量约束以及约束横摆角速度约束:式中,U
并通过求解优化问题:
得到最优控制序列ΔU(k),并根据模型预测控制的基本原理,将该控制序列中的第一个元素Δuu(k)=u
根据上述分析得到基于ESO的车辆轨迹跟踪预测控制过程为:S1:初始化:在实际车辆模型上输入参考轨迹,得到离散化各个时刻的期望状态量ξS2:采样当前时刻k系统状态量ξ(k),计算得到误差状态量ξS3:根据当前时刻k期望状态量ξS4:根据当前时刻k的扰动估计值zS5:将该控制序列中的第一个元素ΔuS6:通过式(9)计算下一时刻扩张状态观测器的估计值Z(k+1);
S7:令k=k+1,并返回步骤S2。