首页 > 汽车技术 > 正文

四轮转向汽车操纵稳定性建模与仿真

2023-01-30 10:02:35·  来源:智能运载装备研究所  
 
由最优控制理论可知,若控制输入为

图片

则性能指标J为最小,其中,P是黎卡提方程的解:

图片

考虑到系统状态的不可测问题,利用观测器重构的状态进行反馈控制,即

图片

其中,

图片

为利用隆伯格观测器(35)估计的x状态值。

根据(24)所示的稳态横摆角速度响应,以及期望的横摆角速度(32),可得4WS车辆稳态行驶时的前馈控制输入为:

图片

则采用前馈与反馈相结合的控制策略时的前轮转角输入为:

图片

闭环系统仿真

假设观测器极点p=[-10,-20],权重系数为q=5R=1,利用以下代码求解观测器和控制器增益矩阵。vx=10;m=1920;Iz=3217;Cf=70000;Cr=110000;lf=1.55;lr=1.45;L=lf+lr;Ga=0.001;Gd=(Cf*lf*m*vx^2-Cf*Cr*lr*L-Ga*Cf*Cr*L*vx^2)/(Cr*lr*m*vx^2+Cf*Cr*lf*L);A=[-(Cf+Cr)/m/vx,-(Cf*lf-Cr*lr-Ga*Cr*vx^2)/m/vx-vx;-(Cf*lf-Cr*lr)/Iz/vx,-(Cf*lf^2+Cr*lr^2+Ga*Cr*lr*vx^2)/Iz/vx];B=[(Cf+Gd*Cr)/m;(Cf*lf-Gd*Cr*lr)/Iz];C=[0,1];p=[-10,-20];Ke=place(A',C',p)';

Q=[0,0;0,10];R=1;K=lqr(A,B,Q,R);

求解结果如下:

Ke=[-2.5820;7.7123],K=[0.0281,1.9669]

假设车辆行驶速度在10m/s附近波动,期望的圆周轨迹半径为50m,即期望轨迹的曲率为0.02。设计四轮转向车辆的圆周轨迹跟踪控制器,并完成4WS车辆的闭环仿真。对比四轮转向和两轮转向车辆的轨迹跟踪性能,以及PID控制和基于隆伯格观测器的LQR状态反馈控制效果,系统仿真结果如下图所示。

图片

15  前后轮转角输入

图片

16  侧向速度响应

图片

17  侧向位移响应

图片

18  横摆角速度响应

图片

19  车辆行驶轨迹

由仿真结果可见,四轮转向车辆的轨迹跟踪性能优于前轮转向车辆,由于车速为10m/s,小于临界车速,因此四轮转向车辆是逆位转向模式,故四轮转向车辆的横摆角速度略高于两轮转向车辆。LQR的控制效果也优于PID的控制效果,在PID的仿真结果中出现了大幅度的振荡,由PID控制的四轮转向车辆也出现了微小的侧偏,而在LQR控制的四轮转向车辆中几乎没有侧偏发生。综上,采用前馈与反馈相结合的方式,并利用隆伯格观测器重构系统状态后用于反馈控制,观测器和控制器分别采用极点配置法和LQR求解,采用这种控制策略的四轮转向车辆能获得较优的轨迹跟踪性能。

分享到:
 
反对 0 举报 0 收藏 0 评论 0
沪ICP备11026917号-25