六轴机械臂基础：运动学模型、D-H参数、正逆解概念、工作空间与自由度
六轴机械臂是工业自动化与智能制造中最常见的执行机构形态，其核心价值在于通过六个旋转关节的协同运动，使末端执行器在三维空间中到达目标位置并保持期望姿态。要完成离线编程与碰撞检测，首先必须建立对机械臂运动学本质的深刻理解。本章将系统梳理运动学模型、D-H参数、正逆解概念、工作空间与自由度这五大基础模块，为后续轨迹规划与碰撞检测算法打下坚实的理论根基。
上图展示了六轴机械臂运动学知识体系的整体框架。五个基础模块相互关联：自由度定义了机械臂的运动能力边界，D-H参数提供了数学建模的统一语言，正运动学解决"关节角到位姿"的映射，逆运动学解决"位姿到关节角"的反向求解，而工作空间则从几何角度界定了机械臂的物理可达范围。在离线编程系统中，这些模块共同构成了从虚拟仿真到实际控制的核心算法链。
2.1 自由度与六轴机械臂的结构本质
核心原理：自由度（Degrees of Freedom, DOF）是描述机构运动独立性的基本参数。在三维空间中，一个刚体具有6个自由度——沿X、Y、Z轴的平移（3个位置自由度）和绕X、Y、Z轴的旋转（3个姿态自由度）。六轴机械臂之所以采用6个旋转关节，正是为了在理论上完全匹配末端执行器在三维空间中的6个自由度需求。
从机构学角度看，六轴机械臂通常由基座、腰部（J1）、肩部（J2）、肘部（J3）以及腕部三个关节（J4、J5、J6）组成。前三个关节（J1-J3）主要决定末端的位置，后三个关节（J4-J6）主要决定末端的姿态。这种"位置-姿态"解耦的结构设计，使得逆运动学求解可以分步进行，大大降低了计算复杂度。
判断方法：在实际工程中，判断一个机械臂是否满足任务需求，需要对比任务所需的自由度与机械臂提供的自由度。例如，简单的搬运任务可能只需要3-4个自由度（位置+单一姿态），而复杂的装配任务则需要完整的6个自由度。当任务自由度超过机械臂自由度时，必然存在不可达的位姿；反之，当任务自由度低于机械臂自由度时，则存在冗余自由度，需要额外的约束条件来获得唯一解。
| 关节编号 | 典型名称 | 运动范围（示例） | 主要功能 |
|---|---|---|---|
| J1 | 腰部旋转 | ±170° | 整体水平旋转，决定末端X-Y平面方位 |
| J2 | 肩部俯仰 | +135° / -45° | 大臂前后摆动，影响末端高度与径向距离 |
| J3 | 肘部俯仰 | +70° / -180° | 小臂相对大臂摆动，扩展径向可达范围 |
| J4 | 腕部旋转1 | ±190° | 末端法兰绕小臂轴线旋转 |
| J5 | 腕部俯仰 | ±120° | 末端法兰俯仰摆动，调整姿态仰角 |
| J6 | 腕部旋转2 | ±360° | 末端法兰绕自身轴线旋转，完成姿态微调 |
2.2 D-H参数：建立运动学模型的通用语言
核心原理：Denavit-Hartenberg（D-H）参数法是一种系统化描述相邻连杆之间相对位置和姿态的方法。每个连杆通过4个参数来定义：连杆长度（ai-1）、连杆扭转角（αi-1）、连杆偏距（di）和关节角（θi）。其中，a和α描述连杆自身的几何特性，d和θ描述相邻连杆之间的连接关系。对于旋转关节，θ是变量；对于移动关节，d是变量。六轴机械臂全部采用旋转关节，因此θ1至θ6为关节变量。
D-H参数法的核心价值在于：通过4个参数的齐次变换矩阵连乘，可以建立从基坐标系到末端坐标系的完整变换关系。标准D-H模型（Craig版本）的相邻连杆变换矩阵为：
T(i-1→i) = Rot(z, θi) · Trans(z, di) · Trans(x, a(i-1)) · Rot(x, α(i-1))其中，Rot表示旋转矩阵，Trans表示平移矩阵。将6个变换矩阵依次相乘，即可得到末端坐标系相对于基坐标系的位姿矩阵T(0→6)。
操作流程：建立六轴机械臂D-H模型的步骤如下：
- 定义各关节坐标系：按照D-H规则，将坐标系{i}固定在连杆i上，Zi轴沿关节i+1的轴线方向。
- 确定连杆参数：根据机械臂的机械图纸或三维模型，测量并填写ai-1、αi-1、di的数值。
- 标注关节变量：明确θi的零位和正方向，通常与机械臂的零点标定一致。
- 验证模型：将机械臂置于已知位姿（如机械零点），代入D-H参数计算末端位姿，与实测值对比。
| 关节 i | a(i-1) (mm) | α(i-1) (°) | d(i) (mm) | θ(i) (°) |
|---|---|---|---|---|
| 1 | 0 | 0 | 290 | θ1 |
| 2 | 270 | -90 | 0 | θ2 |
| 3 | 70 | 0 | 0 | θ3 |
| 4 | 0 | -90 | 302 | θ4 |
| 5 | 0 | 90 | 0 | θ5 |
| 6 | 0 | -90 | 72 | θ6 |
2.3 正运动学与逆运动学：双向映射的数学桥梁
核心原理：正运动学（Forward Kinematics, FK）是已知6个关节角，求解末端执行器在笛卡尔空间中的位置和姿态。这是一个确定性的映射过程，对于给定的关节角组合，末端位姿是唯一的。正运动学计算相对简单，只需按照D-H参数依次进行矩阵连乘即可。
逆运动学（Inverse Kinematics, IK）则是已知末端执行器的目标位姿，求解满足该位姿的关节角组合。这是一个复杂的非线性问题，具有以下特征：
- 多解性：同一个末端位姿通常对应多组关节角解（如肘部向上/向下、腕部翻转等）。
- 可能无解：当目标位姿超出机械臂的工作空间时，不存在有效解。
- 奇异位形：在特定姿态下，机械臂会丧失某个方向的运动能力，导致雅可比矩阵秩亏。
判断方法：在离线编程中，面对多组逆解，需要根据以下准则进行选解：
- 关节限位约束：剔除超出关节运动范围的解。
- 碰撞约束：剔除会导致机械臂与工件、夹具或环境发生碰撞的解。
- 运动连续性：优先选择与当前关节角最接近的解，避免关节突变。
- 奇异规避：避免选择接近奇异位形的解。
2.4 工作空间：机械臂的物理可达边界
核心原理：工作空间（Workspace）是机械臂末端执行器在空间中所有可达位置的集合。根据姿态要求的不同，工作空间可分为：
- 可达工作空间：末端至少能以一种姿态到达的位置集合。
- 灵活工作空间：末端能以任意姿态到达的位置集合，通常远小于可达工作空间。
工作空间的形状和大小由连杆长度、关节运动范围以及机械结构共同决定。对于六轴机械臂，工作空间通常呈现为近似球壳的不规则形状，内部可能存在空洞（不可达区域）。
操作流程：在离线编程中，工作空间分析通常采用蒙特卡洛法：
- 在各关节的运动范围内随机生成大量关节角组合（如10万组）。
- 对每组关节角执行正运动学计算，得到末端位置点。
- 将所有位置点在三维空间中绘制成散点图，即可直观显示工作空间。
- 通过统计方法计算工作空间的体积、边界等量化指标。
2.5 常见误区与总结复盘
常见误区：
- 误区一：认为6自由度机械臂可以到达工作空间内的任意位姿。实际上，只有灵活工作空间内的点才能实现任意姿态，可达工作空间边缘区域的姿态选择非常有限。
- 误区二：忽略D-H参数中α角的正负号。α角的正负直接影响坐标系的旋转方向，一个符号错误会导致整个运动学模型失效。
- 误区三：在逆解选解时只考虑关节限位，不考虑碰撞。离线编程的核心优势之一就是可以在虚拟环境中进行碰撞检测，应充分利用这一能力。
- 误区四：将工作空间视为标准球体。实际工作空间受关节限位影响，形状不规则，必须通过数值方法或厂商提供的图纸确认。
总结复盘：本章内容构成了六轴机械臂离线编程的数学与几何基础。在实际项目中，建议按以下顺序进行运动学验证：首先核对D-H参数与机械图纸的一致性；其次通过正运动学验证模型正确性；然后针对典型任务位姿进行逆解求解与选解；最后进行工作空间分析，确认任务的可达性。这一流程能够有效降低后续轨迹规划与碰撞检测阶段的返工风险。