3. 机器人手眼系统基础:坐标系与标定问题分类
在3D线扫相机Eye-in-Hand标定中,理解机器人坐标系体系与手眼标定的两大分类是构建标定算法的基础。本节将系统梳理机器人基座、工具、用户坐标系的定义与变换关系,并对比Eye-to-Hand与Eye-in-Hand两种标定问题的本质差异。
3.1 机器人坐标系体系
机器人系统通常定义多个坐标系来描述末端执行器、传感器与工件之间的空间关系。在Eye-in-Hand标定中,最核心的三个坐标系为:
| 坐标系名称 | 符号 | 定义 | 典型用途 |
|---|---|---|---|
| 基座坐标系 | {B} | 固定在机器人安装基座上的参考系,通常为机器人世界坐标系原点 | 所有运动学计算的全局参考,机器人位姿指令的基准 |
| 工具坐标系 | {T} | 固定在机器人末端法兰或工具上的动态坐标系 | 描述末端执行器(如夹爪、焊枪)的位姿,TCP(工具中心点)定义 |
| 用户坐标系 | {U} | 用户自定义的工件或工作台坐标系,可任意偏移旋转 | 简化编程,使机器人运动沿工件表面或特征方向进行 |
关键变换链: 机器人正向运动学提供从基座{B}到工具{T}的齐次变换矩阵 TBH,这是手眼标定中已知的输入量。
3.2 坐标系变换关系
在Eye-in-Hand系统中,相机固定在机器人末端,因此相机坐标系{C}与工具坐标系{T}之间存在一个固定的未知变换 CTH,这正是标定需要求解的目标。完整的坐标系变换链如下:
基座 {B} → 工具 {T} → 相机 {C} → 标定板 {P}
已知(机器人读数) 待求(手眼矩阵) 已知(标定板位姿)
其中,标定板坐标系{P}相对于基座{B}的变换可通过机器人位姿与相机观测联合建立方程。
3.3 手眼标定问题分类
根据相机与机器人的安装方式,手眼标定分为两大类,其数学模型与求解策略有显著差异。
| 对比维度 | Eye-to-Hand(眼在手外) | Eye-in-Hand(眼在手上) |
|---|---|---|
| 相机安装位置 | 固定在工作空间上方或侧面,不随机器人运动 | 固定在机器人末端法兰或工具上,随机器人运动 |
| 标定目标 | 求解相机坐标系{C}到基座坐标系{B}的变换 BCH | 求解相机坐标系{C}到工具坐标系{T}的变换 CTH |
| 标定板安装 | 标定板固定在机器人末端,随机器人运动 | 标定板固定在工作空间某处,不随机器人运动 |
| 观测方程形式 | BCH · CPH = BTH · TPH | BTH · TCH · CPH = BPH |
| 典型应用场景 | 大视野定位、机器人抓取前的全局视觉引导 | 3D线扫、焊缝跟踪、精密装配、小视野高精度检测 |
| 标定复杂度 | 中等,标定板需固定在末端,运动范围受限 | 较高,需多组不同位姿观测,且线扫相机需配合运动 |
课程聚焦: 本课程所有标定方法均针对 Eye-in-Hand 配置。3D线扫相机固定在机器人末端,利用机器人运动实现线扫成像,因此手眼矩阵 CTH 的精度直接影响点云拼接与测量准确性。
3.4 Eye-in-Hand 标定的数学本质
对于Eye-in-Hand系统,标定问题可归结为求解经典方程:
B_T_H * T_C_H * C_P_H = B_P_H
其中:
B_T_H:机器人正向运动学给出的基座→工具变换(已知,随位姿变化)
T_C_H:工具→相机变换(待求的固定手眼矩阵)
C_P_H:相机观测到的标定板位姿(已知,由标定板图像/点云解算)
B_P_H:标定板在基座坐标系下的位姿(未知,但固定不变)
通过采集多组不同机器人位姿下的观测数据,可以消去未知的 BPH,构建形如 AX = XB 的齐次矩阵方程,其中A、B由相邻两组位姿的变换差计算得到,X即为待求的手眼矩阵。
3.5 标定流程概览
基于上述坐标系基础,Eye-in-Hand标定的典型流程包含以下步骤:
- 准备标定板:选择高精度陶瓷或玻璃标定板,特征点间距已知且经过计量校准。
- 采集多组位姿数据:控制机器人运动到N个不同位姿(N≥5),在每个位姿下记录机器人正向运动学输出 BTH 和相机观测到的标定板位姿 CPH。
- 构建AX=XB方程:利用相邻两组位姿数据,计算A = (BT2H)⁻¹ · BT1H 和 B = CP2H · (CP1H)⁻¹,求解X = CTH。
- 非线性优化:以AX=XB的解析解为初值,对所有观测数据进行整体重投影误差最小化优化。
- 精度验证:使用预留的验证位姿数据,计算标定后点云拼接误差或三维测量误差。
常见误区: 初学者容易混淆工具坐标系{T}与相机坐标系{C}的变换方向。在Eye-in-Hand中,手眼矩阵定义为 CTH(从工具到相机的变换),而非 TCH。请务必在构建方程时确认变换链方向一致。