简介imu-utils是一套面向机器人导航、虚拟现实、飞行控制及移动设备开发者的IMU标定工具包用于消除加速度计、陀螺仪与磁力计的系统误差和随机误差提升姿态、加速度与旋转数据的测量精度。资源包共235个文件约4.32MB以txt说明文档、sample样例数据、h/hpp头文件、cpp源码、yaml与launch配置、m脚本及md文档为主并包含code_utils与imu_utils两个核心模块兼顾标定算法实现与数据处理、接口设计等辅助功能。代码中已修正错误引用稳定性更有保障用户可依据硬件环境定制标定流程。目前已有438人学习下载适合需要将IMU集成到项目中、希望减少标定技术障碍的工程师参考也可作为理解偏差、尺度因子与非正交性校正流程的实践素材。1. IMU 标定工具 imu-utils从零偏到尺度因子的工程化落地很多团队第一次把 IMU 数据接进融合算法时都会经历一个玄学阶段静止时姿态缓慢漂移转一圈回来航向差了十几度跑几分钟位置就飞了。第一反应往往是怀疑融合算法写得不对但十有八九问题出在传感器本身——零偏没扣、尺度因子不准、轴间不正交。imu-utils 这类工具要解决的就是这件事把 IMU 的确定性误差用一套可复现的流程标出来输出成融合算法能直接吃的参数。它适合两类人一类是刚拿到 IMU 模组、还没建立标定流程的嵌入式或机器人开发者另一类是已经能跑通融合、但精度卡在某个量级上不去的工程师。标定不是玄学它是一组有明确输入输出、有明确评价指标的工程步骤imu-utils 的价值就在于把这组步骤工具化、可重复化。2. IMU 误差模型与 imu-utils 的选型逻辑2.1 确定性误差和随机误差要分开处理IMU 的误差分两大类处理方式完全不同。确定性误差包括零偏、尺度因子误差、轴间非正交误差这些在固定温度下是常数或缓变量可以用一次标定算出补偿系数之后一直用。随机误差包括角度随机游走、速度随机游走、零偏不稳定性这些是噪声统计特性只能用 Allan 方差分析出噪声密度参数交给滤波器去建模。imu-utils 主要处理确定性误差这也是绝大多数团队最先要解决的问题。把这两类混在一起标结果就是参数互相污染标完反而更差。确定性误差的数学模型通常写成这样真实角速度 ω_true 和测量值 ω_meas 的关系是 ω_meas M · S · ω_true b n其中 M 是非正交矩阵S 是尺度因子对角阵b 是零偏n 是噪声。工程上常把 M 和 S 合并成一个 3×3 的标定矩阵加上一个 3×1 的零偏向量一共 12 个待标参数。加速度计同理。imu-utils 的输出就是这 12 个参数格式上一般是一个 3×3 矩阵加一个 3×1 向量方便直接写进代码。2.2 为什么选静态多位置法而不是转台法标定方法有好几种转台法精度最高但需要精密设备手转法简单但重复性差。imu-utils 走的是静态多位置法把 IMU 依次放在若干个已知姿态下每个姿态静止采集一段时间用重力矢量在加速度计上的投影来约束参数。这种方法不需要额外设备一块水平台面加一个能摆出几个固定角度的夹具就能做重复性对大多数应用足够。选它的理由很实际转台贵且不一定有手转法的角速度真值根本不知道而静态多位置法的真值来自重力重力的大小和方向是确定的这就把标定问题变成了一个最小二乘问题。代价是它只能标加速度计和陀螺仪的零偏陀螺仪的尺度因子和非正交需要靠转台或者已知角速度的旋转来标静态法标不了。所以 imu-utils 的典型用法是加速度计用多位置法全标陀螺仪只标零偏尺度因子如果厂家出厂已经校准过就先用着不够再上转台。2.3 采集数据的三个硬性要求不管用什么工具数据采集这一步做不好后面全白搭。第一条每个位置必须真正静止判断标准是加速度计三轴模值波动小于 0.05 m/s²陀螺仪输出接近零偏水平。第二条每个位置采集时长不少于 30 秒采样率 100 Hz 以上这样零偏估计的方差才够小。第三条位置数量要够加速度计至少 6 个面各朝下一次最好加上几个斜置姿态总共 12 到 20 个位置覆盖球面分布越均匀越好。采集时还要注意温度。IMU 零偏对温度敏感冷机开机和热机稳定后的零偏能差出不少。建议开机预热 5 到 10 分钟等芯片温度稳定后再采。如果应用场景温度变化大那就要做温补那是另一个话题imu-utils 本身不处理温变但它的输出可以作为温补的基准点。3. 用 imu-utils 跑通一次完整标定3.1 环境准备与数据采集脚本先确认 Python 环境和依赖。imu-utils 一般依赖 numpy 做矩阵运算scipy 做最小二乘优化matplotlib 做结果可视化。用虚拟环境隔离避免和系统包冲突。# 创建虚拟环境并安装依赖 python3 -m venv imu_env source imu_env/bin/activate pip install numpy scipy matplotlib # 如果 imu-utils 以源码形式提供进入其目录安装 cd imu-utils pip install -e .数据采集这一步我一般会写一个独立脚本把 IMU 通过串口或 ROS topic 读进来按位置分段存成 CSV。每个 CSV 文件对应一个静止姿态文件名里带上姿态编号。下面是一个最小采集脚本的骨架假设数据从串口按行读入每行是时间戳加六轴数据。import serial import csv import time # 串口配置根据实际模组改端口和波特率 ser serial.Serial(/dev/ttyUSB0, 115200, timeout1) # 每个位置采集 30 秒100Hz 约 3000 个样本 DURATION 30 SAMPLES 3000 def collect_one_position(filename): rows [] start time.time() while len(rows) SAMPLES and (time.time() - start) DURATION * 1.5: line ser.readline().decode(ascii, errorsignore).strip() if not line: continue parts line.split(,) # 假设格式timestamp, ax, ay, az, gx, gy, gz if len(parts) 7: rows.append(parts) # 写入 CSV带表头方便后续解析 with open(filename, w, newline) as f: writer csv.writer(f) writer.writerow([ts, ax, ay, az, gx, gy, gz]) writer.writerows(rows) print(f{filename}: {len(rows)} samples) # 依次采集 12 个位置每个位置手动摆好后回车继续 for i in range(12): input(f摆好第 {i1} 个位置后按回车开始采集...) collect_one_position(fpos_{i1:02d}.csv)这段脚本的关键点在于采集前用 input 阻塞保证人是摆好姿态后才开始每个位置固定采样数而不是固定时间避免串口丢包导致样本数不一致CSV 带表头后面解析不用猜列顺序。参数上DURATION 和 SAMPLES 要匹配你的实际采样率如果模组是 200 HzSAMPLES 就设 6000。串口超时设 1 秒是防止 readline 永久阻塞。3.2 加速度计多位置标定的实现数据齐了之后核心就是把每个位置的静止均值算出来然后解最小二乘。加速度计的观测方程是测量值 标定矩阵 × 真实重力向量 零偏。真实重力向量在每个位置是已知的因为姿态已知重力在机体坐标系下的方向就是姿态旋转矩阵的第三列乘以重力大小。import numpy as np import glob G 9.80665 # 当地重力加速度按纬度查表更准 def load_mean(path): data np.loadtxt(path, delimiter,, skiprows1) # 取后 80% 样本求均值丢掉开头可能未稳定的部分 n len(data) acc data[int(n*0.2):, 1:4] gyr data[int(n*0.2):, 4:7] return acc.mean(axis0), gyr.mean(axis0) # 每个位置对应的真实重力方向单位向量需按实际摆放填写 # 这里以 6 面法为例顺序X, -X, Y, -Y, Z, -Z 朝下 true_dirs np.array([ [1,0,0], [-1,0,0], [0,1,0], [0,-1,0], [0,0,1], [0,0,-1] ], dtypefloat) files sorted(glob.glob(pos_*.csv)) acc_means [] for f in files: a, g load_mean(f) acc_means.append(a) acc_means np.array(acc_means) # 最小二乘a_meas M (G * d) b # 未知量是 M 的 9 个元素和 b 的 3 个元素共 12 个 # 构造 A x y 形式每个位置贡献 3 个方程 A [] y [] for i in range(len(acc_means)): d true_dirs[i] * G # M 按行展开每行 3 个未知数b 每行 1 个 for axis in range(3): row np.zeros(12) row[axis*3:axis*33] d row[9axis] 1.0 A.append(row) y.append(acc_means[i, axis]) A np.array(A) y np.array(y) # 解最小二乘 x, residuals, rank, sv np.linalg.lstsq(A, y, rcondNone) M x[:9].reshape(3,3) b x[9:] print(标定矩阵 M:\n, M) print(零偏 b:\n, b)这段代码的逻辑是把每个位置的测量均值和已知重力方向代入线性方程堆叠成超定方程组用 lstsq 求解。参数说明G 要按当地纬度取值差 0.01 对结果影响不大但别用 9.8 凑合true_dirs 必须和实际摆放严格对应摆错一个方向整个标定就废了取后 80% 样本是为了避开手动摆放后的余振。解出来的 M 理想情况接近单位阵b 接近零如果 M 的对角线偏离 1 超过 5%说明要么数据有问题要么模组本身太差。3.3 陀螺仪零偏的估计与验证陀螺仪零偏的标定简单得多因为静止时真实角速度为零测量值直接就是零偏加噪声。把所有位置的陀螺仪均值再平均一次就得到零偏估计。gyr_means [] for f in files: a, g load_mean(f) gyr_means.append(g) gyr_means np.array(gyr_means) # 零偏取所有位置均值的平均降低噪声影响 gyro_bias gyr_means.mean(axis0) # 同时看标准差判断零偏稳定性 gyro_std gyr_means.std(axis0) print(陀螺零偏:, gyro_bias) print(位置间标准差:, gyro_std)这里的关键判断是标准差。如果位置间标准差和单次采集的噪声水平相当说明零偏稳定这个估计可信。如果标准差明显偏大比如超过 0.01 rad/s那可能是采集时没真正静止或者模组零偏随温度漂了。验证方法是把标定参数写回代码重新静止采集一段数据看补偿后的角速度是否在零附近对称波动均值接近零。4. 标定流程里最容易翻车的几个地方4.1 现象标定后精度反而变差原因通常是姿态方向填错了。多位置法依赖真实重力方向如果实际是 X 朝下但代码里写的是 -X最小二乘会解出一个扭曲的 M 来强行拟合结果就是所有方向都偏。解决方法是采集时在每个 CSV 文件名或单独一个记录文件里写清楚实际姿态标定前先核对一遍。另一个常见原因是某个位置采集时手碰到了桌子均值被污染这种离群点要在求均值前用中位数或截断均值剔除。4.2 现象零偏估计每次都不一样原因是采集时长不够或者预热不充分。零偏估计的方差和采样数成反比30 秒 100 Hz 只有 3000 个样本对低噪声模组够用对噪声大的模组就不够。解决办法是延长到 60 秒或者增加位置数量取平均。预热问题更隐蔽冷机零偏可能比热机大好几倍一定要等温度稳定。我一般会先开机跑 10 分钟再开始采集急不得。4.3 现象标定矩阵对角线偏离 1 很多如果 M 的对角线元素在 0.9 到 1.1 之外先别怀疑算法检查数据。常见原因是量程设置不对导致饱和或者单位搞错了比如模组输出是 g 而代码里按 m/s² 处理。还有一种情况是模组本身尺度因子误差就大廉价 MEMS 能到 5%这种标出来是正常的补偿后能用就行。但如果偏离超过 20%基本可以判定是数据或方向错误。4.4 现象陀螺仪零偏随温度明显变化这是 MEMS 的固有特性不是标定能解决的。如果应用场景温度变化超过 10 度静态标定的零偏只在标定温度附近有效。解决办法是做温补在不同温度点分别标定零偏拟合出零偏随温度的变化曲线运行时用片上温度计查表补偿。imu-utils 本身不做温补但它的输出可以作为温补的基准。如果不想做温补那就尽量让 IMU 工作在恒温环境或者接受精度下降。5. 把标定参数用起来验证与进阶技巧标定完不是结束验证才是关键。最直接的验证方法是把参数写进补偿代码重新采集一组静止数据看补偿后的加速度计模值是否稳定在 G 附近波动越小越好陀螺仪补偿后均值是否接近零。更严格的验证是做一个已知角度的旋转比如水平转 90 度看积分出来的角度和实际差多少。差在 1 度以内说明标定合格差几度说明还有问题。补偿代码的写法很简单就是标定公式的逆运算。假设标定得到加速度计矩阵 M_a 和零偏 b_a那么补偿后的真实值近似为 M_a 的逆乘以测量值减 b_a。实际写代码时不用每次求逆标定时直接把逆矩阵算好存下来。# 标定阶段算好逆矩阵 M_a_inv np.linalg.inv(M_a) # 运行时补偿 def compensate(acc_raw, gyr_raw): acc_cal M_a_inv (acc_raw - b_a) gyr_cal gyr_raw - gyro_bias return acc_cal, gyr_cal进阶技巧有两个方向。一是把标定参数和温度关联做分段标定或者线性温补这个对高精度应用值得投入。二是把标定流程自动化写一个脚本从采集到解算到验证一键跑完每次换模组或者怀疑参数漂了就重跑一遍几分钟的事。我自己的习惯是每批模组抽检一两个做完整标定确认批次一致性后其余用出厂参数省时间又不至于翻车。标定这件事做一次不难难的是建立可重复的流程并坚持执行。希望帮到你。本文还有配套的精品资源点击获取