机器人 / 系统课时

辨认标准 DH 与改进 DH 的差异

辨认标准 DH 与改进 DH 的差异

同一台机器人可以使用标准 DH 或改进 DH 建立正运动学模型,但两种约定的坐标系放置位置、变换顺序和参数索引并不相同。本课通过关节轴对比、矩阵公式和数值实验,学会辨认已有参数表的约定,并避免混用造成的末端位姿错误。

学习目标

  • 根据关节轴编号和坐标系放置方式,区分标准 DH 与 Craig 改进 DH。
  • 正确写出两种约定的单节齐次变换矩阵及参数索引。
  • 通过数值实验和检查步骤,识别直接混用 DH 参数表产生的错误。

从关节轴辨认坐标系约定

DH 参数法使用四个参数描述相邻连杆坐标系之间的刚体变换:关节角 θ\theta、沿关节轴的偏移 dd、连杆长度 aa 和连杆扭角 α\alpha。

标准 DH(Standard DH,简称 SDH)与 Craig 改进 DH(Modified DH,简称 MDH)都使用这些物理量,但坐标系编号与变换分组不同。这里采用机器人学中常见的 Craig 改进 DH 定义。

检查项 标准 DH Craig 改进 DH
第 ii 个关节的运动轴 zi−1z_{i-1} ziz_i
相邻关节轴之间的公法线 沿 xix_i 沿 xi−1x_{i-1}
连杆长度和扭角在第 ii 段变换中的索引 ai,αia_i,\alpha_i ai−1,αi−1a_{i-1},\alpha_{i-1}
关节角与轴向偏移 θi,di\theta_i,d_i θi,di\theta_i,d_i
单节变换的操作分组 先绕、沿 zz,再沿、绕 xx 先沿、绕 xx,再绕、沿 zz

例如,同一台具有 J1、J2 两个旋转关节的机械臂,标准 DH 将 J1 的运动轴记为 z0z_0、J2 的运动轴记为 z1z_1;Craig 改进 DH 则分别记为 z1z_1 和 z2z_2。两套编号必须与各自的参数表一起使用。

标准 DH 与 Craig 改进 DH 的关节轴编号、坐标系位置和变换顺序对比

对照两种齐次变换的乘法顺序

规定采用列向量表示坐标,i−1Ti^{i-1}T_i 表示将第 ii 坐标系中的点变换到第 i−1i-1 坐标系。RzR_z、RxR_x 表示绕指定轴旋转,TzT_z、TxT_x 表示沿指定轴平移。

标准 DH 的单节变换为:

i−1TiSDH=Rz(θi)Tz(di)Tx(ai)Rx(αi)^{i-1}T_i^{\mathrm{SDH}}=R_z(\theta_i)T_z(d_i)T_x(a_i)R_x(\alpha_i)

其操作序列为:

  1. 绕当前 zz 轴旋转 θi\theta_i。
  2. 沿当前 zz 轴平移 did_i。
  3. 沿变换后的 xx 轴平移 aia_i。
  4. 绕该 xx 轴旋转 αi\alpha_i。

Craig 改进 DH 的单节变换为:

i−1TiMDH=Tx(ai−1)Rx(αi−1)Rz(θi)Tz(di)^{i-1}T_i^{\mathrm{MDH}}=T_x(a_{i-1})R_x(\alpha_{i-1})R_z(\theta_i)T_z(d_i)

其操作序列为:

  1. 沿前一坐标系的 xx 轴平移 ai−1a_{i-1}。
  2. 绕该 xx 轴旋转 αi−1\alpha_{i-1}。
  3. 绕变换后的 zz 轴旋转 θi\theta_i。
  4. 沿该 zz 轴平移 did_i。

这里的顺序描述的是逐步建立中间坐标系的过程;采用列向量矩阵乘法时,最右侧矩阵首先作用于被变换的点。不要将矩阵乘积的书写顺序直接理解为对固定世界坐标轴执行操作的时间顺序。

绕同一轴旋转与沿该轴平移可以交换次序,例如 Rz(θ)Tz(d)=Tz(d)Rz(θ)R_z(\theta)T_z(d)=T_z(d)R_z(\theta)。但一般不能交换绕 zz 轴的旋转与沿 xx 轴的平移,因为旋转会改变平移方向。

用数值实验复现参数混用错误

假设某段变换的参数数值为:

参数 数值
θ\theta 90∘90^\circ
dd 0.2 m0.2\ \mathrm{m}
aa 0.5 m0.5\ \mathrm{m}
α\alpha 0∘0^\circ

