做机器人定位、自动驾驶感知或者无人机SLAM的时候IMU标定这几个字几乎是绕不过去的坎。我刚接触那会儿也天真地以为IMU标定就是把一个传感器拿去测一测、调一调填一张出厂校准表就完事了。实际在工程里一上手才发现这边说的“IMU标定”至少包含两个完全不在一个量级上的工作一个是标IMU本身的误差另一个是把IMU跟相机、雷达这些传感器之间的相对关系标出来。两个方向用的工具、采集的数据、看的结果完全不一样很多人一开始就被“标定”这个词搞懵了最后项目里报错都不知道该查哪一步。这篇文章我想把这两条路分别讲透。你们可以把它当成一份梳理好的踩坑笔记也可以直接照里面的流程去开跑。无论你是刚入门做第一版视觉惯性里程计还是在做相机和激光雷达联合导航的工程落地看完之后至少能分清“现在卡住的是内参问题还是外参问题”以及该用哪种标定方式去解决。1. 两种标定到底在标什么先把概念分清1.1 内参标定让IMU自身读数变可信IMU内部一般包含三轴陀螺仪和三轴加速度计部分还带磁力计。理想情况下陀螺仪静止时输出应该是0加速度计静止时输出应该是当地重力加速度在三个轴上的投影。但现实中的MEMS器件远远做不到这么干净零偏、刻度因子、交轴耦合、随机噪声、温度漂移每一项都会让你融合出来的姿态在几十秒内肉眼可见地飘走。内参标定要解决的就是这个问题。它干的事可以理解成给IMU建立一个“误差词典”把某个原始输出对应的真实值估算出来。标定完成之后软件层拿到IMU原始数据先套误差模型做补偿再进入姿态解算或者滤波融合这样后面做的视觉惯性里程计、激光惯性系统才有意义。举一个最直接的例子一个零偏不标定的陀螺仪静止时可能每秒输出0.01rad/s的角速度一秒钟的积分偏0.3度左右看起来不多但几分钟过去就是十几度的姿态飘移。这在AR头盔或无人机增稳里是灾难性的。1.2 外参标定把多个传感器坐标系对齐外参标定则是另外一回事。这时候IMU本身可能很准但光准没用因为机器人系统里不是只有一个传感器。相机看到的画面和IMU测量到的角速度、加速度必须统一到同一个坐标系下联合标定就是去求IMU坐标系到相机坐标系或者其他传感器坐标系之间的旋转矩阵和平移向量。这里说的“外参”本质上是一个六自由度的变换关系包括旋转和平移。很多做融合定位的工程问题算法选得再先进外参给得不准在线标定优化起来也会费很大劲甚至直接发散。一句话总结这两种方式内参标定管的是“这个器件自己读的数准不准”外参标定管的是“多个传感器之间互相对齐得准不准”。很多项目里用户反馈“IMU标定了但定位还是飘”通常不是内参没做而是外参根本没标或者只标了旋转没标平移。为了后面展开方便我把两条路的差异整理成一张表维度内参标定外参标定标定对象IMU自身误差IMU与其他传感器间位姿主要参数零偏、刻度因子、交轴耦合、噪声密度旋转R、平移T常见工具imu_utils、kalibr_allan、六位置法Kalibr、lidar-imu标定工具、手眼标定采集要求静止或精确控制姿态相机与标定板可见、IMU充分激励典型输出yaml噪声参数、bias稳定性4x4变换矩阵、外参yaml验证方式静止积分漂移、Allan方差曲线重投影误差、轨迹对比2. 内参标定静态采集和Allan方差能算出什么2.1 先搞清楚要标的那些参数内参标定的第一步不是急着拿工具开跑而是先把要估的参数列清楚。最常碰到的几类误差是零偏零输入时的偏移量单位通常是deg/h或者deg/s。刻度因子实测输出与理论输入之间的比例误差。交轴耦合三个轴的敏感方向不完全垂直导致的互相串扰。零偏不稳定性描述零偏随时间缓慢波动的量Allan方差曲线上对应最低点的值单位是deg/h。角度随机游走由白噪声积分导致的姿态随机漂移单位是deg/√h。速率随机游走角速度噪声积分的随机游走单位是deg/h^2。做过惯性器件选型的人应该对这些名词不陌生但真正在工程里做标定时很多人只关心噪声密度和随机游走因为这两个参数要填进卡尔曼滤波器的状态方差初值。零偏和刻度因子则更多在传感器驱动层做补偿。2.2 静态采集的时长和数据要求最常见的低成本内参标定方案就是静态采集加Allan方差分析。它的核心假设是IMU静止放置时真实角速度和加速度都是常数或0测量值里剩下的变化全部来自噪声和误差项。通过长时间静止数据可以分离不同时间尺度上的噪声成分。采集时长是个关键选择。Allan方差曲线要看到从秒级到千秒级的变化趋势通常需要连续静止至少1小时以上严谨一些的做法是2到4小时。很多开发板测试时只采了5分钟出来的Allan曲线后半段全是毛刺根本拟合不出随机游走项。比较好的做法是让系统上电预热10分钟以上再开始录bAg等温度稳定。采集时用三脚架或者直接放在减震台上避免人走动、空调风直吹这类地面微振动干扰。频率上最好让IMU以200Hz以上输出原始数据如果只有100Hz也不是不能处理但拟合出来的高频噪声段会差一些。2.3 实际跑Allan方差和六位置法现在开源工具已经比较成熟了ROS社区里常用的是imu_utils和kalibr_allan。这些工具输入rosbag输出对应的yaml参数文件里面就包含噪声密度、随机游走、零偏不稳定性等需要用的结果。通常的做法是先录一个主题为imu/data的静态rosbag然后直接运行rosbag record -O imu_static.bag /imu/data然后调用imu_utils里的工具例如roslaunch imu_utils imu_utils.launch或者用kalibr_allan的python脚本处理。最终得到类似这样的输出# 陀螺仪 gyroscope_noise_density: 1.83e-04 gyroscope_random_walk: 1.02e-05 # 加速度计 accelerometer_noise_density: 5.13e-03 accelerometer_random_walk: 8.43e-05这些值怎么理解gyroscope_noise_density越小代表高频抖动越小gyroscope_random_walk越小代表长时间积分飘得越慢。填进VIO初始化或惯性导航解算时这些值会直接决定滤波器对IMU观测的置信度。除了纯静态Allan方差工程上还常用六位置法做零偏和刻度因子标定。做法是把IMU在六个标准方向分别静止一段时间利用重力加速度在三个轴上的不同投影建立方程组解出零偏和刻度因子。没有转台的情况下只要有一个比较水平的平面就能做精度对多数应用来说足够了。这里补充一句基于常见实践的提醒六位置法标定的过程中每个位置停留时长建议不少于60秒且切换方向时动作要轻等稳定后再开始记录。不要用手拿着快速翻转那样会让加速度计在切换瞬间饱和污染数据段。3. 外参标定Kalibr跑相机-IMU联合标定的完整流水线3.1 准备标定板和imu.yaml的必要字段外参标定在视觉惯性系统里最常用的开源方案是Kalibr它同时支持相机内参标定和相机-IMU外参联合标定。Kalibr以标定板作为视觉观测基准通过连续图像帧上的角点特征重建相机的位姿轨迹再和IMU积分出来的轨迹做联合优化最终求出摄像头和IMU之间的旋转和平移。准备工作里最容易被忽略的是标定板文件本身。目标板要选择aprilgrid或者棋盘格aprilgrid最适合因为支持部分遮挡情况下的角点辨识。标定板文件里要写清楚类型、行列数和每个格子的边长单位是米。格式类似target_type: aprilgrid tagCols: 6 tagRows: 6 tagSize: 0.05 tagSpacing: 0.3另一个必要文件是imu.yaml至少要包含IMU的频率、坐标系、噪声密度和随机游走这些信息。Kalibr里这个yaml是优化器的初始化依据写得不对直接决定标定结果能不能收敛。一个典型的imu.yaml长得像这样# 加速度计和陀螺仪频率 rate: 200 accelerometer_noise_density: 5.13e-03 accelerometer_random_walk: 8.43e-05 gyroscope_noise_density: 1.83e-04 gyroscope_random_walk: 1.02e-05这些噪声密度和随机游走参数正好可以用到上一章的内参标定结果这也是为什么我建议先做内参标定再做外参标定顺序不要反。3.2 采集数据怎么“甩”相机才是关键很多人以为联合标定就是把相机对着标定板静置拍几张图然后跑一下Kalibr就行这是一个很大的误解。外参标定的本质是靠运动激励来同时估计IMU偏置、重力和相机轨迹。如果相机长时间静止不动IMU没有任何角速度和加速度激励旋转和平移的可观测性都会大幅下降。我自己实测下来比较有效的动作流程是这样的开始录bag前先让相机和IMU静止2到3秒然后开始缓慢平移加旋转动作要有轴间区分也就是不要让所有轴一直同时运动。最实用的一种激励方式是画“8”字形轨迹同时把标定板保持在画面里。记得中间穿插几次停留但不要停太多。整个录制过程控制在60到90秒左右就够时长不是越长越好因为长时间手持会累手抖会引入IMU高频噪声。录bag时尽量用低曝光固定快门避免标定板角点模糊。很多人在室内照明下拍出来的照片暗部噪点严重角点提取不稳定联合标定就跑不出结果。3.3 跑kalibr与结果解读准备工作做足之后开始运行联合标定。典型的命令是kalibr_calibrate_imu_camera \ --target april_6x6_50x50cm.yaml \ --cam camchain.yaml \ --imu imu.yaml \ --bag dataset.bag \ --time-calibration命令里多提一嘴--time-calibration这个选项很有用它会同时估计相机和IMU之间的小时间差。在消费级设备上IMU和相机的时间同步经常不是严格的不加这个选项明明外参是对的也可能因为20ms的时间错位让优化结果变差。跑完后会输出一个类似camchain-imucam-dataset.yaml的文件里面就是标定得到的q_ic和p_ic。q_ic是四元数表示IMU坐标系到相机坐标系的旋转p_ic是平移向量。在后续使用中如果代码里期望的是相机到IMU的变换记得取逆。4. 最容易和IMU标定混淆的几个标定4.1 相机内参标定不是IMU标定做视觉惯性系统时很多标定工作容易混在一起。相机内参标定主要标的是焦距、主点、畸变系数这些量最常用的是张正友标定法通过拍摄多个姿态下的棋盘格或aprilgrid图片计算出相机的内参矩阵和畸变参数。它解决的是“像素坐标和相机坐标系里的空间点怎么对应”的问题和IMU没有直接关系。但相机内参标定的质量会直接影响IMU外参标定的精度。如果相机内参不准Kalibr里用标定板恢复出来的相机位姿本身就有偏差那后面求相机和IMU之间的旋转和平移也不可能准。所以正常的工作流应该是先标相机内参再标相机-IMU外参最后才谈传感器融合。4.2 手眼标定与九点标定也是“外参”但不是IMU特有的手眼标定在机械臂领域非常常见核心是解AXXB方程A是一个坐标系的变换B是另一个坐标系的变换X就是待求的手眼矩阵。它其实是一类通用的外参标定思路不局限于IMU和相机之间。网上搜“手眼标定”会搜出一大堆机械臂抓取、相机引导贴合的内容这类标定解决的是机器人末端执行器或基座与视觉系统的坐标关系和IMU本身无关。九点标定同样容易混淆。它通常用在2D平面视觉定位里通过几个已知点建立图像坐标系和机器人平面坐标系之间的仿射变换或者投影映射适合上下相机引导贴合、激光切割定位这类场景。严格来说它跟IMU没有任何交集但很多工程师同时要处理IMU、相机、机械臂多个传感器混在一起搜索时会产生一种“这些都是同一种标定”的错觉。简单整理一个鉴别表标定名词解决什么问题是否关联IMU相机内参标定像素与相机坐标映射不直接关联手眼标定相机与机械臂/末端坐标系可用但不特有九点标定2D图像与平面坐标映射不关联双目相机标定左右相机相对位姿不直接关联相机-IMU联合标定视觉与惯性融合外参强关联IMU内参标定惯性器件自身误差直接关联4.3 ADAS和汽车领域里的“IMU标定”自动驾驶功能上车时汽车驾驶辅助标定是一个非常热门的词里面经常提到IMU。ADAS标定通常包含相机、毫米波雷达、IMU等多个传感器的联合标定既有静态标定又有动态标定。动态标定里经常要做的是把IMU测到的横摆角速度、纵向加速度与车辆底盘模型输出做对齐本质上也是一种特殊的“外参时间延迟”标定。跟机器人平台还不太一样的是ADAS领域要求有完整的安全流程和标准通常会借助四轮定位仪、标定板、雷射标靶这些专业设备。但核心思想没有变IMU必须和车辆坐标系、传感器坐标系建立确定关系否则车道线融合、自动泊车这些功能都会出现偏差。5. 标定结果怎么验证 我踩过的坑5.1 内参结果验证标定不是跑完工具输出yaml就算结束验证环节直接决定你敢不敢把这个参数用到产品里。内参方面最直观的验证方法是静止积分测试。把IMU按标定输出补偿之后静止放置一分钟观察姿态解算的漂移角速度是否大幅下降。好的MEMS级别的IMU补偿后静止一分钟的纯积分姿态漂移应该在个位数以内如果还是几十度级别漂移通常说明零偏估计不准或者是温度变化太快导致零偏已经漂走。Allan方差曲线本身也是一种验证手段。正常曲线应该能从高频段到低频段看出明显的先降后升趋势最终在某个平台区域出现最低点。如果曲线乱作一团大概率是数据里混入了大幅振动或者采集时长不够。5.2 外参结果验证外参标定结果的验证最常用的是重投影误差。Kalibr会在标定报告里给出视觉残差RMS经验值上室内标定场景RMS如果大于1个像素就要警惕标定质量。但仅看RMS不够因为优化器会把误差分摊到多个参数上个别参数即使不对RMS也可能压得很低。更有实际意义的验证方式是把IMU数据投影到图像坐标系里。具体做法是让相机对准一个有明显地平线或铅垂线的场景把标定出的重力方向通过外参旋转投影到图像上看这条投影线和画面里的真实垂直方向是否重合。如果角度差超过一两度说明外参旋转估计有问题。我还习惯做一次跑图对比拿标定好的外参并到VIO或者LIO系统里跑一组已知轨迹再看最终轨迹是否收敛到起点。这个验证非常直观平移外参错10cm和旋转错1度在几十米的行驶轨迹上会表现出完全不同的漂移形态。5.3 我踩过的几个坑第一个坑是数据同步问题。我第一次做相机-IMU联合标定时IMU打了时间戳但相机用的是硬件触发两者之间有一个固定延迟没处理Kalibr跑了好几次都报“initial batch estimation failed”。后来做了时间标定才解决从此以后我录bag前都会用示波器或者驱动日志确认时间戳是否一致。第二个坑是静止阶段和运动阶段的占比。最初采集时我想着多给一些静止段有利于bias估计结果整段bag里60%都是静止最后标出来的外参平移不确定性非常大。后来把运动占比提到70%到80%结果明显稳定很多。第三个坑是用冷藏过的开发板直接做标定。传感器上电后内部温度还在爬升零偏随时间明显变化Allan方差曲线低频频段异常。现在我的标准流程是先通电预热十分钟再录数据如果项目对温度漂移敏感还会在标定时加一个简易加热片模拟实际工作温度。第四个坑是标定板不平整。有些便宜的亚克力板印出来的棋盘格厚薄不均贴在墙上之后角点位置有亚毫米级波动视觉重建时产生微小偏差。由于IMU外参标定的平移精度本来就受限这种误差叠加进去后标出来的T非常离散。后来换了铝基板加哑光覆膜角点稳定性好了不少。最后分享一个实际项目里的体会有一次我们在车辆平台上做外参标定车内电子设备温度变化很快早上标定的T和中午标定的T相差了将近1.5度旋转。排查半天发现不是标定流程出问题而是IMU壳体温度变了导致内参零偏偏移带动整个联合优化结果跟着动。从那以后我养成了一个习惯内参标定和外参标定尽量在同一温度环境下进行最好把IMU封装好避免阳光直射或者冷风直吹。标定这种事看着是数据工程实际上里面塞满了物理环境的坑多做几遍、多验证几遍比依赖任何一次“完美收敛”都可靠得多。