想象一下，你告诉一个机械臂“关节1转30度，关节2转45度”，它如何知道自己手掌（末端）最终伸到了哪里？正向运动学就是回答这个问题的数学工具。它根据已知的机器人关节角度，计算出末端执行器在空间中的位置和姿态。

正向运动学是机器人控制、路径规划和仿真的基石。没有它，我们就无法将关节指令映射为末端在三维空间中的实际运动。

DH参数法：描述机器人结构的标准语言

要计算正向运动学，首先需要一种标准化的方法来描述机器人连杆和关节之间的几何关系。Denavit-Hartenberg（DH）参数法就是最广泛使用的建模工具。它用四个参数来唯一确定相邻连杆坐标系之间的变换关系。

四个DH参数分别是：

对于旋转关节，关节转角θ_i是变量，其他三个是固定常数。对于平移关节，关节偏距d_i是变量。这四个参数定义了一个从坐标系{i-1}到坐标系{i}的标准变换。

从DH参数到变换矩阵

一旦获得了相邻坐标系间的四个DH参数，就可以构造出齐次变换矩阵 ^i-1_iT。这个矩阵描述了如何将坐标系{i}中的点，变换到坐标系{i-1}中表示。

标准DH参数法对应的变换由四个顺序变换组成：

将这四次变换的矩阵按顺序相乘，就得到了最终的 ^i-1_iT 矩阵。其通用形式如下（其中cθ表示cosθ，sθ表示sinθ，cα表示cosα，sα表示sinα）：

i-1T = [
[ cθ<sub>i</sub>,   -sθ<sub>i</sub>*cα<sub>i-1</sub>,    sθ<sub>i</sub>*sα<sub>i-1</sub>,     a<sub>i-1</sub>*cθ<sub>i</sub> ],
[ sθ<sub>i</sub>,    cθ<sub>i</sub>*cα<sub>i-1</sub>,   -cθ<sub>i</sub>*sα<sub>i-1</sub>,     a<sub>i-1</sub>*sθ<sub>i</sub> ],
[ 0,         sα<sub>i-1</sub>,          cα<sub>i-1</sub>,           d<sub>i</sub>      ],
[ 0,         0,               0,            1      ]
]

这个矩阵的左上角3x3部分是旋转矩阵，描述了姿态变换；右边3x1部分是位置向量，描述了原点平移。对于每个关节i，你只需要代入其DH参数和当前的关节变量（θ_i或d_i），就能算出这个变换矩阵。

串联机器人正向运动学计算流程

对于一个由n个关节串联而成的机器人（如常见的六轴机械臂），其末端执行器坐标系{n}相对于基座坐标系{0}的变换，就是所有相邻连杆变换矩阵的连续乘积。

计算公式为：

⁰_nT = ⁰₁T * ¹₂T * ²₃T * ... * ^n-1_nT

计算步骤非常清晰：

1. 建模：为机器人每个连杆建立坐标系，确定所有DH参数（常数a, α, d和变量θ或d）。
2. 获取关节状态：读取当前所有关节的位置（角度或位移）。
3. 计算单步变换：对每个关节i，根据其DH参数和关节状态，计算 ^i-1_iT。
4. 矩阵链乘：将所有单步变换矩阵按顺序相乘，得到 ⁰_nT。
5. 提取位姿：从 ⁰_nT 中提取出末端的位置向量（矩阵第4列前3行）和旋转矩阵（矩阵左上角3x3部分）。

让我们通过一个极简的例子——一个在平面内运动的2连杆机械臂（RR机构），来直观感受这个过程。

这个结果非常直观：末端点的X坐标是两段连杆在X方向投影之和，Y坐标同理，而最终姿态就是两个关节角度的叠加。对于更复杂的6轴空间机械臂，虽然矩阵运算复杂，但原理完全相同。

正向运动学的应用与局限

正向运动学计算是机器人众多功能的基础模块。

• 仿真与可视化：在软件中驱动机器人模型运动，实时显示末端位置。
• 开环控制：在精度要求不高的场景，直接根据关节传感器读数判断末端大致位置。
• 为逆向运动学提供输入：逆向求解通常需要正向计算来验证解的正确性或进行迭代。

然而，正向运动学有一个核心局限：它是单向的。给定关节角，它能唯一确定末端位姿；但给定一个期望的末端位姿，它无法直接告诉你关节角应该怎么转。这就是逆向运动学要解决的问题。此外，正向运动学本身不处理关节限位、连杆碰撞、奇异点等问题，这些需要在应用层额外处理。