2. 机器人运动学基础
工业机器人轨迹规划与运动控制的底层数学根基，是刚体在三维空间中的位姿描述与坐标变换。无论是六轴关节臂还是SCARA机器人，控制器都需要在关节空间与笛卡尔空间之间反复映射，而这一映射的数学语言正是齐次变换矩阵。本节将系统梳理位姿描述方法、齐次变换矩阵的构造与运算规则，并厘清正运动学与逆运动学在工程中的角色边界，为后续插补算法与关节轨迹规划奠定严格的数学基础。
3.1 刚体位姿描述：从三维向量到旋转矩阵
机器人末端执行器在空间中的状态由位置与姿态两部分构成，合称位姿。位置用三维向量 P = [x, y, z]ᵀ 表示，描述的是坐标系原点在参考坐标系中的坐标；姿态则描述刚体坐标系相对于参考坐标系的旋转关系，数学上通常用 3×3 旋转矩阵 R 表示。旋转矩阵的列向量分别是刚体坐标系各轴在参考坐标系中的方向余弦，满足正交性与行列式为 +1 的约束。
实际工程中，旋转矩阵的9个元素存在冗余，因此常采用更紧凑的表达方式：欧拉角（RPY、ZYX等）、四元数、轴角表示。欧拉角直观但存在万向锁问题；四元数无奇异且插值平滑，在轨迹规划中应用广泛；轴角表示适合描述绕任意轴的旋转。选择何种表达方式取决于应用场景：示教器显示常用欧拉角，姿态插补常用四元数，而底层矩阵运算则统一使用旋转矩阵。
3.2 齐次变换矩阵：统一位置与姿态的数学工具
为了将旋转与平移统一为一次线性变换，工程上引入 4×4 齐次变换矩阵 T：
T = [ R P ]
[ 0 1 ]其中 R 为 3×3 旋转矩阵，P 为 3×1 平移向量，最后一行固定为 [0 0 0 1]。齐次变换矩阵的核心价值在于：复合变换可以通过矩阵乘法直接实现。例如，从基坐标系到工具坐标系的变换 T_base_tool = T_base_link1 · T_link1_link2 · ... · T_linkN_tool，将多个关节的旋转与连杆的平移串联起来。
逆变换的计算同样简洁：T⁻¹ = [Rᵀ -RᵀP; 0 1]。由于旋转矩阵的正交性，其逆等于转置，这大大简化了计算。在机器人控制中，经常需要在基坐标系与工具坐标系之间来回切换，掌握齐次变换矩阵的逆运算至关重要。
| 变换类型 | 数学表达 | 物理含义 | 工程应用 |
|---|---|---|---|
| 纯平移 | T = [I P; 0 1] | 仅改变位置，不改变姿态 | 工件坐标系偏移 |
| 纯旋转 | T = [R 0; 0 1] | 仅改变姿态，不改变位置 | 工具姿态调整 |
| 复合变换 | T₁₂ · T₂₃ | 先相对坐标系2变换，再相对坐标系1变换 | 多关节链式求解 |
| 逆变换 | T⁻¹ = [Rᵀ -RᵀP; 0 1] | 从目标坐标系反算参考坐标系 | 视觉引导手眼标定 |
3.3 正运动学：从关节空间到笛卡尔空间的唯一映射
正运动学解决的是：已知各关节角度，求末端执行器的位姿。对于 n 自由度串联机器人，通过 DH 参数（Denavit-Hartenberg）建立相邻连杆坐标系间的齐次变换矩阵 Aᵢ，然后依次连乘得到末端位姿：
T₀ₙ = A₁(θ₁) · A₂(θ₂) · ... · Aₙ(θₙ)正运动学具有唯一解，即给定一组关节角，末端位姿是确定的。这一特性使得正运动学常用于：验证逆运动学解的正确性、机器人标定中的前向计算、以及实时控制中的位姿反馈。在工业机器人控制器中，正运动学通常以固定函数形式封装，计算量小，可在每个控制周期（通常1-8ms）内完成。
某六轴机器人DH参数中，关节2与关节3之间存在连杆偏置 a₂=600mm，d₄=150mm。当给定关节角 θ=[0°, -30°, 60°, 0°, 45°, 0°] 时，通过连乘计算得到末端位置 P=[512.3, 0, 418.7]mm，姿态 R 的 ZYX 欧拉角为 [0°, 15.2°, 0°]。该结果与激光跟踪仪实测值偏差小于0.3mm，验证了DH参数标定的准确性。若偏差过大，应优先检查关节零位标定与连杆参数误差。
3.4 逆运动学：多解、奇异与工程取舍
逆运动学是轨迹规划的核心难点：已知末端目标位姿，反求各关节角。与正运动学不同，逆运动学存在以下特征：
- 多解性：同一末端位姿可能对应多组关节角（如肘上/肘下、腕部翻转）；
- 可能无解：目标位姿超出机器人工作空间；
- 奇异位形：在特定姿态下，关节速度与末端速度的映射关系退化，导致某些方向无法运动。
求解方法分为解析法与数值法。解析法（如Pieper方法）适用于满足相邻三轴交于一点的6自由度机器人，计算快、精度高，是工业机器人主流方案。数值法（如雅可比迭代、优化方法）通用性强，但计算量大、可能陷入局部最优，常用于冗余自由度或特殊构型机器人。
工程中处理多解问题的策略是：根据当前关节位置选择最近解（最小关节位移），同时避开关节限位与奇异区域。例如，在轨迹插补的每个周期，逆解模块会优先选择与上一周期关节角变化最小的解，以保证运动连续性。
3.5 正逆运动学在轨迹规划中的协同工作
在工业机器人关节轨迹规划中，正逆运动学并非孤立使用，而是形成闭环：
- 笛卡尔空间规划：在任务空间（如焊接、涂胶路径）中规划末端位姿序列；
- 逆运动学求解：将每个目标位姿转换为关节角；
- 关节空间插补：在关节角之间进行平滑插值（如梯形速度、S曲线）；
- 正运动学校验：将插补后的关节角重新计算末端位姿，验证路径精度。
这种"笛卡尔规划→逆解→关节插补→正解校验"的流程，既保证了末端路径的几何精度，又兼顾了关节运动的平滑性。实际系统中，逆解计算通常占用控制周期约20%-30%的算力，因此优化逆解算法（如查表法、简化模型）对提升控制频率至关重要。
| 对比维度 | 正运动学 | 逆运动学 |
|---|---|---|
| 输入 | 关节角 θ₁...θₙ | 末端位姿 T_des |
| 输出 | 末端位姿 T₀ₙ | 关节角 θ₁...θₙ |
| 解的唯一性 | 唯一 | 多解或无解 |
| 计算复杂度 | 低（矩阵连乘） | 高（需解方程组） |
| 典型应用 | 位姿反馈、标定验证 | 轨迹规划、示教再现 |
3.6 常见误区与工程复盘
误区一：混淆坐标系变换顺序。齐次变换矩阵的乘法不满足交换律，T₁₂·T₂₃ 与 T₂₃·T₁₂ 含义完全不同。在编写代码时，务必明确每个变换矩阵的参考坐标系，建议在变量命名中体现（如 T_base_link1）。
误区二：忽略数值精度。旋转矩阵在长时间迭代后可能失去正交性，需定期正交化处理（如SVD分解后重新正交化）。在轨迹插补中，建议每100个周期对旋转矩阵做一次正交化修正。
误区三：逆解选择只看距离。仅选择关节角变化最小的解，可能忽略关节限位或奇异区域。正确的做法是：先排除超限解，再计算候选解的加权代价（关节位移、能耗、避障距离），最后选择最优解。
掌握位姿描述、齐次变换矩阵、正逆运动学的基本概念，是理解后续插补算法与轨迹规划的前提。下一层级的关节空间插补、笛卡尔空间插补以及奇异规避策略，都将基于本节建立的数学框架展开。