广告
四轮转向汽车操纵稳定性建模与仿真
则性能指标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求解，采用这种控制策略的四轮转向车辆能获得较优的轨迹跟踪性能。
广告
最新资讯
-
BMS开发(13) --- 硬件版BMS和软件版BMS
2024-05-19 16:05
-
BMS开发(12) --- BMS的安规设计
2024-05-19 16:02
-
BMS开发(11) --- SOH估算
2024-05-19 15:58
-
BMS开发（10）--- 系统低压上下电功能
2024-05-19 15:53
-
BMS开发（9）--- 热管理冷却功能
2024-05-19 15:51
广告
广告
