当前位置：首页 > news >正文

【机器人学】从DH参数到末端位姿：正运动学建模与计算全解析

news 2026/5/27 9:04:26

1. 正运动学基础概念

刚接触机器人学时，我经常被各种坐标系和变换矩阵搞得晕头转向。直到真正动手计算了几次机械臂的正运动学问题，才发现这套理论其实非常直观。正运动学（Forward Kinematics）要解决的核心问题是：已知机器人各个关节的参数，如何确定末端执行器在三维空间中的位置和姿态。

想象你手里拿着一个多节棍玩具，每节棍子之间通过关节连接。如果你知道每个关节转了多少角度，理论上就能算出棍子末端的位置。机器人学中的正运动学就是这个原理的数学表达。

在机器人学中，我们常用齐次变换矩阵来描述坐标系之间的相对关系。这个4×4的矩阵不仅能表示旋转，还能表示平移。我第一次看到这个矩阵时觉得它很复杂，但拆开来看其实很简单：

左上角3×3的子矩阵表示旋转
右上角3×1的列向量表示平移
最后一行固定为[0 0 0 1]

举个例子，假设机械臂的基座坐标系为{0}，末端坐标系为{n}，那么从基座到末端的变换可以表示为：

0Tn = 0T1 * 1T2 * ... * n-1Tn

这个链式乘法正是正运动学计算的核心。我第一次实现这个公式时，因为矩阵乘法顺序搞反而得到了完全错误的结果，后来才明白变换矩阵的乘法顺序要从右往左看。

2. DH参数建模详解

2.1 DH参数的定义与物理意义

Denavit-Hartenberg（DH）参数法是机器人学中最经典的运动学建模方法。记得我第一次用DH参数给六轴机械臂建模时，花了整整一个下午才把各个参数标定正确。DH参数用四个量来描述相邻连杆之间的关系：

连杆长度(a)：沿着X轴，从当前Z轴移动到下一个Z轴的距离
连杆转角(α)：绕着X轴，从当前Z轴旋转到下一个Z轴的角度
连杆偏距(d)：沿着Z轴，从当前X轴移动到下一个X轴的距离
关节角(θ)：绕着Z轴，从当前X轴旋转到下一个X轴的角度

这四个参数中，对于旋转关节来说θ是变量，其他三个是常量；对于平移关节来说d是变量，其他三个是常量。我在实验室调试UR5机械臂时，发现它的DH参数表是这样的：

关节	θ(°)	d(mm)	a(mm)	α(°)
1	θ1	89.2	0	90
2	θ2	0	425	0
3	θ3	0	392	0
4	θ4	109.3	0	90
5	θ5	94.75	0	-90
6	θ6	82.5	0	0

2.2 改进DH参数法

传统DH参数法在处理某些特殊构型时会出现问题，Craig提出了改进的DH参数法。两者的主要区别在于坐标系附着方式和参数定义顺序。改进DH法的变换矩阵计算顺序是：

i-1Ti = RX(αi-1) * DX(ai-1) * RZ(θi) * DZ(di)

其中RX表示绕X轴旋转，DX表示沿X轴平移。我在MATLAB中实现这个变换时，最初因为旋转和平移的顺序搞错，导致机械臂仿真出现严重偏差。正确的变换矩阵应该是：

[cθ -sθ 0 a; sθ*cα cθ*cα -sα -sα*d; sθ*sα cθ*sα cα cα*d; 0 0 0 1]

3. 正运动学计算实战

3.1 六轴机械臂实例分析

让我们以一个典型的六轴工业机械臂为例，演示完整的正运动学计算流程。假设机械臂的DH参数如下表所示：

连杆	θ	d	a	α
1	θ1	d1	0	π/2
2	θ2	0	a2	0
3	θ3	0	a3	0
4	θ4	d4	0	π/2
5	θ5	0	0	-π/2
6	θ6	d6	0	0

计算过程分为以下步骤：

为每个连杆建立坐标系，确保Z轴沿关节轴线方向
根据DH参数表填写四个参数
计算每个相邻连杆的变换矩阵i-1Ti
将所有的变换矩阵按顺序相乘得到末端位姿

在实际项目中，我通常会用符号计算工具（如MATLAB的Symbolic Math Toolbox）来保持计算的精确性。例如，前三个连杆的变换矩阵可以这样计算：

syms theta1 theta2 theta3 d1 a2 a3 real % 连杆1的变换矩阵 T01 = [cos(theta1) 0 sin(theta1) 0; sin(theta1) 0 -cos(theta1) 0; 0 1 0 d1; 0 0 0 1]; % 连杆2的变换矩阵 T12 = [cos(theta2) -sin(theta2) 0 a2*cos(theta2); sin(theta2) cos(theta2) 0 a2*sin(theta2); 0 0 1 0; 0 0 0 1];

3.2 使用MATLAB机器人工具箱验证

Peter Corke的机器人工具箱可以大大简化我们的工作。以下是如何用工具箱建立这个六轴机械臂模型：

% 定义DH参数 L(1) = Link([0 d1 0 pi/2 0], 'modified'); L(2) = Link([0 0 a2 0 0], 'modified'); L(3) = Link([0 0 a3 0 0], 'modified'); L(4) = Link([0 d4 0 pi/2 0], 'modified'); L(5) = Link([0 0 0 -pi/2 0], 'modified'); L(6) = Link([0 d6 0 0 0], 'modified'); % 创建机械臂模型 robot = SerialLink(L, 'name', '6-DOF Arm'); % 指定关节角度 q = [pi/4 pi/6 pi/3 pi/2 -pi/4 0]; % 计算正运动学 T = robot.fkine(q) % 可视化 robot.plot(q);

这个工具箱不仅能够计算正运动学，还能进行可视化验证。我第一次使用时，发现自己的手工计算结果与工具箱输出有微小差异，后来发现是因为忽略了旋转顺序的重要性。

4. 常见问题与调试技巧

4.1 DH参数标定的常见错误

在多年的工程实践中，我总结了几个DH参数标定时容易犯的错误：

坐标系方向定义错误：Z轴必须沿着关节轴线方向，X轴沿公共法线方向。我曾经因为把Z轴方向搞反，导致整个运动学计算完全错误。
参数符号错误：连杆转角α和连杆偏距d的符号很容易搞混。一个简单的记忆方法是：从当前Z轴看向下一个Z轴，顺时针旋转时α为正。
基准面对齐问题：在定义基坐标系和末端坐标系时，需要确保初始状态下的对齐方式与实际机械结构一致。有次项目因为基准面定义错误，导致末端执行器的姿态计算总是偏差90度。