智能车浅谈——从PID到模型预测：方向控制算法演进

1. PID控制智能车方向控制的起点我第一次接触智能车方向控制是在2013年参加大学生智能车竞赛时。当时我们的电磁组小车就是靠最简单的PID算法在赛道上跑出了2.5米/秒的成绩。PID控制作为最经典的控制算法至今仍是许多工业控制系统的核心。PID是比例Proportional、积分Integral、微分Derivative的缩写。这三个环节各司其职比例控制决定现在的响应强度积分控制消除过去的累积误差微分控制预测未来的变化趋势。在智能车方向控制中我们通常使用PD控制去掉积分环节因为赛道环境变化快积分环节容易导致超调。实际调参时我总结出一个三三制口诀先调P值直到车开始震荡然后取这个值的1/3作为基准D值从P值的1/10开始试逐步增加到消除震荡最后微调这两个参数直到车能平稳过弯。比如我们的电磁车最终参数是KP10.0KD2.5这个组合能让车在急弯时提前打方向出弯时自动回正。2. PID的局限性当传统算法遇到复杂场景随着参赛经验积累我发现PID在以下场景会暴露出明显短板连续S弯PID的事后纠正特性导致车总是慢半拍像醉汉走猫步一样左右摇摆突变路况当赛道突然从直道变为急弯时PD参数无法自适应调整高速场景车速超过3m/s后PD控制很容易出现震荡甚至失控根本原因在于PID是无模型控制它只关心当前误差而不理解车辆的运动规律。就像蒙着眼睛走迷宫只能靠碰壁后的反馈来调整方向。2016年我们尝试用模糊PID改进虽然过弯更流畅了但参数整定变得异常复杂。3. 模型预测控制(MPC)智能驾驶的新范式2018年我第一次在实验室接触MPC控制器时最震撼的是它居然能预测未来3秒的车辆轨迹。MPC的核心思想可以概括为建模建立车辆动力学模型比如常用的自行车模型预测基于当前状态预测未来多步的轨迹优化求解最优控制序列通常转化为二次规划问题执行实施第一步控制量下一周期重新预测用个比喻来说PID是摸着石头过河而MPC是先搭好浮桥再过河。在MATLAB仿真中MPC控制的车辆过S弯时方向盘的转动幅度比PID小30%路径跟踪误差降低50%以上。4. MPC实现的关键技术点在实际工程化时MPC需要解决几个核心问题4.1 车辆建模常用的二自由度自行车模型dx/dt v*cos(θ β) dy/dt v*sin(θ β) dθ/dt (v/l_r)*sin(β) β arctan((l_r/(l_fl_r))*tan(δ))其中l_f、l_r分别是质心到前后轴的距离δ是前轮转角。这个模型虽然简化了轮胎特性但计算量小适合实时控制。4.2 滚动优化MPC的优化问题可以表述为min Σ(||x(k)-x_ref(k)||²_Q ||u(k)||²_R) s.t. x(k1)f(x(k),u(k)) u_min ≤ u(k) ≤ u_max其中Q、R是权重矩阵需要根据车辆特性调整。我们团队发现将横向误差的权重设为纵向误差的2倍能获得更好的跟踪效果。4.3 实时性保障在树莓派上部署时我们采用以下优化将预测时域设为20步2秒控制时域5步使用ACADO工具包生成C代码固定Hessian矩阵减少在线计算量 最终单次优化耗时控制在50ms以内满足20Hz的控制频率要求。5. 算法对比与选型建议根据实测数据整理的对比表指标PID控制MPC控制响应速度(ms)10-5050-100路径误差(cm)15-305-15计算资源占用5% CPU30-50% CPU参数易调性★★★★☆★★☆☆☆抗干扰能力★★☆☆☆★★★★☆给初学者的建议低速场景2m/s优先选择PID容易实现结构化道路MPC优势明显特别是弯道工况资源受限平台可考虑改进PID如模糊PID量产项目推荐MPC虽然开发周期长但后期维护成本低6. 前沿方向数据驱动的智能控制最近我们在试验结合深度学习的MPC控制器。具体做法用LSTM网络学习驾驶员操作数据将网络输出作为MPC的参考轨迹在线调整MPC的权重参数实测表明这种混合方法在非结构化道路上的控制误差比传统MPC降低40%。不过要注意神经网络需要大量高质量数据我们采集了超过1000公里的真实驾驶数据才训练出可用模型。另一个有趣的方向是强化学习与MPC的结合。谷歌Waymo的最新论文显示他们用PPO算法优化MPC的代价函数在交叉路口场景中减少了23%的急刹车次数。不过这类方法目前还停留在仿真阶段落地应用仍需时日。7. 实战经验分享去年给某车企做EPS控制器时我们踩过几个坑采样时间不一致CAN总线100ms传感器10ms导致MPC预测不准。解决方案是增加缓冲区做时间对齐执行器延迟转向电机响应有80ms滞后需要在MPC模型中增加延迟补偿路面扰动颠簸路段导致模型失配后来增加了路面估计模块建议在部署前一定要做硬件在环测试HIL。我们开发了一套基于CARLA的测试平台可以模拟雨雪天气、传感器故障等极端场景大幅减少了实车调试时的意外情况。