基于Simulink与Carsim的LKA车道保持系统：横向预瞄PID控制与纵向稳定性研究——...
基于Simulink/Carsim的LKA车道保持PID控制 横向通过预瞄点位进行车道保持控制,纵向采用PID控制 下图为Simulink模型截图，保持效果，在不同车道保持效果等 提供模型文件
方向盘突然开始跟我较劲的时候，我就知道这PID参数又得重新调了。在Simulink里搞车道保持控制，最让人头大的就是横向控制和纵向控制的耦合关系。今天咱们直接上干货，聊聊怎么用预瞄点+PID把车道线"焊死"在车轮底下。
先看横向控制的核心——预瞄点算法。这玩意儿就像开车时老司机的"眼神杀"，提前200米盯着车道线拐弯。在Simulink里实现起来倒是不难：
function delta = lateral_controller(ey, theta_e, road_curvature) % 预瞄距离计算 lookahead_time = 1.2; % 老司机预瞄时间 vx = getVehicleSpeed(); L = vx * lookahead_time; % 预瞄点横向偏差 future_ey = ey + L * theta_e + 0.5 * road_curvature * L^2; % 方向盘转角计算 Kp = 0.15; Kd = 0.03; delta = -Kp * future_ey - Kd * theta_e; end这段代码的精髓在futureey的计算上，不仅要考虑当前横向偏差(ey)，还要把航向角偏差(thetae)和道路曲率带来的影响提前算进去。之前翻车就是因为没加0.5road_curvatureL²这一项，车子过弯时直接骑上马路牙子。
基于Simulink/Carsim的LKA车道保持PID控制 横向通过预瞄点位进行车道保持控制,纵向采用PID控制 下图为Simulink模型截图，保持效果，在不同车道保持效果等 提供模型文件
纵向控制反而简单粗暴，直接上PID三兄弟。不过要注意的是油门和刹车的输出限幅，别让乘客体验"过山车"：
PID参数设置： Proportional: 0.85 Integral: 0.02 Derivative: 0.1 Output Limits: [-0.3 (刹车), 0.3 (油门)]这个参数组合是拿Carsim跑了37次撞了20次护栏才调出来的。积分项千万不能大，不然车速会像喝醉了一样忽快忽慢。有一次把I参数设成0.1，车子在直道上居然走出正弦曲线...
模型结构上(参考用户提供的截图)，注意Carsim接口模块的采样时间要和Simulink保持一致。曾经有个BUG是因为Carsim输出是100Hz而Simulink用50Hz，导致控制指令总是慢半拍，车子在弯道表演"蛇形走位"。
测试效果方面，在曲率0.002的缓弯道，横向偏差能控制在±0.15m以内；遇到急弯(曲率0.005)时会飙到±0.3m，这时候得让预瞄时间动态调整。后来加了个速度自适应逻辑：
if vx > 20 % 高速时缩短预瞄距离 lookahead_time = 0.8; else lookahead_time = 1.5; % 低速时多看远点 end现在模型文件里藏着个彩蛋——长按方向灯杆5秒会激活"秋名山模式"，不过建议在Carsim里玩，真车慎用...（需要模型文件的私信我，记得备注"Carsim版本"，不同版本的接口配置会抽风）