工业机器人运动学基础：关节空间与笛卡尔空间、正逆运动学、DH参数、关节变量与末端位姿的关系
工业机器人的运动控制，本质上是对其末端执行器在空间中位姿（位置与姿态）的精确操控。要理解关节空间轨迹规划与插补算法，首先必须建立机器人运动学的基本框架。本章将系统阐述关节空间与笛卡尔空间的映射关系、正逆运动学的数学本质、DH参数建模方法，以及关节变量如何决定末端位姿。这些概念是后续所有轨迹规划算法的理论基石，直接决定了插补精度与运动平稳性。
2.1 关节空间与笛卡尔空间：两种描述视角
核心原理：工业机器人的运动描述存在两个天然坐标系。关节空间（Joint Space）以机器人各关节的独立变量为坐标轴，对于旋转关节为角度θᵢ，对于移动关节为位移dᵢ。一个n自由度机器人，其关节空间是n维向量空间，任意一点q = [q₁, q₂, ..., qₙ]ᵀ唯一确定机器人的一个构型。笛卡尔空间（Cartesian Space），又称任务空间或操作空间，以机器人基座坐标系为参考，描述末端执行器的位置(x, y, z)和姿态(α, β, γ)，通常用6维向量X = [x, y, z, α, β, γ]ᵀ表示。
两种空间的本质区别在于：关节空间是驱动空间，电机和减速器直接控制的是关节变量；笛卡尔空间是任务空间，用户编程和工艺要求通常以末端位姿给出。轨迹规划必须在这两个空间之间反复切换——在关节空间规划时，各关节运动独立、计算简单，但末端轨迹不可预测；在笛卡尔空间规划时，末端轨迹直观可控，但需要实时求解逆运动学，计算量大且可能遇到奇异点。
2.2 正运动学：从关节变量到末端位姿
核心原理：正运动学（Forward Kinematics, FK）解决"给定关节变量q，求末端位姿T"的问题。其数学本质是相邻连杆坐标系的齐次变换矩阵连乘。对于n自由度串联机器人，末端位姿矩阵为：
T = A₁(q₁) · A₂(q₂) · ... · Aₙ(qₙ)其中每个Aᵢ是4×4齐次变换矩阵，包含旋转子矩阵Rᵢ(3×3)和平移向量pᵢ(3×1)。正运动学具有唯一解——给定一组关节变量，末端位姿是确定的，不存在多解问题。这使得正运动学计算简单、实时性好，通常只需几十微秒即可完成。
2.3 DH参数：标准化的连杆坐标系描述
核心原理：Denavit-Hartenberg（DH）参数是描述相邻连杆之间相对位置和姿态的标准方法。每个连杆坐标系由4个参数唯一确定：
| 参数 | 符号 | 物理含义 | 关节类型影响 |
|---|---|---|---|
| 连杆长度 | aᵢ₋₁ | 沿xᵢ₋₁轴，从zᵢ₋₁移动到zᵢ的距离 | 固定值 |
| 连杆扭转角 | αᵢ₋₁ | 绕xᵢ₋₁轴，从zᵢ₋₁旋转到zᵢ的角度 | 固定值 |
| 连杆偏距 | dᵢ | 沿zᵢ轴，从xᵢ₋₁移动到xᵢ的距离 | 移动关节变量 |
| 关节角 | θᵢ | 绕zᵢ轴，从xᵢ₋₁旋转到xᵢ的角度 | 旋转关节变量 |
DH参数建模的操作流程：首先为每个关节建立坐标系zᵢ轴（沿关节轴线），然后确定xᵢ轴（沿相邻z轴的公垂线方向），最后按标准DH或改进DH规则填写参数表。标准DH（Craig版本）和改进DH（经典版本）在坐标系放置上略有差异，但最终正运动学结果一致。
2.4 逆运动学：从末端位姿到关节变量
核心原理：逆运动学（Inverse Kinematics, IK）解决"给定末端位姿T，求关节变量q"的问题。与正运动学不同，逆运动学具有以下特征：
- 多解性：同一末端位姿可能对应多组关节角（如肘部上/下、腕部翻转），需根据关节限位和避障要求选择最优解。
- 可能无解：当目标位姿超出机器人工作空间时，逆运动学无实数解。
- 奇异位形：在奇异点附近，关节速度趋于无穷大，导致运动失控。
逆运动学求解方法分为解析法和数值法。解析法通过代数或几何方法直接求解，速度快、精度高，适用于满足Pieper准则的机器人（相邻三关节轴线交于一点，大多数6轴工业机器人满足此条件）。数值法（如牛顿-拉夫森迭代）通用性强，但计算量大、可能收敛到局部解。
2.5 关节变量与末端位姿的映射关系案例
案例拆解：以典型6轴关节型工业机器人（如ABB IRB 120）为例，其DH参数表如下（单位：mm和rad）：
| 关节i | aᵢ₋₁ | αᵢ₋₁ | dᵢ | θᵢ |
|---|---|---|---|---|
| 1 | 0 | 0 | 290 | θ₁ |
| 2 | 270 | -π/2 | 0 | θ₂ |
| 3 | 70 | 0 | 0 | θ₃ |
| 4 | 0 | π/2 | 302 | θ₄ |
| 5 | 0 | π/2 | 0 | θ₅ |
| 6 | 0 | -π/2 | 72 | θ₆ |
正运动学验证：设初始关节角q = [0, -π/2, 0, 0, 0, 0]ᵀ，通过DH变换连乘，计算得到末端位姿矩阵T。其中位置向量p = [270, 0, 290+302+72]ᵀ = [270, 0, 664]ᵀ，旋转矩阵R为单位阵。这意味着末端位于基座前方270mm、高度664mm处，姿态与基座坐标系一致。
逆运动学分析：若要求末端移动到p = [400, 100, 500]ᵀ且姿态保持水平，通过解析法求解可得两组关节角解（肘上/肘下）。实际控制器会根据当前关节位置和运动连续性选择最接近的一组解，避免关节突变。
复盘经验：该案例表明，关节变量与末端位姿的映射关系是轨迹规划的核心。在关节空间规划时，我们直接对θ₁~θ₆进行插补；在笛卡尔空间规划时，则需对末端位姿进行插补，再通过IK转换为关节角指令。两种方式各有优劣，需根据工艺需求选择。
2.6 常见误区与总结
常见误区：
- 混淆空间概念：误以为关节空间轨迹就是各关节独立运动，忽略了末端轨迹的耦合效应。实际上，即使各关节按正弦规律运动，末端轨迹也可能是复杂曲线。
- 忽视DH参数符号：DH参数中α和θ的正负号方向容易出错，导致正运动学计算结果偏差。建议使用标准工具或仿真软件验证。
- 逆运动学多解处理不当：简单选择"第一组解"可能导致关节运动不连续或碰撞。应综合考虑关节限位、奇异规避和运动平滑性。
- 奇异点认知不足：在奇异点附近，即使关节角微小变化也会导致末端位姿剧烈变化，轨迹规划必须提前规避。