1. PID控制:智能车方向控制的起点
我第一次接触智能车方向控制是在2013年参加大学生智能车竞赛时。当时我们的电磁组小车,就是靠最简单的PID算法在赛道上跑出了2.5米/秒的成绩。PID控制作为最经典的控制算法,至今仍是许多工业控制系统的核心。
PID是比例(Proportional)、积分(Integral)、微分(Derivative)的缩写。这三个环节各司其职:比例控制决定"现在"的响应强度,积分控制消除"过去"的累积误差,微分控制预测"未来"的变化趋势。在智能车方向控制中,我们通常使用PD控制(去掉积分环节),因为赛道环境变化快,积分环节容易导致超调。
实际调参时,我总结出一个"三三制"口诀:先调P值直到车开始震荡,然后取这个值的1/3作为基准;D值从P值的1/10开始试,逐步增加到消除震荡;最后微调这两个参数直到车能平稳过弯。比如我们的电磁车最终参数是KP=10.0,KD=2.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_f+l_r))*tan(δ))其中l_f、l_r分别是质心到前后轴的距离,δ是前轮转角。这个模型虽然简化了轮胎特性,但计算量小,适合实时控制。
4.2 滚动优化
MPC的优化问题可以表述为:
min Σ(||x(k)-x_ref(k)||²_Q + ||u(k)||²_R) s.t. x(k+1)=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-50 | 50-100 |
| 路径误差(cm) | 15-30 | 5-15 |
| 计算资源占用 | <5% CPU | 30-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的测试平台,可以模拟雨雪天气、传感器故障等极端场景,大幅减少了实车调试时的意外情况。