3. 坐标系与变换：世界坐标系、工具坐标系、用户坐标系，齐次变换矩阵（旋转+平移）

坐标系这东西，说白了就是给机器人一个「空间感」。没有坐标系，你告诉它「往右走 10 厘米」，它根本不知道「右」是哪个方向。我刚开始接触运动控制时，总觉得坐标系是个纯理论概念，直到有一次调试六轴机械臂，因为工具坐标系没标定，夹爪直接怼到了工件上……嗯，从那以后我再也不敢小看坐标系了。

3.1 为什么需要多个坐标系？

你想想看，一个机器人系统里，有底座、有关节、有末端执行器，还有工作台上的工件。如果只用一套坐标系描述所有东西，计算会变得非常混乱。比如：

• 世界坐标系：固定在机器人底座或车间地面，是全局参考。
• 工具坐标系：固定在机器人末端（比如焊枪尖、夹爪中心），描述工具的位置和姿态。
• 用户坐标系：由用户自定义，通常贴在工作台或工件上，方便编程。

我个人习惯把世界坐标系当作「绝对原点」，其他坐标系都是相对于它定义的。这样，无论机器人怎么动，我都能知道工具相对于工件的精确位置。

3.2 齐次变换矩阵：旋转 + 平移

齐次变换矩阵是一个 4×4 的方阵，它把旋转和平移打包在一起。为什么是 4×4？因为 3×3 的旋转矩阵只能处理旋转，平移需要单独加一个向量。齐次坐标（加一个 1 变成 4 维向量）让旋转和平移可以统一用矩阵乘法完成。

它的标准形式长这样：

| R11  R12  R13  Tx |
| R21  R22  R23  Ty |
| R31  R32  R33  Tz |
|  0    0    0    1  |

左上角 3×3 是旋转矩阵 R，右上角 3×1 是平移向量 T。最后一行固定是 [0 0 0 1]，这是齐次坐标的约定。

3.3 旋转矩阵的三种基本形式

旋转矩阵是正交矩阵，行列式为 +1。绕 X、Y、Z 轴旋转 θ 角的基本矩阵如下：

| 1    0       0    |
| 0  cosθ  -sinθ |
| 0  sinθ   cosθ |

|  cosθ  0  sinθ |
|   0    1   0   |
| -sinθ  0  cosθ |

| cosθ  -sinθ  0 |
| sinθ   cosθ  0 |
|  0      0    1 |

3.4 齐次变换的链式法则

假设你有两个坐标系：{A} 和 {B}。已知 {B} 相对于 {A} 的变换矩阵为 ^AT_B，那么 {B} 中的点 ^BP 转换到 {A} 中的坐标就是：

AP = ATB · BP

如果还有第三个坐标系 {C}，那么：

ATC = ATB · BTC

这就是链式法则。我调试机器人时，经常用这个法则把工具坐标系、用户坐标系串联到世界坐标系下。比如：

• 世界 → 机器人底座（固定）
• 机器人底座 → 机器人末端（由运动学计算）
• 机器人末端 → 工具（标定得到）
• 世界 → 工件（用户坐标系）

最终，工具相对于工件的位姿就是这些矩阵的乘积。

3.5 逆变换：从目标回到原点

有时候我们需要反过来求——已知 ^AT_B，想求 ^BT_A。逆变换矩阵可以直接计算：

BTA = (ATB)-1 = 
|  RT   -RT·T |
|  0 0 0    1    |

其中 R^T 是旋转矩阵的转置（因为旋转矩阵是正交矩阵，逆等于转置），-R^T·T 是平移部分的逆变换。

3.6 知识体系总览

下面这张图把本章的核心逻辑串起来了。你可以看到，世界坐标系是根，工具坐标系和用户坐标系都通过齐次变换矩阵与它关联。链式法则让我们可以在任意坐标系之间跳转。