4. 激光雷达-IMU外参标定误差排查实战

在矿山设备上，激光雷达与IMU通常刚性安装在同一个支架或车体上，两者之间的平移与旋转关系称为外参。SLAM前端把IMU测得的角速度、比力变换到雷达坐标系后，才能与点云配准结果做紧耦合优化。外参一旦存在偏差，IMU预积分轨迹与雷达观测轨迹就会系统性错位，优化器只能靠不断修正位姿来"迁就"错误外参，表现为缓慢累积的定位漂移。本节围绕外参标定原理、质量评估指标、在线修正方法，结合一组示例标定数据，说明如何诊断外参误差引起的漂移。

外参标定原理与误差来源

设雷达坐标系为 L、IMU坐标系为 I，外参由旋转 R_IL 与平移 t_IL 组成，满足 p_L = R_IL·p_I + t_IL。标定的本质是寻找一组 (R, t)，使同一段运动在两种传感器下的观测一致：IMU积分得到的相对运动与雷达配准得到的相对运动在最小二乘意义下残差最小。常用做法是手持或车载设备做充分激励运动（绕三个轴均有明显转动、含加减速），采集一段数据后离线优化，或用标定板/角反射器提供绝对约束。

矿山场景的误差来源主要有三类。第一类是安装误差：支架焊接变形、减振垫压缩不均，使实际安装角与设计值相差零点几度到数度。第二类是振动引起的松动漂移：设备长期在爆破、铲装、运输工况下高频振动，螺栓预紧力衰减，外参在数天到数周内缓慢变化，这是本节的重点。第三类是标定过程本身的质量问题：激励不足导致某些自由度不可观、时间同步偏差被误吸收进外参、标定场地点云特征退化。排查时要先区分"标定没标好"与"标好后漂了"，两者的处理路径完全不同。

标定质量评估指标

不能只看优化是否收敛，要看成套的可观测量。工程上常关注以下指标：

• 重投影/重配准残差：把IMU预积分相对位姿与雷达配准相对位姿对齐后，平移残差与旋转残差的均方根。示例中健康标定旋转残差约 0.15°，平移残差约 1.5 cm；若旋转残差超过 0.5° 需警惕。
• 各自由度可观测性：通过信息矩阵或协方差判断哪个轴激励不足。绕竖直轴（yaw）激励不足时，yaw外参方差会明显偏大。
• 时间偏移估计：雷达与IMU的时间戳偏差 δt 与外参耦合，δt 偏大会让旋转外参被系统性带偏，应单独估计并检查是否稳定。
• 重复标定一致性：同一设备连续标定 3 次，比较外参的离散程度，比单次残差更能反映真实质量。

在线外参修正方法

针对振动导致的缓慢漂移，离线重标成本高，可采用在线修正。核心思路是把外参作为状态量加入优化，用雷达配准残差与IMU预积分残差联合约束，并对外参施加缓慢变化的先验（随机游走模型），防止其在短时噪声下乱跳。实现上通常设置：外参更新开关仅在激励充分（角速度方差、加速度方差超过阈值）时打开；对外参增量做限幅，例如单次优化旋转修正不超过 0.05°；对平移修正不超过 2 mm；并记录外参随时间的变化曲线用于趋势监控。

另一种轻量做法是"分段标定+插值"：按工况（空载行驶、铲装、重载运输）分别标定，运行时按当前工况切换或插值外参。这种方法实现简单，但需要足够的工况样本，且切换点要平滑，避免位姿跳变。

示例数据诊断：外参误差引起的漂移

以下为一组用于教学的示例数据（非实测），设备为井下铲运机，雷达与IMU同支架安装，标定后运行约 40 分钟闭环轨迹。健康状态下闭环误差约 0.3 m；某次维护后出现漂移，闭环误差增至 2.1 m，且误差随行驶距离近似线性增长。

结合上表可判断：平移与时间同步正常，问题集中在旋转，尤其是 yaw。进一步查看轨迹，发现直线段漂移不明显，转弯后航向误差快速增大，符合 yaw 外参偏差的特征——转弯时角速度观测与点云旋转观测的错位被放大。处理方式是：检查支架螺栓预紧力与减振垫，重新做含充分 yaw 激励的标定，标定后开启在线外参修正并设置 0.05°/次的修正限幅，运行 30 分钟后观察外参曲线是否收敛平稳。

需要强调的是，外参排查要形成闭环：先看残差与一致性指标定位是哪个自由度，再结合轨迹形态（直线漂移还是转弯漂移）确认，最后用在线修正或离线重标处理，并通过外参随时间曲线与闭环误差验证效果。振动导致的漂移往往不是一次性的，建议把外参趋势纳入日常维护检查项，在螺栓预紧力、减振垫状态变化后主动复标，而不是等到定位明显漂移才被动处理。