4. 横向控制评价:路径跟踪精度、横向偏差、航向角误差、曲率跟踪能力
横向控制,说白了就是让无人车「听话地沿着路走」。你想想看,纵向控制只管油门刹车,但车往哪拐,全靠横向控制。我做了这么多年无人车,见过太多「纵向控制完美,横向控制翻车」的案例了。
今天咱们就聊聊,怎么评价横向控制做得好不好。我个人习惯从四个维度入手:路径跟踪精度、横向偏差、航向角误差、曲率跟踪能力。这四个指标,基本能覆盖横向控制的全部性能。
4.1 路径跟踪精度
路径跟踪精度,是最直观的指标。说白了就是「车实际走的轨迹,跟规划好的路径有多像」。
我在项目中遇到过一个问题:明明横向偏差很小,但车就是走不出漂亮的弧线。后来才发现,只看偏差是不够的,还得看跟踪的「平滑度」。
常用的评价指标有:
- 均方根误差(RMSE):衡量整体跟踪偏差的统计量
- 最大绝对误差(MaxAE):看最差情况下的偏差
- 跟踪延迟:车对路径变化的响应速度
重要提示:路径跟踪精度不是越高越好。精度过高往往意味着控制器的增益很大,容易导致方向盘抖动。我建议在直道上追求高精度,弯道上适当放宽。
4.2 横向偏差
横向偏差,就是车当前位置到参考路径的垂直距离。这个指标最直观,也最容易理解。
嗯,这里要注意:横向偏差有正负之分。通常定义车在路径左侧为正,右侧为负。但不同团队的定义可能相反,所以看数据前一定要确认符号约定。
我个人的经验是:
- 直道行驶:横向偏差应控制在 ±0.1m 以内
- 弯道行驶:可以放宽到 ±0.3m
- 紧急避障:允许 ±0.5m,但时间要短
小技巧:评价横向偏差时,别只看平均值。我建议重点关注「偏差的方差」——方差大说明控制不稳定,车在左右摇摆。
4.3 航向角误差
航向角误差,是车的实际航向与路径切线方向的夹角。这个指标很多人会忽略,但它其实非常关键。
为什么?因为横向偏差是「位置」的误差,航向角误差是「方向」的误差。位置对了但方向不对,车就会「切着」路径走,而不是「沿着」路径走。
我记得有一次测试,横向偏差只有 5cm,但航向角误差达到了 8 度。结果车在弯道里一直「内切」,差点蹭到路沿。从那以后,我每次评价横向控制,都会把航向角误差放在第一位。
航向角误差的典型要求:
| 场景 | 允许误差 | 备注 |
|---|---|---|
| 高速直道 | ≤ 1° | 方向稍有偏差,横向偏差会快速累积 |
| 城市道路 | ≤ 3° | 速度较低,容错空间大 |
| 急弯 | ≤ 5° | 曲率变化大,允许一定误差 |
4.4 曲率跟踪能力
曲率跟踪能力,是横向控制评价中最「高级」的指标。它衡量的是车能不能准确跟随路径的弯曲程度。
你想想看,路径的曲率是连续变化的,但车的转向机构有物理限制——最大转角、转向速率都是有限的。如果控制器不考虑这些限制,就会出现「弯道里转向不足」或者「出弯时转向过度」。
我曾经踩过一个坑:用纯跟踪算法做横向控制,直道上表现完美,但一到 S 弯就「甩尾」。后来分析发现,是曲率变化太快,控制器跟不上。解决方案是加了曲率前馈,提前预判弯道变化。
评价曲率跟踪能力,我常用这几个方法:
- 曲率误差曲线:画出实际曲率与目标曲率的对比图
- 曲率变化率:看曲率跟踪的响应速度
- 转向平滑度:方向盘转角的变化是否平滑
警告:曲率跟踪能力差,往往不是控制器的问题,而是「路径规划」的问题。如果规划出来的路径曲率不连续,再好的控制器也白搭。所以评价横向控制时,一定要先确认参考路径的质量。
4.5 横向控制评价的知识体系
下面这张图,是我总结的横向控制评价知识体系。你可以把它当作一个检查清单,每次做评价时对照着看,不容易漏项。
4.6 综合评价方法
四个指标都讲完了,那怎么综合起来评价呢?我个人的做法是:
- 先看横向偏差和航向角误差——这两个是基础,如果它们都不合格,后面的不用看了
- 再看路径跟踪精度——用 RMSE 和 MaxAE 量化整体表现
- 最后看曲率跟踪能力——这是「加分项」,决定了控制器的上限
核心观点:横向控制评价不是「打分」,而是「找问题」。每个指标不合格,都对应着不同的控制器问题。比如横向偏差大,可能是增益不够;航向角误差大,可能是前馈缺失;曲率跟踪差,可能是模型不准。
好了,横向控制评价就聊到这儿。这四个指标,你可以在实际项目中反复用,慢慢就会有自己的心得了。
公众号:蓝海资料掘金营,微信deep3321