第三章 传感器标定与数据同步：IMU内参标定、多传感器时间戳对齐与硬件触发设计
说实话，传感器标定和数据同步这块，是导航系统量产化过程中最容易被低估的环节。我见过太多团队，算法仿真跑得飞起，一上硬件就崩。为什么？说白了，你给算法的数据本身就是错的。
今天我们就来聊聊，怎么把传感器这块的「脏活累活」干漂亮。
3.1 IMU内参标定：别让陀螺仪和加速度计「带病上岗」
IMU这东西，出厂时厂家会给一份标定参数。但我个人的习惯是——拿到手先自己标一遍。为什么？因为运输过程中的震动、焊接应力、甚至温度变化，都会让参数偏移。你想想看，一个零偏误差0.1°/s的陀螺仪，积分10秒就是1°的航向误差，这谁受得了？
3.1.1 标定什么？
IMU内参标定主要搞定三件事：
- 零偏（Bias）：静止时传感器输出的非零值。陀螺仪的零偏单位是°/s，加速度计的是m/s²。
- 尺度因子（Scale Factor）：实际物理量与传感器输出之间的比例关系。比如你转90°，它输出89.5°，这就是尺度因子不准。
- 轴间对准（Misalignment）：三个轴理论上互相垂直，但实际总有偏差。这个偏差会导致一个轴的运动串扰到另一个轴。
核心公式（简化版）：
测量值 = 尺度因子矩阵 × (真实值 + 零偏) + 噪声我们要做的，就是通过实验数据反推出尺度因子矩阵和零偏。
3.1.2 怎么标？
加速度计标定最简单——利用重力。把IMU放在6个不同的静止姿态（每个轴朝上、朝下各一次），记录数据。理论上，每个姿态下加速度计模值应该等于g（9.8m/s²）。通过最小二乘法，就能解出零偏和尺度因子。
陀螺仪标定稍微麻烦点。我常用的方法是转台法，但量产时不可能每个都上转台。所以工业界更常用的是「艾伦方差法」——通过长时间静止数据，分析噪声特性，分离出角度随机游走、速率随机游走和零偏不稳定性。
我的经验： 量产时，我建议用「六位置法」标加速度计，用「静止法+艾伦方差」标陀螺仪。成本低，效果够用。我曾经在一个项目里用这个方法，把IMU的航向积分误差从每分钟5°降到了0.3°以内。
3.1.3 标定流程示例
// 伪代码：加速度计六位置标定
// 输入：6个姿态下的静止数据（每个姿态采集1000个样本）
// 输出：零偏bias[3]，尺度因子scale[3]
1. 对每个姿态，计算加速度计三轴均值
2. 构建观测方程：||a_meas|| = g
3. 使用最小二乘法求解：
[a_x_meas] [s_x 0 0 ] [a_x_true + b_x]
[a_y_meas] = [0 s_y 0 ] [a_y_true + b_y]
[a_z_meas] [0 0 s_z] [a_z_true + b_z]
4. 约束条件：a_x_true² + a_y_true² + a_z_true² = g²
5. 迭代求解得到bias和scale3.2 多传感器时间戳对齐：别让数据「穿越」
多传感器融合时，最头疼的问题就是时间不同步。你想想看，IMU的数据是100Hz，相机是30Hz，激光雷达是10Hz。如果时间戳对不上，融合出来的结果就是「关公战秦琼」。
我遇到过最离谱的一次，是某个供应商的IMU时间戳用的是系统启动时间，而相机用的是GPS时间，两者差了整整12秒。排查了三天才发现问题。
3.2.1 软件时间戳对齐
最常用的方法是「插值法」。以IMU和相机为例：
- 给每个传感器数据打上统一的时间基准（比如系统时钟或GPS时间）
- 找到相机曝光时刻前后最近的两次IMU数据
- 用线性插值或四元数球面插值（SLERP）计算出相机曝光时刻的IMU状态
注意： 插值法假设IMU数据在短时间内是线性的。如果IMU频率太低（比如低于50Hz），或者运动太剧烈，插值误差会很大。我一般要求IMU频率至少100Hz，才能保证插值精度。
3.2.2 硬件触发设计
软件对齐总有延迟和抖动。如果你追求极致精度，就得用硬件触发。
硬件触发的思路很简单：用一个共同的时钟源（比如MCU的PWM或FPGA的计数器）产生触发信号，同时触发所有传感器采集数据。这样所有数据的时间戳天然对齐，误差只有硬件延迟（通常微秒级）。
| 方法 | 精度 | 成本 | 适用场景 |
|---|---|---|---|
| 软件时间戳+插值 | 毫秒级 | 低 | 低速运动、低成本产品 |
| 硬件触发 | 微秒级 | 高 | 高速运动、高精度导航 |
| 混合模式（硬件触发+软件补偿） | 亚微秒级 | 中 | 量产主流方案 |
避坑指南： 我曾经在一个量产项目中，用了硬件触发但没考虑触发信号的电气延迟。结果不同传感器之间的触发信号因为走线长度不同，差了200纳秒。对于1000°/s的角速度，200纳秒就是0.0002°的误差，虽然小，但在高精度应用中不可忽略。所以，硬件触发设计时一定要做信号完整性分析。
3.3 量产中的标定与同步策略
实验室里怎么标都行，但量产时你得考虑效率和成本。我总结了几条原则：
- 标定要自动化：不能靠人工手动转IMU。设计一个自动化的标定夹具，一次装夹完成所有标定。
- 标定参数要存储：每个传感器的标定参数要写入芯片的EEPROM或Flash中，随产品一起出厂。这样即使更换传感器，参数也不会丢失。
- 时间同步要冗余：硬件触发为主，软件对齐为辅。万一硬件触发失效，软件还能兜底。
- 产线测试要覆盖：每台设备出厂前，必须跑一遍「静止测试」和「旋转测试」，验证标定参数是否有效。
我的习惯： 量产时，我会在产线最后一道工序加一个「快速标定验证」环节。让设备在夹具上做一个固定的旋转动作（比如绕Z轴转90°），然后检查航向角误差是否在0.5°以内。如果超差，直接返工。这个环节帮我拦截了至少30%的不良品。
3.4 小结
传感器标定和数据同步，说白了就是「把脏数据洗干净，再对齐时间」。这两步做不好，后面的算法再牛也是白搭。
我个人建议，在产品设计阶段就把标定和同步方案定下来，不要等到算法调不通了再回头补课。嗯，这章就到这里，下一章我们聊聊「多传感器融合的工程实现」。