下面把外参标定(Extrinsic Calibration)系统性讲清楚:从统一数学模型 → 各类传感器组合(LiDAR-相机 / LiDAR-IMU / LiDAR-轮速计)→ 工程方法 → 面试核心问题(如何标定LiDAR-相机外参)。
一、什么是外参标定?
一句话定义:
外参标定是求解不同传感器坐标系之间的刚体变换关系(旋转R + 平移t)。
数学形式
任意两坐标系 A → B:
$$ \mathbf{p}_B = R_{BA} \mathbf{p}_A + t_{BA} $$或齐次形式:
$$ T_{BA} = \begin{bmatrix} R & t \\ 0 & 1 \end{bmatrix} $$二、外参标定的本质
寻找一个变换,使不同传感器对“同一物理世界”的观测一致。
三、LiDAR-相机外参标定
1. 目标
求:
$$ T_{cam}^{lidar} $$使得:
- LiDAR点 → 投影到图像
- 与真实图像匹配
2. 方法分类
方法一:基于标定板(最常用)
使用:
- 棋盘格 / AprilTag / ArUco
步骤
Step 1:数据采集
- 多角度拍摄标定板
- 同时采集点云 + 图像
Step 2:图像处理
- 提取角点(2D)
- 已知标定板3D坐标
Step 3:点云处理
- 提取标定板平面
- 获取角点/边界(3D)
Step 4:建立对应关系
- 3D点(LiDAR)
- 2D点(图像)
Step 5:求解外参(PnP问题)
$$ \min || x_{img} - \pi(T \cdot X_{lidar}) ||^2 $$Step 6:优化(Bundle Adjustment)
方法二:基于特征匹配
- 提取边缘/线
- 在图像和点云中匹配
缺点:
- 不稳定
方法三:基于互信息(MI)
- 最大化图像与点云投影的一致性
方法四:深度学习(较新)
- 自动学习对齐关系
四、LiDAR-IMU外参标定
1. 目标
求:
$$ T_{imu}^{lidar} $$2. 方法:手眼标定(Hand-Eye Calibration)
经典模型:
$$ AX = XB $$3. 含义
- A:IMU运动
- B:LiDAR运动
- X:外参
4. 方法
- 收集多段运动数据
- 求解旋转 + 平移
5. 工程方法
- Kalibr(常用工具)
- LIO-SAM / FAST-LIO在线估计
五、LiDAR-轮速计(Odom)标定
1. 目标
求:
$$ T_{odom}^{lidar} $$2. 特点
- 轮速计提供平面运动
- 存在滑动误差
3. 方法
方法一:轨迹对齐
- LiDAR SLAM轨迹
- 轮速计轨迹
最小化:
$$ \min || T \cdot Traj_{odom} - Traj_{lidar} || $$方法二:优化方法
- 图优化
- ICP轨迹对齐
六、多传感器联合标定(核心)
目标
同时求解:
- LiDAR ↔ Camera
- LiDAR ↔ IMU
- LiDAR ↔ Odom
方法
1️⃣ 分步标定(常用)
- 相机内参
- LiDAR-相机
- LiDAR-IMU
2️⃣ 联合优化(高级)
构建统一优化问题:
$$ \min \sum (\text{重投影误差} + \text{IMU误差} + \text{几何误差}) $$七、核心问题:如何标定激光雷达到相机的变换矩阵?
标准回答结构(建议背)
一句话回答
可以通过标定板建立LiDAR点云与图像之间的2D-3D对应关系,然后通过PnP或非线性优化求解外参矩阵。
展开回答(面试高分)
通常使用棋盘格或AprilTag作为标定板,同时采集点云和图像数据。在图像中提取角点,在点云中提取标定板平面或角点,从而建立3D点到2D像素的对应关系。然后利用相机投影模型,将LiDAR点通过外参变换投影到图像中,并通过最小化重投影误差来求解变换矩阵,通常使用PnP算法或非线性优化方法。为了提高精度,可以使用多帧数据进行联合优化。
八、工程注意事项(非常重要)
1. 标定板选择
- 大尺寸(LiDAR分辨率低)
- 高反射
2. 数据采集
- 多角度
- 多距离
- 覆盖整个视野
3. 时间同步(关键)
- 不同步 → 标定失败
4. 初值问题
- 初值差 → 优化失败
九、常见误差来源
- 时间不同步
- 标定板提取误差
- LiDAR稀疏
- 相机畸变未校正
十、面试总结对比
| 标定类型 | 方法 | 核心思想 |
|---|---|---|
| LiDAR-相机 | 标定板 + PnP | 2D-3D匹配 |
| LiDAR-IMU | AX=XB | 运动一致性 |
| LiDAR-Odom | 轨迹对齐 | 轨迹误差最小化 |
十一、结合你项目的加分表达
你可以这样说:
在我的项目中,通常先完成相机内参标定,然后通过标定板完成LiDAR与相机的外参标定,同时结合IMU数据进行系统级优化,以保证多传感器融合的精度和稳定性。
十二、一句话总结
外参标定的本质是通过几何或运动一致性约束,求解不同传感器坐标系之间的刚体变换,其中LiDAR-相机通常通过标定板进行2D-3D匹配求解。