3. 刚体变换与齐次矩阵：旋转矩阵、平移向量、齐次坐标、4x4齐次变换矩阵的数学表示
在3D视觉与手眼标定中，机器人末端执行器与相机之间的空间关系本质上是刚体变换。刚体变换保证物体在三维空间中只发生旋转和平移，不发生形变、缩放或剪切。本章将系统梳理刚体变换的数学工具：旋转矩阵、平移向量、齐次坐标以及4x4齐次变换矩阵，为后续标定方程建立奠定基础。
3.1 旋转矩阵：描述姿态的数学核心
旋转矩阵是一个3x3的正交矩阵，用于描述两个坐标系之间的旋转变换。设坐标系{A}与坐标系{B}原点重合，则{B}相对于{A}的姿态可由旋转矩阵 ABR 表示：
[ r11 r12 r13 ]
ABR = [ r21 r22 r23 ]
[ r31 r32 r33 ]旋转矩阵满足以下性质：
- 正交性：RTR = I，R-1 = RT
- 行列式为+1：det(R) = 1（右手系）
- 列向量为单位向量且两两正交
关键理解：旋转矩阵的每一列代表被旋转坐标系{B}的基向量在参考坐标系{A}中的投影。例如，第一列 [r11, r21, r31]T 即为{B}的X轴在{A}中的方向余弦。
3.2 平移向量：描述位置的偏移
平移向量是一个3x1的列向量，表示两个坐标系原点之间的位移。设坐标系{B}的原点在坐标系{A}中的位置为 APBorg：
APBorg = [ x, y, z ]T当已知空间中一点P在{B}中的坐标 BP，求该点在{A}中的坐标 AP 时，完整的刚体变换公式为：
AP = ABR · BP + APBorg
手眼标定中的物理意义：旋转矩阵描述相机与机器人末端之间的姿态差异，平移向量描述两者之间的位置偏移。两者共同构成6自由度（3旋转+3平移）的空间刚体关系。
3.3 齐次坐标：统一旋转与平移的数学工具
为了将旋转和平移统一为线性变换，引入齐次坐标。齐次坐标将三维点扩展为四维向量，在末尾添加一个缩放因子w（通常取1）：
三维点 (x, y, z) → 齐次坐标 [x, y, z, 1]T
三维向量 (vx, vy, vz) → 齐次坐标 [vx, vy, vz, 0]T齐次坐标的核心优势：
| 特性 | 欧氏坐标 | 齐次坐标 |
|---|---|---|
| 旋转+平移表示 | 分离为R和t | 统一为4x4矩阵 |
| 变换复合 | 需分别计算 | 矩阵乘法串联 |
| 逆变换 | RT 和 -RTt | 4x4矩阵求逆 |
| 无穷远点表示 | 无法表示 | w=0表示方向 |
3.4 4x4齐次变换矩阵：刚体变换的完整表达
将旋转矩阵R（3x3）和平移向量t（3x1）组合为4x4齐次变换矩阵T：
[ R t ] [ r11 r12 r13 x ]
T = [ ] = [ r21 r22 r23 y ]
[ 0T 1 ] [ r31 r32 r33 z ]
[ 0 0 0 1 ]其中：
- 左上角3x3子块：旋转矩阵R
- 右上角3x1子块：平移向量t
- 左下角1x3子块：零向量
- 右下角1x1子块：缩放因子1
使用齐次变换矩阵，点P的坐标变换简化为：
APhom = ABT · BPhom其中 APhom 和 BPhom 均为齐次坐标形式。
常见误区：齐次变换矩阵的逆矩阵不是简单的转置，而是：
T-1 = [ RT -RTt ; 0T 1 ]。在手眼标定中，求逆操作频繁出现，务必使用正确公式。
T-1 = [ RT -RTt ; 0T 1 ]。在手眼标定中，求逆操作频繁出现，务必使用正确公式。
3.5 变换的复合与逆变换
在手眼标定中，经常需要将多个变换串联。设坐标系{A}到{B}的变换为 ABT，{B}到{C}的变换为 BCT，则{A}到{C}的复合变换为：
ACT = ABT · BCT复合变换的物理意义：先进行 BCT 变换，再进行 ABT 变换。注意矩阵乘法不满足交换律，变换顺序至关重要。
逆变换用于从目标坐标系回到源坐标系：
BAT = (ABT)-1 = [ ABRT -ABRT · APBorg ; 0T 1 ]
手眼标定中的典型变换链：
机器人基座 → 机器人末端 → 相机 → 标定板
每个环节都是一个4x4齐次变换矩阵，整个链路的复合变换构成标定方程的核心。
机器人基座 → 机器人末端 → 相机 → 标定板
每个环节都是一个4x4齐次变换矩阵，整个链路的复合变换构成标定方程的核心。
3.6 旋转矩阵的三种参数化方式
旋转矩阵虽然有9个元素，但只有3个自由度。实际应用中常用以下参数化方式：
| 参数化方式 | 表示形式 | 优点 | 缺点 |
|---|---|---|---|
| 欧拉角 | (α, β, γ) 绕固定轴或动轴旋转 | 直观，3个参数 | 万向锁问题，不连续 |
| 旋转向量 | θ·u (角度×单位轴) | 紧凑，无冗余 | 需Rodrigues公式转换 |
| 四元数 | q = (w, x, y, z) | 无奇异性，插值平滑 | 需归一化，不直观 |
工程建议：在手眼标定求解过程中，内部计算推荐使用四元数或旋转向量避免奇异性；最终结果通常转换为旋转矩阵形式，便于与4x4齐次变换矩阵集成。
3.7 本章小结
- 旋转矩阵R：3x3正交矩阵，描述坐标系间的姿态关系，满足RTR=I且det(R)=1。
- 平移向量t：3x1向量，描述坐标系原点间的位移。
- 齐次坐标：将三维点扩展为四维向量，使旋转和平移可统一为线性变换。
- 4x4齐次变换矩阵T：由R和t组合而成，是手眼标定中描述刚体变换的标准数学工具。
- 变换复合：多个变换可通过矩阵乘法串联，变换顺序不可交换。
- 逆变换：T-1 = [RT -RTt ; 0T 1]，用于反向求解坐标系关系。