机械臂运动学：改进D-H参数法与工程实践

1. 机械臂运动学基础概念

机械臂的运动学分析是机器人控制领域的核心基础，而关节空间与变换的定义则是运动学建模的关键环节。在实际工程项目中，我们经常需要精确描述机械臂各连杆之间的相对位置和姿态关系，这就需要建立规范化的数学表达体系。

改进型D-H参数法（Modified Denavit-Hartenberg）是目前最常用的机械臂建模方法之一。与传统D-H法相比，它在参数定义和坐标系分配上做了优化，使得建模过程更加直观且不易出错。我经手过的六轴工业机器人项目中，约80%都采用这种建模方式。

重要提示：改进D-H法在相邻坐标系定义时，要求Z轴必须与关节轴线重合，这直接影响到后续正逆运动学的计算准确性。新手常犯的错误就是坐标系方向定义不一致。

2. 改进D-H参数详解

2.1 参数定义规则

改进D-H法用四个参数描述相邻连杆间的几何关系：

1. 连杆长度aᵢ：沿Xᵢ轴，从Zᵢ-1到Zᵢ的距离
2. 连杆转角αᵢ：绕Xᵢ轴，从Zᵢ-1旋转到Zᵢ的角度
3. 关节偏距dᵢ：沿Zᵢ-1轴，从Xᵢ-1到Xᵢ的距离
4. 关节角度θᵢ：绕Zᵢ-1轴，从Xᵢ-1旋转到Xᵢ的角度

对于旋转关节，θᵢ是变量；对于平移关节，dᵢ是变量。我在ABB IRB 120机器人的建模中就遇到过第三个关节是平移关节的特殊情况，这时需要特别注意参数定义顺序。

2.2 坐标系建立步骤

1. 确定所有关节轴线方向（Z轴）
2. 确定各坐标系原点：
   • 对于相交轴：原点在交点
   • 对于平行轴：原点使公垂线距离最小
3. X轴沿相邻Z轴的公垂线方向
4. Y轴按右手定则确定

实际操作中，我习惯先用SolidWorks等CAD软件导出各关节的轴线方程，再根据上述规则在MATLAB中建立坐标系。这种方法比纯手工计算更不容易出错。

3. 变换矩阵的推导与计算

3.1 齐次变换矩阵构成

相邻连杆间的变换矩阵ⁱ⁻¹Tᵢ可分解为四个基本变换的乘积：
ⁱ⁻¹Tᵢ = Rot(Z,θᵢ) * Trans(Z,dᵢ) * Trans(X,aᵢ) * Rot(X,αᵢ)

展开后的齐次变换矩阵为：

code复制[ cosθᵢ    -sinθᵢcosαᵢ     sinθᵢsinαᵢ     aᵢcosθᵢ ]
[ sinθᵢ     cosθᵢcos