IMU数据零漂和温漂校准（豆包版本）

IMU的零漂（固定零偏）与温漂（随温度变化的零偏）校准，核心是，下面给你完整可落地的方法与步骤。

时空自由民.

241人浏览 · 2026-03-12 22:56:27

时空自由民. · 2026-03-12 22:56:27 发布

IMU的零漂（固定零偏）与温漂（随温度变化的零偏）校准，核心是先离线测偏、建模补偿，再在线实时修正，下面给你完整可落地的方法与步骤。

一、零漂校准（固定零偏补偿）

零漂是IMU静止时输出不为零的固定偏差，最常用静态均值法与六位置法。

1. 静态均值法（最基础、快速）

适用场景：实验室/上电快速校准、低成本MEMS IMU。
操作步骤：
1. 将IMU完全静止固定在水平刚性平台，无振动、无晃动。
2. 连续采集≥1000点原始数据（加速度计a_x,a_y,a_z、陀螺仪ω_x,ω_y,ω_z）。
3. 计算零偏（均值）：
```
b_a = (1/N)·Σa_i （加速度计零偏）
b_g = (1/N)·Σω_i （陀螺仪零偏）
```
4. 实时补偿：
```
a_cal = a_raw - b_a
ω_cal = ω_raw - b_g
```
优缺点：简单、快；但未修正尺度/轴间误差，适合快速上电校准。

2. 六位置法（高精度，含尺度/轴间误差）

适用场景：需要同时校准零偏、尺度因子、安装误差。
操作步骤：
1. 将IMU依次固定在6个正交位置（如：X+/X-/Y+/Y-/Z+/Z-朝上）。
2. 每个位置静止采集数据，利用重力加速度g作为已知输入。
3. 建立方程组，用最小二乘法求解：零偏b、尺度因子s、轴间非正交矩阵M。
4. 补偿公式：
```
a_cal = M·s·(a_raw - b)
```
优缺点：精度高；需多位置摆放，耗时更长。

二、温漂校准（温度依赖零偏补偿）

温漂是零偏随温度变化的部分，必须离线建温度-零偏模型，运行时实时查表/拟合补偿。

1. 离线温度标定（核心步骤）

硬件准备：温箱（覆盖工作温度，如-40℃~85℃）、IMU、数据采集系统。
流程：
1. 温箱按阶梯升温/降温（如每5℃一个点），每个温度点保温≥30分钟至热平衡。
2. 每个温度点执行静态零偏采集（同零漂校准步骤），记录：T, b_a_x(T), b_a_y(T), b_a_z(T), b_g_x(T), b_g_y(T), b_g_z(T)。
3. 建立温度-零偏数据集。

2. 温漂模型（3种常用）

1）多项式拟合（最常用）
用二次/三次多项式拟合每个轴的零偏随温度变化：
```
b(T) = b0 + b1·(T-T0) + b2·(T-T0)² + b3·(T-T0)³
```
- T0：参考温度（如25℃）
- b0,b1,b2,b3：拟合系数，存入固件。
2）查找表（LUT）+ 线性插值
- 存储离散温度点的零偏，运行时按当前温度线性插值计算补偿值。
- 适合非线性强、滞后明显的传感器。
3）指数预热模型（开机瞬态补偿）
开机阶段温度快速变化，用指数模型拟合瞬态漂移：
```
b(t) = b_inf + A·exp(-t/τ)
```
- b_inf：稳态零偏
- A,τ：拟合参数。

3. 在线实时温漂补偿

读取IMU内置温度传感器T_current。
代入温漂模型，计算当前温度下的零偏b(T_current)。

补偿：

a_cal = a_raw - b_a(T_current)
ω_cal = ω_raw - b_g(T_current)

三、工程化建议（从校准到使用）

先零漂、后温漂：先做静态/六位置零偏校准，再做全温区温漂标定。
定期重校准：
- 上电/开机执行快速静态零偏校准。
- 环境温度变化大时，触发温漂模型更新。
在线自适应修正（进阶）：
- 利用GPS静止/视觉VIO/磁力计等外部参考，通过**卡尔曼滤波（EKF/UKF）**实时估计并更新零偏。
- 建模零偏为随机游走，与姿态/速度联合估计。
滤波降噪：
- 用**低通滤波（LPF）**抑制高频噪声，减少对零偏估计的干扰。

四、伪代码示例（C语言风格）

// 1. 零偏参数（静态校准结果）
float gyro_bias_static[3] = {0.12, -0.08, 0.05}; // dps
float accel_bias_static[3] = {0.02, -0.01, 0.03}; // g

// 2. 温漂模型系数（二次多项式，T0=25℃）
float gyro_temp_coeff[3][3] = {
    {0.001, 0.0002, 0.00001}, // x: b0, b1, b2
    {-0.002, 0.0001, -0.00002}, // y
    {0.0015, -0.0003, 0.00001} // z
};

// 计算温度补偿后的零偏
void calc_temp_bias(float T, float *gyro_bias, float *accel_bias) {
    float dT = T - 25.0f;
    for(int i=0; i<3; i++) {
        gyro_bias[i] = gyro_temp_coeff[i][0] 
                      + gyro_temp_coeff[i][1]*dT 
                      + gyro_temp_coeff[i][2]*dT*dT;
        // 加速度计同理
    }
}

// 主补偿流程
void imu_calibrate(float *raw_accel, float *raw_gyro, float T, 
                   float *cal_accel, float *cal_gyro) {
    float gyro_bias[3], accel_bias[3];
    calc_temp_bias(T, gyro_bias, accel_bias);
    
    // 总零偏 = 静态零偏 + 温度零偏
    for(int i=0; i<3; i++) {
        cal_gyro[i] = raw_gyro[i] - (gyro_bias_static[i] + gyro_bias[i]);
        cal_accel[i] = raw_accel[i] - (accel_bias_static[i] + accel_bias[i]);
    }
}