3. 机械臂建模基础

3.1 D-H参数法：从几何结构到数学表达的标准化

3.1.1 核心原理：四个参数的物理意义

D-H（Denavit-Hartenberg）参数法通过四个参数描述相邻连杆之间的相对位姿关系。对于旋转关节，关节角 θ_i 是变量；对于移动关节，关节偏置 d_i 是变量。其余两个参数——连杆长度 a_i-1 和 连杆扭转角 α_i-1——由机械臂的固定几何结构决定。这四个参数构成一个 4×4 的齐次变换矩阵，将连杆 i-1 的坐标系变换到连杆 i 的坐标系。

标准 D-H 变换矩阵的数学形式为：

T(i-1→i) = Rot(z, θi) · Trans(z, di) · Trans(x, a(i-1)) · Rot(x, α(i-1))

展开后得到：

| cosθi   -sinθi·cosα(i-1)   sinθi·sinα(i-1)   a(i-1)·cosθi |
| sinθi    cosθi·cosα(i-1)  -cosθi·sinα(i-1)   a(i-1)·sinθi |
|   0          sinα(i-1)          cosα(i-1)          di       |
|   0              0                  0               1       |

这一矩阵是后续正运动学计算的基础。将每个关节的变换矩阵依次相乘，即可得到末端执行器相对于基座标系的位姿。

3.1.2 操作流程：D-H参数表的建立步骤

1. 标注关节轴：从基座开始，依次标出每个关节的旋转轴或移动轴方向。
2. 确定公垂线：对于相邻关节轴 i 和 i+1，找到它们的公垂线（若相交则交点为原点）。
3. 建立坐标系：Z_i 轴沿关节轴 i 方向，X_i 轴沿公垂线指向关节轴 i+1。
4. 测量参数：a_i-1 为沿 X_i-1 方向从 Z_i-1 到 Z_i 的距离；α_i-1 为绕 X_i-1 轴从 Z_i-1 旋转到 Z_i 的角度。
5. 填写参数表：将每个关节的四个参数填入表格，形成完整的 D-H 参数表。

典型六轴工业机器人（如 KUKA KR 系列）的 D-H 参数表示例。注意第 2、3 关节的 α 值反映了机器人结构中的“弯脖”设计。

3.1.3 案例拆解：六轴机器人正运动学计算

以一款常见的 6 自由度串联机械臂为例，其 D-H 参数如上表所示。正运动学计算过程如下：

// 伪代码：正运动学计算
T_06 = T_01 * T_12 * T_23 * T_34 * T_45 * T_56;
// 其中 T_(i-1,i) 由 D-H 参数计算得到
// 最终 T_06 的左上 3×3 为姿态矩阵 R
// 右上 3×1 为位置向量 P

给定一组关节角（例如 θ = [0°, 90°, 0°, 0°, 90°, 0°]），通过矩阵连乘可得到末端位置和姿态。这一计算在机器人控制器中每秒执行数百次，是轨迹规划与伺服控制的基础。

3.2 连杆坐标系建立：规则、技巧与常见错误

3.2.1 核心原理：坐标系的几何意义

连杆坐标系是 D-H 参数法的空间载体。每个连杆 i 固连一个坐标系 {i}，其 Z 轴与关节轴 i 重合，X 轴沿公垂线指向关节轴 i+1。坐标系的建立直接影响后续所有计算的复杂度与准确性。正确的坐标系应满足两个基本约束：X_i 垂直于 Z_i，且 X_i 与 Z_i+1 相交。

3.2.2 操作流程：坐标系建立的五步法

1. 识别关节轴：画出所有关节的轴线，用箭头标出正方向。
2. 处理平行轴：若相邻关节轴平行，公垂线不唯一，通常选择过前一坐标系原点的公垂线。
3. 处理相交轴：若相邻关节轴相交，原点取交点，X 轴方向由 Z_i 与 Z_i+1 的叉积确定。
4. 确定 X 轴方向：沿公垂线从关节轴 i 指向关节轴 i+1。
5. 验证右手定则：Y 轴由 Z 和 X 叉积确定，确保坐标系为右手系。

3.2.3 实战场景：球腕结构（Spherical Wrist）的坐标系建立

大多数六轴工业机器人的末端三个关节构成球腕结构——三个关节轴交于一点。这种设计的优势在于：腕部中心位置与姿态解耦，简化了逆运动学求解。在建立坐标系时，第 4、5、6 关节的原点均取在交点处，X 轴方向根据相邻 Z 轴的叉积确定。

3.3 雅可比矩阵：速度映射与静力传递

3.3.1 核心原理：从关节空间到操作空间的线性映射

雅可比矩阵 J(θ) 是关节速度到末端笛卡尔速度的线性映射：

[ v ]   [ Jv ] 
[ ω ] = [ Jω ] · θ̇

