四轮转向4WS轨迹跟踪控制模型 采用双SMC控制 4WS通过积分滑模控制跟踪期望横摆角速度和质心侧偏角效果很好~ 轨迹跟踪为双移线输入采用积分滑模控制 【特别说明】 是针对两篇论文的控制进行复现哦~ 提供参考文献及模型文件最近在复现四轮转向轨迹跟踪控制模型时发现把双积分滑模控制Double SMC塞进4WS系统里效果出奇带劲。尤其是处理双移线轨迹这种蛇皮走位工况车辆横摆角速度和质心侧偏角的耦合关系就跟量子纠缠似的难搞这时候滑模控制的强鲁棒性就派上用场了。先说控制框架的邪门之处传统SMC对付单一变量还行但4WS需要同时控制横摆角速度γ和质心侧偏角β这两个冤家。于是直接祭出双滑模控制器左手一个β跟踪右手一个γ跟踪中间用方向盘转角δf和后轮转角δr联动输出。!4WS控制架构示意图核心代码里最骚的操作是这个积分滑模面设计class SlidingModeController: def __init__(self, k, lambda_, alpha): self.k k # 滑模增益 self.lambda_ lambda_ # 积分系数 self.alpha alpha # 指数项系数 self.integral 0 # 误差积分 def compute_surface(self, error, dt): self.integral error * dt s error self.lambda_ * self.integral return s def control_law(self, s): u_eq -self.alpha * np.sign(s) # 等效控制 u_sw -self.k * abs(s)**0.5 * np.sign(s) # 切换控制 return u_eq u_sw这里的积分项λ∫e dt像牛皮糖一样粘着稳态误差不放而指数项|s|^0.5则让系统状态在滑模面上开启漂移模式既削弱了抖振又保持了收敛速度。实际调参时发现个反直觉现象后轮转向的增益系数竟然要比前轮小0.3倍左右才能避免画龙。后来翻论文才知道这是因为后轮转角对质心侧偏角的影响更为敏感就跟踩高跷时调整脚后跟比脚尖更需要小心一个道理。仿真时最惊艳的是双移线工况下的航向角跟踪效果% 双移线轨迹生成 function [ref_pos] double_lane_change(t) if t 2 Y_ref 0; elseif t 5 Y_ref 3.5*(1 - cos(2*pi*(t-2)/6)); else Y_ref 0; end ref_pos Y_ref; end当车速提到80km/h时普通PID控制的车辆像喝醉的狗熊左摇右摆而双SMC控制的车却走出了六亲不认的精准步伐。从相平面图上看系统状态点就像被磁铁吸住一样紧贴滑模面滑动这大概就是鲁棒控制的魅力吧。四轮转向4WS轨迹跟踪控制模型 采用双SMC控制 4WS通过积分滑模控制跟踪期望横摆角速度和质心侧偏角效果很好~ 轨迹跟踪为双移线输入采用积分滑模控制 【特别说明】 是针对两篇论文的控制进行复现哦~ 提供参考文献及模型文件不过实验中也踩过坑有一次没加积分项结果质心侧偏角出现0.5°的稳态误差导致车辆在长直道行驶时居然会像螃蟹一样横着走。后来在滑模面里加入误差积分项相当于给系统装了个自动纠偏陀螺仪问题迎刃而解。参考文献方面主要复现了[1] 《四轮转向车辆全工况积分滑模控制》里的分层控制架构[2] 《双移线工况下4WS鲁棒跟踪方法》中的耦合关系解耦技巧模型文件已打包在Github仓库地址示例github.com/4ws-control包含CarSim-Simulink联合仿真模型和Python控制核心模块。下次打算试试把神经网络和滑模控制杂交看能不能整出更生猛的控制效果。注文中代码为示意片段完整实现需考虑轮胎魔术公式、整车动力学模型等细节