一、定位漂移现象全解析
大家好，我是这次课程的主讲工程师。在自动驾驶行业摸爬滚打了这么多年，我遇到过最让人头疼的问题之一，就是定位漂移。说实话，这玩意儿就像个幽灵，你明明觉得一切正常，它突然就给你来个「灵魂出窍」。
今天这一章，咱们就把定位漂移这个家伙彻底扒开看看。它到底是什么？长什么样？为什么会发生？
1.1 什么是定位漂移？
先给个最直白的定义：定位漂移，就是车辆实际位置和算法估算位置之间的偏差，而且这个偏差会随时间或环境变化而恶化。
你想想看，自动驾驶系统里，定位模块就像人的眼睛。眼睛花了，后面所有决策——规划、控制——全都会跑偏。我参与过一个园区物流项目，有一次车辆在隧道里突然偏了2米，差点撞上货架。排查了一整天，最后发现就是定位漂移惹的祸。
从技术角度说，定位漂移的本质是状态估计误差的累积或突变。无论是基于GNSS、IMU、激光雷达还是视觉的定位方案，都会面临这个问题。只是程度不同而已。
核心观点：定位漂移不是「有」或「没有」的问题，而是「多大程度」的问题。我们的目标不是消除漂移（理论上不可能），而是把它控制在安全阈值内。
1.2 漂移的三种典型表现
根据我这些年的实战经验，定位漂移主要有三种「长相」。我习惯把它们分成三类：跳变、缓慢偏移、静止抖动。下面一个个说。
1.2.1 跳变（Sudden Jump）
跳变是最吓人的一种。车辆明明在直行，定位轨迹突然「啪」一下横移半米，然后又恢复正常。就像电影卡帧一样。
典型场景：
- 车辆经过高架桥下，GNSS信号被遮挡后重新捕获
- 激光雷达扫描到玻璃幕墙，点云匹配突然失效
- IMU受到强振动，积分结果瞬间发散
我记得有一次在测试场，车辆以40km/h行驶，定位突然跳了1.2米。控制模块直接猛打方向盘，差点冲出跑道。后来发现是GNSS多路径效应导致的——旁边刚好有一栋新盖的玻璃大楼。
避坑指南：我曾经以为跳变只发生在低成本传感器上。后来在64线激光雷达+高精度IMU的配置下也遇到过。跳变往往不是传感器精度问题，而是传感器融合逻辑有漏洞。
1.2.2 缓慢偏移（Gradual Drift）
缓慢偏移更隐蔽，也更危险。它不像跳变那样瞬间暴露，而是像温水煮青蛙——你看着轨迹，觉得「好像有点偏」，但又不确定。等发现时，已经偏出去好几米了。
典型场景：
- 纯惯性导航（INS）长时间无GNSS修正
- 激光SLAM在长直走廊或空旷区域退化
- 轮速计因轮胎磨损或打滑产生比例误差
我做过一个地下车库的定位项目，纯靠IMU+轮速计。刚开始10秒误差不到10厘米，但到第60秒时，误差已经累积到1.5米。这就是典型的缓慢偏移——IMU的零偏误差被二次积分放大了。
说白了，缓慢偏移的根源就是误差累积。每个时刻的估计都带一点点误差，下一时刻又把误差带进去，像滚雪球一样。
| 漂移类型 | 时间尺度 | 典型误差源 | 危害程度 |
|---|---|---|---|
| 跳变 | 毫秒~秒级 | GNSS多路径、点云匹配失效 | 高（瞬时失控） |
| 缓慢偏移 | 秒~分钟级 | IMU零偏、轮速计比例误差 | 中（逐渐偏离车道） |
| 静止抖动 | 持续存在 | 传感器噪声、滤波参数不当 | 低（影响舒适性） |
1.2.3 静止抖动（Stationary Jitter）
车辆明明停着没动，定位结果却在原地晃来晃去。有时候幅度不大，就几厘米，但看着特别闹心。更关键的是，这种抖动会误导下游模块——比如控制模块以为车辆在移动，反复调整方向盘。
典型场景：
- GNSS在开阔天空下的多路径噪声
- IMU的角速度随机游走
- 卡尔曼滤波器的过程噪声协方差设置过大
嗯，这里要注意：静止抖动和前面两种不同，它不一定是「错误」，更多是精度极限的体现。你想想看，任何传感器都有噪声，定位算法只能尽量抑制，不可能完全消除。
我个人的习惯是，在静止状态下，如果抖动幅度小于10厘米，就认为是可以接受的。但如果超过20厘米，就得检查滤波参数或者传感器安装是否牢固了。
1.3 漂移的根源：一张图看懂
下面我用一张SVG图来总结定位漂移的完整知识体系。这张图我画了很多遍，每次讲课时都会拿出来用。
1.4 为什么漂移这么难搞？
你可能要问：既然知道漂移的原因，为什么不能彻底解决？
原因有三点，我用自己的话总结一下：
- 传感器都有「盲区」——GNSS在室内失效，激光雷达怕雨雪，IMU会温漂。没有一种传感器是完美的。
- 环境是动态的——今天这条路好好的，明天旁边多了个施工围挡，点云地图就变了。
- 计算资源有限——理论上可以用粒子滤波、图优化等复杂方法，但车规级芯片算力就那么多，得权衡。
我记得刚入行时，总想着「用更好的算法一次性解决漂移」。后来被现实教育了——定位漂移不是一道数学题，而是一个系统工程问题。你需要理解每个传感器的脾气，知道什么时候该信谁，什么时候该怀疑谁。
个人小技巧：我习惯在调试时同时打开三个可视化窗口——原始传感器数据、定位估计结果、地面真值（如果有）。三个窗口一对比，漂移的类型和原因基本就清楚了。别只盯着定位输出看，那会误导你。
1.5 本章小结
这一章我们聊了定位漂移的三种典型表现：跳变、缓慢偏移、静止抖动。每种都有不同的成因和危害。你想想看，如果不先搞清楚「漂移长什么样」，后面修复时就会像无头苍蝇一样乱撞。
下一章，我会带大家深入Autoware的定位模块源码，看看这些漂移在代码层面是怎么体现的。到时候咱们手把手分析，把问题彻底搞透。
可可精品资料库