其中 v 为末端线速度，ω 为末端角速度，θ̇ 为关节速度向量。J 的每一列对应一个关节的单位速度对末端速度的贡献。对于旋转关节 i，其贡献为：

J_i = [ z_(i-1) × (p_e - p_(i-1)) ]
      [ z_(i-1) ]

其中 z_i-1 是关节轴 i 在基座标系中的方向向量，p_e 是末端位置，p_i-1 是关节 i 原点位置。

3.3.2 判断方法：雅可比矩阵的构造流程

1. 计算正运动学：得到每个关节坐标系相对于基座标的变换矩阵。
2. 提取 Z 轴向量：从 T_0,i-1 中提取 z_i-1（第三列前三行）。
3. 计算位置向量：p_e 为末端位置，p_i-1 为关节 i 原点位置。
4. 填充矩阵列：对于旋转关节，按上述公式计算；对于移动关节，J 列为 [z_i-1; 0]。

3.3.3 案例拆解：2 自由度平面机械臂的雅可比

考虑一个平面 2R 机械臂（连杆长度 L1=L2=1m），其雅可比矩阵为：

J = [ -L1·sinθ1 - L2·sin(θ1+θ2)   -L2·sin(θ1+θ2) ]
    [  L1·cosθ1 + L2·cos(θ1+θ2)    L2·cos(θ1+θ2) ]

当 θ2 = 0°（手臂完全伸直）时，J 的第二列与第一列线性相关，矩阵秩为 1，末端只能沿一个方向运动——这就是边界奇异。当 θ2 = 180°（手臂折叠）时，同样出现奇异。这一简单案例揭示了奇异位形的本质：雅可比矩阵降秩导致操作空间自由度丢失。

3.4 奇异位形分析：识别、影响与规避策略

3.4.1 核心原理：奇异位形的数学本质

奇异位形是机械臂在特定关节角组合下，雅可比矩阵不满秩的状态。此时，末端执行器在某些方向上的运动无法通过关节运动实现，表现为：

• 运动学奇异：末端速度在某些方向不可达，关节速度趋于无穷大。
• 静力奇异：末端力在某些方向无法传递到关节，关节力矩趋于无穷大。
• 控制性能恶化：轨迹跟踪误差增大，甚至引发系统失稳。

3.4.2 判断方法：奇异位形的分类与检测

3.4.3 实战场景：六轴机器人奇异位形规避

在工业机器人轨迹规划中，奇异位形是必须规避的“陷阱”。以典型的焊接或搬运任务为例，当机器人经过腕部奇异位形（第 4 和第 6 关节轴共线）时，第 4 关节速度会急剧增大，可能导致电机过流或轨迹偏差。

3.4.4 案例复盘：奇异位形导致的轨迹跟踪失败

背景：某汽车产线焊接机器人（6 轴，球腕结构）在完成一条圆弧焊缝时，末端轨迹在特定位置出现剧烈抖动，焊接质量不合格。

现象：示教器显示第 4 关节速度指令在 0.2 秒内从 30°/s 跳变到 450°/s，同时第 6 关节位置误差超过 2mm。

分析：通过离线仿真软件检查该路径，发现轨迹经过腕部奇异位形附近（第 4 与第 6 关节轴夹角小于 5°）。此时雅可比矩阵条件数达到 10⁴，逆解对关节速度的放大效应显著。

解决：在路径规划中增加一个过渡点，使机器人以“姿态调整”方式绕过奇异区域。同时，在控制器中启用 DLS 算法（λ=0.01），限制关节速度峰值。

结果：修改后轨迹跟踪误差降至 0.3mm 以内，第 4 关节速度峰值降至 120°/s，焊接质量合格。

复盘：奇异位形问题必须在离线编程阶段识别，单纯依赖在线控制算法会牺牲精度或导致系统失稳。建议在仿真环境中对整条路径进行奇异检测，并设置安全裕度。

3.5 总结与工程实践建议

机械臂建模是连接机械结构与控制算法的桥梁。D-H 参数法提供了标准化的数学描述，连杆坐标系建立是正确建模的前提，雅可比矩阵揭示了关节空间与操作空间的映射关系，而奇异位形分析则是保障控制系统稳定性的关键。在实际工程中，建议遵循以下原则：

• 建模阶段：使用仿真工具（如 MATLAB Robotics Toolbox）验证 D-H 参数的正确性，通过正运动学结果与 CAD 模型对比。
• 控制阶段：实时计算雅可比矩阵的条件数，当条件数超过阈值（如 100）时触发奇异预警。
• 规划阶段：在轨迹规划中集成奇异检测模块，自动调整路径点或插入过渡姿态。
• 调试阶段：利用奇异值分解（SVD）分析雅可比矩阵的零空间，理解末端自由度的缺失方向。