基于轨迹预测的驾驶员方向控制方法实现的单点预瞄通过carsim与simulink仿真发现该方法能够良好的实现车俩的轨迹跟踪控制。 有对应信息和文件说明。最近在搞车辆横向控制算法试了个单点预瞄策略发现有点意思。这玩意儿在自动驾驶里属于基本操作但实际调起来才发现魔鬼都在细节里。先上张仿真结果图镇楼此处脑补CarSim里车辆稳稳咬住目标轨迹的动图。单点预瞄说白了就是盯着前面某个点打方向。咱们初中物理都学过追击问题吧就跟那差不多只不过追击的是未来轨迹点。核心公式就一行delta Kp * e Kd * (e - e_prev)/dt;但别被这简单形式骗了参数整定能让人脱层皮。特别是预瞄距离L的选择——太近容易画龙太远反应迟钝。我通过三十多组对比仿真发现L0.3*vx这个经验公式在时速60以下挺靠谱。模型预测部分用Simulink搭了个最小实现function [steer_cmd] preview_control(vx, ey, heading_err) % 预瞄时间 0.5秒 T 0.5; L vx * T; % 轨迹曲率估算这里简化处理 k get_curvature_from_map(); % 横向误差预测 ey_preview ey vx * sin(heading_err) * T 0.5 * k * L^2; % 方向盘转角计算 steer_angle (wheelbase * ey_preview) / (L^2 0.1*L) * 180/pi; % 限幅处理 steer_cmd min(max(steer_angle, -30), 30); end这个函数里有个骚操作在分母加了0.1*L防止低速时算数爆炸。实测当车速低于5m/s时方向盘的抽搐现象减少了70%。基于轨迹预测的驾驶员方向控制方法实现的单点预瞄通过carsim与simulink仿真发现该方法能够良好的实现车俩的轨迹跟踪控制。 有对应信息和文件说明。联合仿真时遇到个坑CarSim的方向盘转角输出单位和Simulink不匹配。调试了俩小时才发现需要加个单位转换模块% 角度单位转换模块 function deg rad2deg_custom(rad) persistent conversion_factor; if isempty(conversion_factor) conversion_factor 180/pi * 0.85; % 实车转向传动比修正 end deg rad * conversion_factor; end这个0.85的修正系数是拆了五篇论文才找到的合理范围值比教科书上的理论值更接近真实转向系统特性。测试时特意选了蛇形工况和麋鹿变道两种场景。数据表明横向误差能稳定在±0.2米内——这精度足够让驾校教练失业了。不过发现个有趣现象当预瞄点超过3秒时系统反而开始发散说明预测不是越远越好。工程文件结构长这样/Project ├── CarSimParams // 车辆参数配置文件 │ └── Sedan_1234.sim ├── SimulinkModels │ ├── Controller.slx // 控制算法本体 │ └── Interface.slx // 联合仿真接口 └── TestScenarios ├── DoubleLaneChange.sim // 麋鹿测试 └── SCurve.sim // 蛇形路线建议跑仿真时先把CarSim的求解步长调到5ms以下不然会看到车辆跳disco一样的魔性轨迹。最后说个冷知识CarSim的轮胎模型在低附着路面会突然傲娇这时候得在预瞄算法里加个μ敏感因子才能稳住。