四轮转向汽车操纵稳定性建模与仿真
则性能指标J为最小,其中,P是黎卡提方程的解:
考虑到系统状态的不可测问题,利用观测器重构的状态进行反馈控制,即
其中,
为利用隆伯格观测器(35)估计的x的状态值。
根据(24)所示的稳态横摆角速度响应,以及期望的横摆角速度(32),可得4WS车辆稳态行驶时的前馈控制输入为:
则采用前馈与反馈相结合的控制策略时的前轮转角输入为:
闭环系统仿真
假设观测器极点p=[-10,-20],权重系数为q=5和R=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求解,采用这种控制策略的四轮转向车辆能获得较优的轨迹跟踪性能。
-
汽车测试网V课堂
-
微信公众号
-
汽车测试网手机站
编辑推荐
最新资讯
-
直播|革新汽车仿真:探索 VI-grade 2025.1
2024-11-05 16:03
-
用于高压电池测试的加速度计
2024-11-05 14:44
-
卡特彼勒新一代240吨电动矿卡投入使用
2024-11-05 14:43
-
[法规] 欧盟发布重型车辆事件数据记录仪(E
2024-11-05 14:43
-
城无界野无疆 柴油混动火星9越野版曝时尚越
2024-11-05 12:02