DH建模入门:从坐标系到变换矩阵的机械臂运动学基础
1. 机器人建模的第一步,为什么偏偏是DH
做机器人这行,不管是搞运动学、动力学、轨迹规划还是标定,绕不开的第一个坎就是DH建模。哪怕你只是想在仿真环境里搭一个机械臂模型,也得先把DH参数表填明白。我见过不少刚入门的同学,抱着教材啃了两三天,坐标系画了一整页纸,最后还是搞不清楚theta、d、a、alpha这四个参数到底对应哪条轴、哪个旋转。
说白了,DH建模就是一套“给机器人骨架做坐标系标定”的规则。它把机械臂每个关节、每根连杆之间的相对位置关系,浓缩成一张参数表。只要你按照这套规则把表填出来,机械臂末端在空间里怎么动、手爪在哪个位置、朝哪个方向,全都可以用矩阵算出来。这才是它牛的地方:一套规则,统一描述所有串联机械臂,不管你是两自由度的教学平台,还是六自由度的工业臂,通通适用。
这篇文章不是复述教材,而是按照我自己从零开始搭建机械臂模型时,踩坑踩出来的实操路线来写的。内容包括DH参数到底代表什么、标准DH和修正DH怎么选、坐标系怎么建立、变换矩阵怎么乘、以及新手最容易出错的地方。适合正在学机器人学、准备做毕设或者刚入职做机器人相关开发的读者。
2. DH建模的核心逻辑:为什么四个参数就能描述连杆关系
2.1 刚体的六个自由度,为什么DH只用四个参数
先回到最基础的问题。在三维空间里,一个刚体相对另一个刚体,完整的位置和姿态需要六个独立参数来表示:三个平移量(x、y、z)和三个旋转量(通常用欧拉角或者旋转矩阵表示)。那为什么DH模型只需要四个参数?
因为机械臂的每个关节本身就约束掉了两个自由度。你想象一下,转动关节只能让下一个连杆绕着关节轴线转,移动关节只能让下一个连杆沿着轴线滑动。在描述相邻两个连杆的位姿变化时,剩下那些"被机械结构锁死"的自由度,不需要你专门去描述,它们是固定不变的。
具体到DH参数,四个参数的完整含义是:
| 参数 | 含义 | 物理意义 |
|---|---|---|
| d | 杆件偏移量 | 沿着前一个关节z轴方向的平移距离 |
| theta | 关节角 | 绕着前一个关节z轴方向的旋转角度 |
| a | 杆长 | 沿着公垂线方向,两个关节轴线之间的距离 |
| alpha | 扭转角 | 绕着公垂线方向,两个关节轴线之间的夹角 |
一眼看过去,两个平移加两个旋转,刚好就压缩了原本六个自由度的描述。这里有个理解上的关键点:d和theta描述的是相邻坐标系之间的基本运动,而a和alpha描述的是连杆本身的几何属性。换句话说,如果机器人结构定了,a和alpha基本不变;关节一转动,变的只有theta。
2.2 公垂线是理解DH的钥匙
不少新手卡在DH参数上,其实不是数学不行,而是没搞明白"公垂线"这个东西。
相邻两个关节的轴线,在三维空间里一般是两条不平行也不相交的直线。几何学里有个结论:两条异面直线之间,有且仅有一条公垂线,也就是既垂直于第一条直线,又垂直于第二条直线的线段。这条线段的长度就是两轴之间的最短距离,这个距离就是DH里的a。同时,这两条轴线之间的夹角,投影到垂直于公垂线的平面上,对应的角度就是alpha。
我平时给同事讲的时候,喜欢用一个"楼层电梯"的类比。两个关节轴线分别是两个楼层的平面,公垂线相当于连通的电梯井。a就是两台电梯之间的水平距离,d就是你上下移动的垂直高度,theta是你在这一层转身的角度,alpha则是整层楼相对于另一层楼的倾斜程度。这么一想,四个参数就不难理解了。
2.3 前一个参数决定后一个参数:DH的递推思想
DH建模还有个很容易被忽略的点:它本质上是一种递推思想。每个关节的坐标系定义,都是参考前一个坐标系来完成的。千万不要试图单独把第i个坐标系拎出来凭空定义,它一定是"从第i-1个坐标系出发,按照DH规则一步步走过去的"。
具体走法是这样的(以标准DH为例):
- 从坐标系i-1出发,先绕自己的z轴转一个角度theta_i;
- 再沿着自己的z轴平移一个距离d_i;
- 然后沿着新得到的x轴方向平移一个距离a_i;
- 最后绕新的x轴转一个角度alpha_i。
这四步操作连起来,就完成了坐标系i-1到坐标系i的变换。记住,这个顺序不能乱,每一步都要以前一步的结果为基础。很多新手混淆标准DH和修正DH,原因就是这两套规则的操作顺序不一样,后面专门讲。
3. 标准DH与修正DH:一字之差,坐标系变换顺序完全不同
3.1 标准DH和修正DH的差异对比
DH模型在发展过程中出现了两个版本。早期大家在书里最常见的是标准DH,也叫SDH,由Denavit和Hartenberg在1955年提出。后来为了处理树状结构和闭链机构,又发展出了修正DH,也叫MDH。这两者最核心的区别在于,坐标系固定在哪个位置、以及坐标变换的执行顺序。
标准DH的变换顺序是:theta -> d -> a -> alpha。坐标系i固连在连杆i的远端,也就是关节i+1的位置。举例子,你在标准DH下描述关节2的运动,参考的是坐标系1的z轴,先把坐标系1转theta2、再沿z平移d2、沿x平移a2、绕x转alpha2。
修正DH的变换顺序是:alpha -> a -> theta -> d,也就是先转alpha、再沿x平移a、然后转theta、最后沿z平移d。坐标系i固连在连杆i的近端,也就是关节i本身的位置。
这也带来了一个很实际的问题:同一个机械臂,用标准DH和修正DH填出来的表,数字是会不一样的。尤其是d和a的归属关系会变。你要是拿着标准DH的表格直接套修正DH的矩阵公式去算,结果必定是错的。
| 对比项 | 标准DH (SDH) | 修正DH (MDH) |
|---|---|---|
| 变换顺序 | theta, d, a, alpha | alpha, a, theta, d |
| 坐标系固定位置 | 连杆远端(关节i+1处) | 连杆近端(关节i处) |
| 适用机构 | 串联链式结构最方便 | 树状结构、闭链结构更优 |
| 坐标系建立难度 | 对新手略友好 | 规则更统一,但需注意x轴定义 |
3.2 选哪个?我的建议
说完区别,说说怎么选。如果你做的是最常见的串联机械臂,比如六轴工业机械臂、教学用的五轴平台、两轴云台,标准DH完全够用,资料多、公式顺手、工具链成熟。如果你做的是并联机器人、人形机器人这种存在闭链或者分叉的结构,建议用修正DH,因为它可以把每个关节的坐标系统一建立在关节轴线上,处理分支时更方便。
我个人的习惯是:先看参考文献。如果手头的机械臂厂家说明或者开源模型仓库用的是什么DH,就跟着用哪种。混用是最痛苦的,因为后期你调试的时候,可能要对照好几份资料,坐标定义一旦不一致,排查问题会非常难受。
3.3 判断自己该补哪种DH知识
新手不用两头都精通,先把标准DH练熟、把坐标系建立和矩阵链乘搞透彻,再去碰修正DH,就不容易乱。我见过有同学直接上手修正DH,结果因为x轴方向定义规则混乱,一个简单的两连杆模型推导了三天还没推对。反过来,标准DH树立了直观的空间感之后,再切换成修正DH,只是换了一套变换顺序,底层逻辑通通一样,上手的成本很低。
4. 坐标系建立的实操规则:照着做,才不会出错
4.1 坐标系建立五步法
DH建模最让人头疼的就是坐标系怎么放。这里我总结了一套五步法,照着做基本能避开大部分坑。
- 找出所有关节轴线,画出机械臂的侧视图或简化骨架图,标出每个关节的旋转方向;
- 从基座开始,先确定z轴。转动关节的z轴沿关节旋转轴线方向,移动关节的z轴沿移动方向;
- 确定x轴。标准DH规则里,x_i是坐标系i-1的z轴和坐标系i的z轴的公垂线方向,从关节i-1指向关节i;
- 确定y轴。用右手定则,y = z × x,保证坐标系是右手系;
- 检查所有的x轴方向和z轴方向,确认没有歧义,然后填DH参数表。
这五步里,第3步最需要仔细。如果相邻两个z轴平行,公垂线就不唯一了,此时通常选择前一个关节指向后一个关节的方向为x轴;如果相邻两个z轴相交,则x轴方向取两个z轴的叉乘方向。这些特殊情况,教材里讲得比较简略,实际做的时候遇到一次就明白了。
4.2 基座坐标系怎么放
基座坐标系(坐标系0)的放置有一个常用技巧:让坐标系0在机械臂零位时,与坐标系1完全重合。这样做能让第一个DH参数里的d和a变成简单的常数,甚至可能是0,计算会方便很多。
注意,这不违反DH规则。DH建模只约束相邻坐标系的相对关系,所以坐标系0怎么摆,理论上不影响最终的末端位姿计算结果。既然如此,选一个最好算的方式就是最优的。
4.3 末端坐标系怎么处理
最后一个关节之后还有工具坐标系,严格来说它不属于DH链的范畴。DH参数表只建模到最后一个关节坐标系(坐标系n),工具坐标系是从坐标系n再额外做一次固定变换得到的。这个固定变换可以用一个独立的齐次矩阵表示,通常是沿着工具方向平移一个已知距离。
实战里,很多新手把所有东西都塞进DH表里,在最后一个关节后面硬造一个坐标系n+1,结果这个坐标系和关节n的z轴之间公垂线都找不到,参数填不出来。正确做法是:DH表只管到关节链,工具变换单独列。
4.4 实操中的"零位"约定
填DH参数表之前,必须先确定机械臂的零位姿态。同一个机械臂,如果零位定义不同,theta参数的初始值就不一样。工业机械臂通常有一个机械零位,也就是每个关节都有一个角度参考原点。仿真模型里,你完全可以自定义零位,比如让机械臂完全竖直伸展是零位。
关键在于,DH参数表必须和这个零位定义一致。哪怕你的theta初始值不是0,只要表格里的各项参数能正确描述零位姿态下的空间关系,后面算出来的都是对的。我见过有同学在仿真里给关节加了90度的初始偏置,但是忘了在DH参数表里体现这个偏置,结果末端位置算出来和实际对不上。
5. 从DH参数到齐次变换矩阵:照着抄就能用的计算方法
5.1 标准DH的通式
有了DH参数表,下一步就是把每一个关节的变换矩阵写出来。标准DH的通式是这样的:
A_i = Rot(z, theta_i) * Trans(z, d_i) * Trans(x, a_i) * Rot(x, alpha_i)
展开成4x4齐次矩阵之后,长这样:
| cos(theta) -sin(theta)*cos(alpha) sin(theta)*sin(alpha) a*cos(theta) |
| sin(theta) cos(theta)*cos(alpha) -cos(theta)*sin(alpha) a*sin(theta) |
| 0 sin(alpha) cos(alpha) d |
| 0 0 0 1 |
有的教材矩阵第三行的写法略有不同,是因为alpha的符号或旋转方向定义不同,本质上等价。如果你用的是修正DH,通式要换成先alpha后a再theta最后d的变换顺序,不要搞混。
5.2 两个关键的验证方法
矩阵写完之后,怎么知道没写错?最直接的验证方法有两个。
第一个方法,代入特殊角度。把theta取成0度,alpha取成0度,代入矩阵,你会发现它退化成一个非常简单的平移矩阵:沿x轴平移a,沿z轴平移d。如果代进去得到的矩阵不符合这个直观结果,说明公式出问题了。
第二个方法,在仿真环境里验证。现在很多开源机器人工具箱或者自研的运动学库都可以快速搭建机械臂模型。你先把DH参数表填进去,让模型动起来,再手动用坐标变换算同一个末端点,两者对比,误差在浮点精度范围内就是对的。
5.3 正运动学就是矩阵连乘
有了单个关节的变换矩阵,整条机械臂的正运动学就是把它们按顺序乘起来。
T_n^0 = A_1 * A_2 * ... * A_n
这里的顺序是严格的从左到右,不能颠倒。A_1把基座坐标系变换到坐标系1,A_2把坐标系1变换到坐标系2,依次类推。最后得到的T_n^0就是末端坐标系在基座坐标系下的位姿描述。
用代码表示的话:
import numpy as np
def dh_matrix(theta, d, a, alpha):
ct = np.cos(theta)
st = np.sin(theta)
ca = np.cos(alpha)
sa = np.sin(alpha)
return np.array([
[ct, -st*ca, st*sa, a*ct],
[st, ct*ca, -ct*sa, a*st],
[0, sa, ca, d],
[0, 0, 0, 1]
])
# 例:两连杆平面机械臂
T1 = dh_matrix(np.deg2rad(30), 0, 1.0, 0)
T2 = dh_matrix(np.deg2rad(-45), 0, 0.8, 0)
T_end = T1 @ T2
print(T_end)
这段代码我反复用过很多次,简单直接。注意
np.deg2rad
别忘了,我曾经见过有人直接在theta那里填角度制数值,导致所有cos和sin的结果全是错的。
5.4 用一个两连杆机械臂完整推一遍
拿最简单的两连杆平面机械臂举例,两根杆长分别为L1和L2,两个关节都是旋转关节。零位状态下,两臂完全平展,关节角分别为theta1和theta2。
DH参数表如下:
| 关节 | theta | d | a | alpha |
|---|---|---|---|---|
| 1 | theta1 | 0 | L1 | 0 |
| 2 | theta2 | 0 | L2 | 0 |
因为两关节轴线平行,所以alpha全是0。代入通式之后,末端位置是:
x = L1*cos(theta1) + L2*cos(theta1+theta2)
y = L1*sin(theta1) + L2*sin(theta1+theta2)
你要是回忆一下高中物理里那个经典的两连杆正解公式,和这个结果一模一样。这说明DH参数表建对了。
我当时第一次手动推算这个结果的时候,印象很深:绕了那么大一圈矩阵变换,回到最基础的三角函数关系上,说明整套逻辑是自洽的。对于更复杂的机械臂,你没法一眼看出结果,只能靠矩阵算,但验证思路是一样的——先简化成已知特例,再推广到一般情况。
5.5 常用工具箱怎么用
实操里手写矩阵未免太慢。我用过的几类工具,各有优缺点:
- 某开源机器人工具箱:可以快速定义SerialLink,填DH表后直接调用正运动学函数,适合验证算法。缺点是自定义坐标系时灵活性一般。
- 自写Python脚本:自由度最高,适合研究特殊构型,但调试时间也长。
- 商业仿真软件:建模直观,适合做整机仿真和离线编程,但DH参数要手动输入,校验环节不能省。
不管用哪个工具,都要在拿到末端位姿之后回溯检查一遍:先转一个较简单的关节角,比如让所有theta为0,对比仿真观察的位姿和计算结果是否一致。
6. 协同仿真与模型验证:光会算还不行,要建立闭环校验
6.1 仿真验证是DH建模的照妖镜
理论推导做得再漂亮,不放进仿真里跑一遍,永远不知道哪里出了问题。我自己的习惯是:DH表建完后,先在仿真平台里搭一个"零位状态"的模型,把每个关节依次单独转动,观察末端的运动轨迹是否合理。这个步骤很基础,但能筛选出大量低级错误。
比如一个关节绕z轴旋转,末端却出现了沿x方向的大幅位移,那多半是a或者alpha填错了。如果末端轨迹忽上忽下不稳定,可能是相邻关节的z轴方向定反了。
具体操作流程:
- 在仿真环境里导入或搭建机械臂模型,保持所有关节角度为0;
- 手动给关节1一个固定角度,看末端位置是否在你的预期范围内,例如只绕竖直轴旋转;
- 恢复零位,再给关节2一个固定角度,观察平移或旋转方向;
- 逐关节排查,确认所有关节的运动方向和DH参数定义的旋转方向一致。
这一步做完,才算把“模型建对了”这件事落实。
6.2 数值验证和几何验证双管齐下
数值验证就是拿正运动学算出的坐标和仿真读数对比。这个方法虽然有效,但需要排除坐标系对齐的干扰因素:仿真模型的基座坐标系和DH模型的基座坐标系必须定义成同一个方向。
几何验证则是靠肉眼和空间想象力。比如让机械臂末端沿着一条直线运动,你观察它经过的空间点是否真的在一条线上。这在验证轨迹规划算法时尤为常用,因为在直线插补过程中,每一步逆解出来的关节角变化应该是平滑的,如果DH参数出错,逆解结果会频繁跳到不合理的区间。
6.3 不确定时怎么办:一个逆向检查的小技巧
我遇到过不少情况:DH表检查了好几遍,参数看起来都对,但末端位置总是差一点。这时候有一个很有用的"逆向检查"技巧:取一组合适的关节角,先由正运动学算出末端位姿;然后把末端位姿反代回几何关系式,画出末端点在垂直于工作平面的投影图,看看是否符合机械臂的实际运动范围。
如果投影图上的点落在机械臂物理上根本够不到的区域,说明DH参数定义的关节范围或连杆长度和结构不一致。这个方法不依赖复杂的标定工具,用纸笔画一画就能发现很多隐蔽的问题。
7. 新手最容易踩的六个坑:每一条都是实测经验
7.1 把标准DH和修正DH的矩阵用混了
两类DH的矩阵通式长得非常像,很多同学看资料时没注意版本,抄了一个公式就往代码里塞。填的参数表是标准DH的顺序,用的计算却按修正DH的矩阵来,算出来结果刚好对不上。怎么避免?准备一个小抄,把自己的参数版本和矩阵通式对应起来,贴在代码文件头部。
7.2 关节角单位搞混
代码里角度制还是弧度制,是最常见的翻车现场。我自己就踩过:在脚本里写theta=30,心里想的是30度,但三角函数库默认是弧度,结果整个轨迹全乱套。建议在项目里统一使用弧度制,并在函数入口处做一次强制转换。
7.3 忽略了关节偏置(零点偏差)
机械臂的每个关节都有机械零点,如果你用的DH参数是从某份现成资料抄来的,而那个资料的零点定义和你实际设备不一致,那你的theta值要额外加一个偏置量。这个偏置不是DH参数本身的内容,但它直接影响theta的实际输入。
检查方法:把机械臂摆到零点位姿,记录每个关节编码器读数,如果读数不为0,那这些非零值就是你的初始偏置。
7.4 公垂线方向选反
两个邻接关节轴线的公垂线本来有两个方向,很多新手随意选了一个,结果alpha的正负号或者x轴方向就跟后续参数对不上了。我建议在图上标清楚"从关节i到关节i+1"的方向,让定义的x轴始终沿着坐标变换的推进方向,就不容易搞反。
7.5 末端工具坐标系混进了DH表
前面说了,DH表只建到关节链末尾,工具坐标变换要单独写。如果混在一起,基于DH的逆解算法会非常混乱,因为你等于凭空多了一个自由度约束,而且那个坐标系的定义往往不符合关节结构。
7.6 数组角标从0还是从1开始
代码习惯不同,有的人用0-index,有的人用1-index。DH表填到代码里时,经常出现数组错位的情况。比如关节2的theta填进了关节1的位置,导致所有计算往后错一格。解决方法是给每个关节参数加上明确的注释,命名用
theta_1, theta_2
这种带下标的变量名,少用
theta[0], theta[1]
这类容易混淆的写法。
8. 一个完整的六轴机械臂DH建模实例
8.1 实例背景与参数表
整个建模流程需要一个完整案例来串起来。我以一个常见的六轴串联机械臂为例,做一个不带工具坐标的简化版DH表。这个实例基于常见的六轴结构,各关节均为转动关节。
| 关节i | theta_i | d_i (mm) | a_i (mm) | alpha_i (deg) |
|---|---|---|---|---|
| 1 | theta1 | 350 | 50 | -90 |
| 2 | theta2 | 0 | 400 | 0 |
| 3 | theta3 | 0 | 120 | -90 |
| 4 | theta4 | 360 | 0 | 90 |
| 5 | theta5 | 0 | 0 | -90 |
| 6 | theta6 | 100 | 0 | 0 |
注意,这里的alpha出现了正负90度的情况,说明相邻关节轴线的夹角是90度且绕公垂线方向有正反之分。这类表格在工业机械臂里非常典型。
8.2 逐步计算过程
我把第一组参数代入标准DH通式,theta1=0度时,矩阵变成:
| 1 0 0 50 |
| 0 0 1 0 |
| 0 -1 0 350 |
| 0 0 0 1 |
这个矩阵的含义是:从坐标系0到坐标系1,先沿x平移50mm,再沿z平移350mm,同时坐标系方向发生了一次90度的偏转。因为alpha=-90度,导致坐标系绕x轴转了-90度,z轴方向变成了竖直方向,y轴方向发生了翻转。
把六个关节矩阵依次乘起来,就能得到末端位姿。这里的计算量很大,手算不现实,通常交给代码处理。但如果你只取某几个特定的关节角,比如把所有theta都取0,那每个矩阵都退化成简单形式,可以逐个人工核对,这也是验证整个链条的有效手段。
8.3 从DH到逆运动学的地基
正运动学搞定之后,逆运动学的解法思路就有基础了。对于六轴机械臂,很多解法都是基于DH参数表做解析推导的。比如常见的分离变量法,就是把末端位姿矩阵的某些元素提取出来,通过矩阵等式约束反解关节角。
如果你的DH参数表本身有问题,后面所有逆解算法都会跟着错。所以我的建议永远是:地基阶段多花时间,能省后面十倍调试时间。
9. 从DH建模还能延伸到哪些地方
DH建模不只是正运动学的地基。它搭好之后,很多进阶方向都跟它有关联。
一个是速度层面的雅可比矩阵。雅可比矩阵描述了关节速度到末端笛卡尔速度的映射,它的推导完全依赖DH坐标系的定义。每一列对应一个关节的旋转速度在末端坐标系下的表达,实际上是从DH参数和当前关节角推导出来的。没有清晰的DH坐标系,雅可比矩阵很难推导正确。
另一个是动力学建模。虽然现在动力学建模经常用拉格朗日法或牛顿-欧拉递推法,但惯性张量、连杆质心位置这些参数都是相对于连杆坐标系定义的,连杆坐标系怎么来的?还是从DH参数来的。所以DH建得越标准,后面做动力学参数辨识就越顺畅。
还有是标定。机器人出厂之后,DH参数的实际值和理论值往往有细微偏差,需要用标定算法反推实际DH参数。这个过程的数学模型和误差分析都建立在DH建模的基础上。我见过不少做标定的工程师,最头疼的就是坐标系定义不统一导致的参数耦合问题。
所以,花两周把DH建模吃透,后面的路会顺畅很多。我在实际项目里,最深的体会就是:机器人算法出问题,十有七八不是算法本身有问题,而是底层的DH坐标系或者参数表出了问题。把这个地基打牢,无论做轨迹规划、动力学控制还是视觉伺服,你都会轻松许多。最后再分享一个小窍门:每建完一个机械臂模型,别急着往下走,先花半小时把每个关节单独动一遍,观察末端轨迹是否符合直觉。这半小时,能给你换回后面无数的调试时间。
更多推荐
所有评论(0)