1.一种车辆纵侧向耦合轨迹跟踪控制器设计方法,其特征在于,包括以下步骤:步骤一、根据车辆与期望轨迹之间的运动学和动力学关系,建立一种包含系统参数不确定性和车辆纵侧向非线性耦合动力学特征关系的轨迹跟踪模型;
步骤二、设计车辆纵侧向耦合的轨迹跟踪控制器,获得完整的系统控制律;所述轨迹跟踪控制器由类稳态控制、参考动态前馈控制和状态依赖的误差反馈控制三部分组成;
步骤三、结合自适应律补偿由于车辆运动状态变化引起的系统不确定性扰动;
步骤四、通过底层控制分配策略实现了整车的轨迹跟踪控制;
所述步骤一的具体方法如下:
11)假设左、右车轮受力对称,建立简化的车辆动力学模型如下:式中,m表示整车质量;vx表示车辆纵向速度;vy表示车辆侧向速度; 表示车辆纵向速度的微分; 表示车辆侧向速度的微分;ω表示车辆横摆角速度;表示车辆的横摆角速度的微分;Fux表示施加在车辆质心处的等效纵向力;Cwx表示车辆的纵向风阻系数;Cwy表示车辆的侧向风阻系数;Iz表示车辆的转动惯量;lf表示质心到车辆前轴的距离;lr表示质心到车辆后轴的距离;Fyf表示前轮轮胎受到的侧向力;Fyr表示后轮轮胎受到的侧向力;
12)车辆在轨迹跟踪过程中,轮胎处于线性区内,轮胎受到的侧向力近似表示为:式中,Cf表示轮胎前轮侧片刚度;Cr表示轮胎后轮侧偏刚度;αf表示轮胎前轮侧偏角;αr表示轮胎后轮侧偏角;β表示车辆质心侧偏角;δf表示车辆前轮转角;
13)假设轨迹跟踪过程中车辆系统参数的真实值已知,那么完整的车辆动力学模型表示为:
式中, ρi表示系统参数的真实值; 表示系统参数随车辆运动状态变化的理想值;ρoi表示系统参数的标准值,且表示为:式中,Cwy表示车辆的侧向风阻系数;
14)车辆运动学模型为:
式中,xe表示车辆纵向跟踪误差;ye表示车辆侧向跟踪误差; 表示车辆纵向跟踪误差的微分; 表示车辆侧向跟踪误差的微分;vxd表示期望车辆纵向速度;表示实际车辆横摆角的微分; 表示期望车辆横摆角的微分; 表示期望横摆角和实际横摆角之间的误差;
表示期望横摆角和实际横摆角之间的误差微分;ωd表示期望车辆横摆角速度;Rρ表示目标轨迹的道路曲率;
15)对车辆运动学模型求导得到:式中, 表示车辆纵向跟踪误差的二次微分; 表示车辆侧向跟踪误差的二次微分;
表示期望车辆纵向速度的微分; 表示期望车辆横摆角速度的微分; 表示期望横摆角和实际横摆角之间的误差二次微分;表示实际车辆横摆角的二次微分; 表示期望车辆横摆角的二次微分;
T
16)选用纵向和侧向跟踪误差作为系统的状态变量,即x1=[xe ye] ,施加在车辆质心处的等效纵向力和前轮转角作为系统的控制变T
量,即u=[Fux δf] ,将车辆动力学模型代入车辆运动学模型中,获得包含系统参数不确定性的车辆纵侧向耦合非线性轨迹跟踪模型:y=x1 (18)
2
式中,x1和x2表示系统的状态变量;u表示系统的控制变量;y表示系统输出,F1(x1)=0×1 2×2
表示一阶系统变量 矩阵 ;G1 (x1)=I 表示一阶系统状态矩阵 ;
表示二阶系统变量矩阵; 表示
二阶系统控制矩阵;P1和P2为系统参数矩阵,f2,1(x)、g2,1(x)表示系统局部基函数,f2(x)、g2(x)且表示系统总体基函数:
T T T
P1=[ρ1 ρ2 ρ3 ρ4 ρ6 ρ7],P2=[ρ5 ρ8],g2(x)=[g2,2(x) g2,3(x)],T
f2(x)=[f2,2(x) f2,3(x) f2,4(x) f2,5(x) f2,6(x) f2,7(x)],式中,P1和P2为系统参数矩阵,ρi,i=1,2,…8,表示系统参数的真实值;f2,j(x),j=1,
2,…7,、g2,k(x),k=1,2,3,表示系统局部基函数;f2(x)、g2(x)表示系统总体基函数; 表示期望车辆纵向速度的微分。
2.根据权利要求1所述的一种车辆纵侧向耦合轨迹跟踪控制器设计方法,其特征在于,所述步骤二的具体方法如下:
21)对系统输出y求导,直至控制输入u的出现:式中,x1和x2表示系统的状态变量; 表示系统的状态变量微分;表示系统输出的微分;表示系统输出的二次微分;,F1(x1)表示一阶系统变量矩阵;G1(x1)表示一阶系统状态矩阵;u表示系统的控制变量; 表示二阶系统输出的输出矩阵;
B(x)=G1(x1)G2(x)表示二阶系统输出的控制矩阵;C(x)=G1(x1)F2(x)表示二阶系统输出的参数矩阵;F2(x)表示二阶系统变量矩阵;G2(x)表示二阶系统控制矩阵;
22)假设系统已经处于稳态运动状态,此时 那么系统的类稳态控制律为:式中,us表示系统的类稳态控制律;G2(x)表示二阶系统控制矩阵;F2(x)表示二阶系统变量矩阵;f2,1(x)、g2,1(x)表示系统局部基函数;f2(x)、g2(x)表示系统总体基函数;P1和P2为系统参数矩阵;
23)在标定的控制律中加入前馈控制律用于提高系统的响应性能,即:u=us+uf (22)式中,u表示系统控制律;us表示系统的类稳态控制律,uf表示系统的动态参考前馈控制律;
令y=yd, 将控制律(22)代入系统(20),获得前馈控制律为:式中,uf表示系统的动态参考前馈控制律;G2(x)表示二阶系统控制矩阵; 表示系统期望输出的微分; 表示系统期望输出的二次微分;A(x)表示二阶系统输出的输出矩阵;A(x)表示二阶系统输出的输出矩阵;P2为系统参数矩阵;g2,1(x)表示系统局部基函数;g2(x)表示系统总体基函数;
24)引入误差反馈控制律为:
u=us+uf+ue (24)式中,u表示系统控制律;us表示系统的类稳态控制律;uf表示系统的动态参考前馈控制律;ue表示系统的误差反馈控制律;
定义系统跟踪误差为e1=yd‑y,将控制律(24)其代入系统(20)中可以求得:式中, 表示系统跟踪误差微分; 表示系统跟踪误差的二次微分;A(x)表示二阶系统输出的输出矩阵;G2(x)表示二阶系统控制矩阵;ue表示系统的误差反馈控制律;
令 那么闭环误差系统表示为:
式中, 表示系统跟踪误差微分;e2表示虚拟控制输入; 表示虚拟控制输入微分;A(x)表示二阶系统输出的输出矩阵;G2(x)表示二阶系统控制矩阵,ue表示系统的误差反馈控制律;
25)选用e2为虚拟控制输入,定义李雅普诺夫函数 那么对应的导数为:式中, 表示定义的第一个李雅普诺夫函数微分;e1表示系统跟踪误差; 表示系统跟踪误差微分;e2表示虚拟控制输入;
26)为了保证闭环控制系统稳定性,即 选用虚拟控制输入为:式中, 表示期望虚拟控制输入;e1表示系统跟踪误差,k1表示控制器参数;
对于k1>0, 可以得到:
式中, 表示定义的第一个李雅普诺夫函数微分;k1表示控制器参数;e1表示系统跟踪误差; 表示系统跟踪误差微分;
27)为了使e2趋近于 来确保系统e1→0,我们定义 那么得到:式中, 表示定义的第一个李雅普诺夫函数微分,k1表示三步法控制器参数,e1和 分别表示系统跟踪误差和系统跟踪误差微分,e3表示虚拟控制输入误差;
随着e3→0,得到 那么系统e1渐进稳定,对误差e3进行求导可得:式中, 表示虚拟控制输入误差微分;e2表示实际虚拟控制输入; 表示期望虚拟控制输入微分; 表示虚拟控制输入微分;k1表示控制器参数; 表示系统跟踪误差微分;A(x)表示二阶系统输出的输出矩阵;G2(x)表示二阶系统控制矩阵;ue表示系统的误差反馈控制律;
28)定义包含误差e3在内的李雅普诺夫函数 进行求导得:式中, 表示定义的第二个李雅普诺夫函数微分; 表示定义的第一个李雅普诺夫函数微分;e3表示虚拟控制输入误差; 表示虚拟控制输入误差微分;k1表示控制器参数;e1表示系统跟踪误差; 表示系统跟踪误差微分;A(x)表示二阶系统输出的输出矩阵;G2(x)表示二阶系统控制矩阵;ue表示系统的误差反馈控制律;
根据李亚普诺夫直接法,选取误差反馈控制律为:式中,ue表示系统的误差反馈控制律;A(x)表示二阶系统输出的输出矩阵;G2(x)表示二阶系统控制矩阵;k1和k2表示控制器参数;e1表示系统跟踪误差; 表示系统跟踪误差微分;
e3表示虚拟控制输入误差;
选择k2>0,那么
式中, 表示定义的第二个李雅普诺夫函数微分;k1和k2表示控制器参数;e1表示系统跟踪误差;e3表示虚拟控制输入误差;
29)误差闭环系统渐进稳定,将(26)、(29)以及 代入(36)中,获得实际应用的误差反馈控制律为:
式中,ue表示系统的误差反馈控制律;A(x)表示二阶系统输出的输出矩阵,G2(x)表示二阶系统控制矩阵;k1和k2表示三步法控制器参数;e1表示系统跟踪误差; 表示系统跟踪误差微分;g2,1(x)表示系统局部基函数;g2(x)表示系统总体基函数;P2为系统参数矩阵;
获得的完整的系统控制律:
其中,u表示系统控制律;us为系统类稳态控制律;uf系统动态参考前馈控制律;ue表示‑1 ‑1
系统误差反馈控制律;fP(x)=[G2(x)] (1+k1k2)表示比例项参数;fD(x)=[G2(x)] [k1+k2+A(x)]表示微分项参数;A(x)表示二阶系统输出的输出矩阵;G2(x)表示二阶系统控制矩阵;
k1和k2表示控制器参数;e1表示系统跟踪误差; 表示系统跟踪误差微分。
3.根据权利要求1所述的一种车辆纵侧向耦合轨迹跟踪控制器设计方法,其特征在于,所述步骤三的具体方法如下:
31)定义系统参数估计值:
式中, 表示系统参数估计值; 表示系统参数随车辆运动状态变化的估计值;,ρoi表示系统参数的标准值;
32)系统控制律重新被定义为:
式中,u表示系统控制输入; 表示二阶系统变量矩阵估计值; 表示二阶系统控制矩阵估计值; P1和P2为系统参数矩阵估计值; 表示系统参数估计值; 表示系统期望输出的微分; 表示系统期望输出的二次微分; 表示二阶系统输出的输出矩阵估计值;e1表示系统跟踪误差; 表示系统跟踪误差微分;k1和k2表示控制器参数;
33)将获得的系统控制律(41)代入系统(20)中,可以得到:式中,表示系统输出的二次微分;k1和k2表示控制器参数; 表示二阶系统输出的输出矩阵估计值;e1表示系统跟踪误差; 表示系统跟踪误差微分;F2(x)表示表示二阶系统变量矩阵; 表示二阶系统变量矩阵估计值;G2(x)表示二阶系统控制矩阵; 表示二阶系统控制矩阵估计值;u表示系统控制输入; 表示系统期望输出的二次微分;
根据上式,考虑参数不确定的闭环误差系统可以整理为:其中,
式中,k1和k2表示控制器参数; 表示二阶系统输出的输出矩阵估计值;e1表示系统跟踪误差; 表示系统跟踪误差微分;ΔP表示系统参数矩阵总误差;θ表示系统组合基;P1和P2表示系统参数矩阵;ΔP1和ΔP2表示系统参数矩阵误差; 表示系统参数随车辆运动状态变化的估计值; 表示系统参数随车辆运动状态变化的理想值;f2(x)、g2(x)表示系统总体基函数;u表示系统控制输入;
34)选取 为误差系统的状态变量,那么得到:式中,em表示误差系统的状态变量; 表示误差系统的状态变量微分;
表示误差系统的状态变量参数矩阵;
表示误差系统的参数变量矩阵;θ表示系统组合基;ΔP表示系统参数矩阵总误差;k1和k2表示控制器参数;
35)定义包含系统参数不确定性的李雅普诺夫函数 其中Q>0为正定对称矩阵,求导得:
式中, 表示定义的第三个李雅普诺夫函数微分;em表示误差系统的状态变量;Am表示误差系统的状态变量参数矩阵;Q表示正定对称矩阵;Bm表示误差系统的参数变量矩阵;θ表示系统组合基;ΔP表示系统参数矩阵总误差; 表示系统参数矩阵总误差微分;τ表示参数误差变量参数量化参数;表示系统参数自适应律;
36)取系统参数自适应律为:
式中,表示系统参数自适应律;τ表示参数误差变量参数量化参数;em表示误差系统的状态变量;Q表示正定对称矩阵;Bm表示误差系统的参数变量矩阵,θ表示系统组合基;
将系统参数自适应律代入至(45)中得:式中, 表示定义的第三个李雅普诺夫函数微分;em表示误差系统的状态变量;Q表示正定对称矩阵;Am表示误差系统的状态变量参数矩阵。
4.根据权利要求1所述的一种车辆纵侧向耦合轨迹跟踪控制器设计方法,其特征在于,所述步骤四的具体方法如下:
基于轨迹跟踪控制器求解得到的施加在车辆质心处的等效纵向力Fux并不能直接应用于车辆控制,需要通过底层控制分配策略对其进行分解已获得车辆能够响应的驱动转矩信号Ttq和制动压力信号;
当施加在车辆质心处的等效纵向力Fux大于等于0时,认为车辆系统处于驱动模式,对应的驱动转矩表示为:
式中,Ttq表示车辆目标驱动转矩信号;Fux表示施加在车辆质心处的等效纵向力;R表示车轮滚动半径;i0表示整车全部等效传动比;ηT表示整车全部等效传动效率;
当施加在车辆质心处的等效纵向力Fux小于0时;认为车辆系统处于驱动模式,对应的驱动转矩可以表示为:
式中,P表示车辆目标主缸制动压力;Fux表示施加在车辆质心处的等效纵向力;R表示车轮滚动半径;D表示制动主缸直径;RB表示有效制动卡钳半径;It表示轮胎转动惯量;表示轮胎转速的微分。