标准 DH 中将长度 0.50.5 米沿旋转后的 xx 轴平移,因此得到位置 (0,0.5,0.2)(0,0.5,0.2) 米。改进 DH 中先沿原来的 xx 轴平移,因此直接套用相同数值会得到 (0.5,0,0.2)(0.5,0,0.2) 米。

下面使用 Python 3 标准库复现这一差异。由于 α=0\alpha=0,绕 xx 轴的旋转是单位矩阵,可以省略。

python
from math import cos, sin, pi


def matmul(a, b):
    return [
        [sum(a[r][k] * b[k][c] for k in range(4))
         for c in range(4)]
        for r in range(4)
    ]


def rot_z(theta):
    c, s = cos(theta), sin(theta)
    return [[c, -s, 0, 0], [s, c, 0, 0],
            [0, 0, 1, 0], [0, 0, 0, 1]]


def trans_x(a):
    return [[1, 0, 0, a], [0, 1, 0, 0],
            [0, 0, 1, 0], [0, 0, 0, 1]]


def trans_z(d):
    return [[1, 0, 0, 0], [0, 1, 0, 0],
            [0, 0, 1, d], [0, 0, 0, 1]]


# 刻意复用相同数值,观察错误混用的后果
angle, length, offset = pi / 2, 0.5, 0.2
sdh = matmul(matmul(rot_z(angle), trans_z(offset)),
             trans_x(length))
mdh = matmul(matmul(trans_x(length), rot_z(angle)),
             trans_z(offset))


# 齐次变换矩阵最后一列的前三项就是原点位置
def position(t):
    return tuple(round(t[i][3], 3) for i in range(3))


print("SDH:", position(sdh))
print("MDH:", position(mdh))

预期输出:

text
SDH: (0.0, 0.5, 0.2)
MDH: (0.5, 0.0, 0.2)

两种计算得到的旋转部分相同,但平移列不同,位置误差达到约 0.7070.707 米。这说明即使旋转角度和连杆长度的数值看起来合理,直接将标准 DH 参数交给改进 DH 公式也可能得到错误的位置。

校验已有 DH 参数表是否能够正确使用

接收机器人说明书、论文或程序中的 DH 参数表时,建议按以下顺序检查。

  1. 确认公式:查看单节变换究竟采用 RzTzTxRxR_zT_zT_xR_x 还是 TxRxRzTzT_xR_xR_zT_z,不要只看文档是否写了 DH。
  2. 核对关节轴:逐个标出实际关节 J1、J2、J3 的转轴,检查第 ii 关节在标准 DH 中是否对应 zi−1z_{i-1},在 Craig 改进 DH 中是否对应 ziz_i。
  3. 检查变量与索引:旋转关节通常由 θi\theta_i 随关节位置变化,移动关节通常由 did_i 变化。还要检查零位偏置、正方向以及 aa、α\alpha 的下标定义。
  4. 检查基座与工具变换:确认参数表是否已经包含固定的基座安装偏移和末端工具偏移,避免漏乘或重复乘这些矩阵。
  5. 验证两个姿态:选取全部关节为约定零位的姿态,以及一个非零关节姿态,例如第一关节旋转 90∘90^\circ。分别计算末端位置和姿态,并与机器人几何图、已知标定结果或可信模型比较。

对于具有 nn 个关节的串联机器人,如果每节矩阵都按照同一约定建立,那么连乘关系为:

0Tn=0T1 1T2⋯n−1Tn{}^0T_n={}^0T_1\,{}^1T_2\cdots{}^{n-1}T_n

这里的相邻坐标系必须确实对应,不能将标准 DH 的部分矩阵与改进 DH 的部分矩阵直接拼接。两种方法可以通过明确的坐标变换桥接,但不是替换某几列参数就能完成转换。

如果模型在零位正确、转动后却出现位置偏差,应重点检查旋转与平移的先后顺序;如果所有姿态均存在固定偏移,应检查基座或工具变换;如果只有个别关节运动方向错误,应检查关节轴正方向及零位偏置。

实际项目中,应随 DH 参数表明确记录采用的约定、关节轴编号、长度单位、角度单位和零位定义。没有这些信息的四列数字不足以可靠重建机器人的正运动学模型。

按自己的节奏,确认真正理解。

目录与阅读设置

阅读设置

17

记录一个想法

辨认标准 DH 与改进 DH 的差异

0 / 10000 · 笔记保存到账号。未提交的修改会在关闭、离开或刷新后丢失。

登录哪都通