模糊＋滑膜轨迹跟踪控制算法 模糊＋滑膜路径跟踪控制算法， 仅供学习，入门 推荐使用版本，csrsim8.02，matlab2016b 算法可实现功能：跟踪双移线，单移线，多项式曲线等多种轨迹，稳定性和较好 也可以跟踪你想要的轨迹 车辆横向控制算法
在自动驾驶的横向控制领域，有个组合算法特别适合刚入门的工程师把玩——模糊+滑膜轨迹跟踪控制。就像调校一辆卡丁车，这个算法既允许我们灵活调整手感（模糊逻辑），又能保证车辆不冲出赛道边界（滑膜控制）。今天咱们就用Matlab2016b配合csrsim8.02环境，手把手实现这个能追踪双移线、单移线甚至你随手画的曲线的控制算法。
模糊＋滑膜轨迹跟踪控制算法 模糊＋滑膜路径跟踪控制算法， 仅供学习，入门 推荐使用版本，csrsim8.02，matlab2016b 算法可实现功能：跟踪双移线，单移线，多项式曲线等多种轨迹，稳定性和较好 也可以跟踪你想要的轨迹 车辆横向控制算法
先看个直观的轨迹跟踪效果。在仿真环境中设置双移线轨迹，当车速提到60km/h时，传统PID控制的横向误差会像心电图一样剧烈波动，而我们的算法误差曲线就像被熨斗烫过一样平滑：
% 双移线轨迹生成 t = 0:0.1:20; refPath = 3.5*sin(t/5) + 1.2*cos(t/3); figure(1) plot(t, refPath, '--r'), hold on plot(t, pid_error, 'b'), plot(t, fuzzy_smc_error, 'g') legend('期望轨迹','PID误差','模糊滑膜误差')这背后的核心秘密武器是两个控制策略的融合。模糊控制器负责处理"大概差不多"的情况，比如当车辆稍微偏离轨迹时，它像经验丰富的司机那样模糊判断该打多少方向。而当误差突然增大到危险边缘时，滑膜控制就像ABS防抱死系统，瞬间介入把车辆拉回安全区域。
来看看模糊控制器的设计要点。我们定义了5个三角形隶属度函数描述横向误差，从"负大"到"正大"，规则库看起来就像驾校教练的口头禅：
fis = newfis('fuzzy_controller'); fis = addvar(fis, 'input', 'e', [-2, 2]); % 横向误差 fis = addmf(fis, 'input', 1, 'NB', 'trimf', [-2, -2, -1]); ... % 20条模糊规则示例 ruleList = [1 1 1 1 1; % 如果误差是NB且变化率是NB，则输出NB 2 2 2 1 1; ...]; fis = addrule(fis, ruleList);滑膜控制的精髓在于那个滑动面函数，这相当于给车辆偏离轨迹的程度划了条警戒线。当误差跨过这条线，控制策略会立即切换模式：
function S = sliding_surface(e, de, lambda) S = de + lambda*e; % lambda是调节响应速度的魔法参数 end % 切换控制量计算 if abs(S) > 0.1 % 进入滑膜区域 u_smc = -K * sign(S); else u_smc = 0; % 由模糊控制器接管 end实际调试时会发现两个模块的配合时机非常关键。就像开手动挡的车，换挡时机不对就会顿挫。这里有个小技巧：在模糊控制输出后叠加滑膜补偿量，而不是简单切换：
% 控制量合成 u_fuzzy = evalfis(fis, [e, de]); % 模糊输出 u_total = u_fuzzy + eta * u_smc; % eta是融合系数，通常取0.3-0.7最后来个实战演示——让车辆跟踪一个突然变道的轨迹。注意看控制量的变化曲线，模糊控制像在画水墨画，而滑膜控制的脉冲信号如同盖上去的印章：
% 突发变道场景 refPath(15:end) = refPath(15:end) + 2; % 第15秒突然右移2米 % 运行仿真 sim('FuzzySMC_Control.slx'); % 可视化方向盘转角 figure(2) subplot(211), plot(t, steering_angle), title('方向盘转角') subplot(212), plot(t, slip_angle), title('车身横摆角')调试时如果发现车辆像醉汉一样画龙，八成是滑膜控制的切换阈值设得太敏感。把lambda参数从1.5降到0.8，立马见效。这算法最妙的地方在于，你甚至可以让它跟踪手写轨迹——在仿真界面用鼠标画个爱心，算法会自动生成控制序列让车辆走出浪漫路线。
