Robotics · Forward Kinematics
Denavit-Hartenberg参数与正运动学计算器
快速解答
Denavit-Hartenberg(DH)法用四个参数描述每个连杆:扭角 α、连杆长度 a、偏距 d、关节角 θ,由此构造相邻坐标系间的齐次变换矩阵 ⁱ⁻¹Tᵢ。正运动学即其连乘 T_0n = T_01·T_12·…·T_(n−1)n,可直接得到末端位姿。
输入DH参数(α, a, d, θ),计算最多6自由度串联机器人臂的正运动学。内置PUMA/SCARA/UR预设。实时显示末端执行器的位置与姿态。
什么是DH参数与正运动学
🙋
DH参数是什么?听起来好复杂,是给机器人用的吗?
🎓
简单来说,DH参数就像给机器人手臂的每个关节发一张“身份证”。它用四个数字(a, α, d, θ)就能说清楚一个关节怎么转、怎么摆、离上一个关节有多远。比如在模拟器里,你试着拖动PUMA机器人预设的θ1滑块,就能看到第一个关节转动时,整个机器人的姿态和末端位置都跟着实时变化,这就是正运动学在计算。
🙋
诶,真的吗?那这四个数字具体是怎么决定机器人姿势的呢?
🎓
我们可以把机器人想象成用乐高积木搭的。a是这块积木的长度,α是这块积木的扭角,d是两块积木之间的偏移,θ就是关节转动的角度。工程现场常见的是,设计SCARA机器人时,会先设定好前三个参数(a, α, d),然后通过改变θ来控制它抓取东西。你可以在模拟器里切换到SCARA预设,改变θ1或θ2:末端只在水平面内移动,Z始终保持100 mm不变,因为四个关节的α都是0。
🙋
我懂了!那把这些关节的“身份证”信息组合起来,就能算出机器人手爪最后在哪,对吗?
🎓
完全正确!这个过程就是正运动学。我们把每个关节的变换矩阵像连乘一样组合起来,$^{0}T_N = ^{0}T_1 \cdot ^{1}T_2 \cdots ^{N-1}T_N$,最终得到的就是末端相对于机器人底座的位置和姿态。你试着在模拟器里为一个6轴机器人填满所有参数,然后改变任意一个θ,右侧的3D模型和位置坐标都会立刻更新,直观地展示这个计算过程。
物理模型与关键公式
Denavit-Hartenberg (DH) 方法的核心是定义相邻连杆坐标系之间的齐次变换矩阵。这个矩阵完全由四个DH参数决定。本工具采用修正DH约定(Craig),即 $^{i-1}T_i = R_x(\alpha_{i-1})\,T_x(a_{i-1})\,R_z(\theta_i)\,T_z(d_i)$:
$$^{i-1}T_i = \begin{bmatrix}\cos\theta_i & -\sin\theta_i & 0 & a_{i-1} \\
\sin\theta_i \cos\alpha_{i-1} & \cos\theta_i \cos\alpha_{i-1} & -\sin\alpha_{i-1} & -\sin\alpha_{i-1}\, d_i \\
\sin\theta_i \sin\alpha_{i-1} & \cos\theta_i \sin\alpha_{i-1} & \cos\alpha_{i-1} & \cos\alpha_{i-1}\, d_i \\
0 & 0 & 0 & 1
\end{bmatrix}$$
$a_{i-1}$ (连杆长度): 沿 $x_{i-1}$ 轴,从 $z_{i-1}$ 移动到 $z_i$ 的距离。
$\alpha_{i-1}$ (连杆扭角): 绕 $x_{i-1}$ 轴,从 $z_{i-1}$ 旋转到 $z_i$ 的角度。
$d_i$ (连杆偏距): 沿 $z_i$ 轴,从 $x_{i-1}$ 移动到 $x_i$ 的距离。
$\theta_i$ (关节角): 绕 $z_i$ 轴,从 $x_{i-1}$ 旋转到 $x_i$ 的角度(对于旋转关节是变量)。
正运动学通过连续相乘所有连杆变换矩阵,计算出末端执行器相对于基座坐标系的位置和姿态:
$$^{0}T_{tool}= ^{0}T_1 \cdot ^{1}T_2 \cdot ... \cdot ^{n-1}T_n \cdot ^{n}T_{tool}$$
这个最终的 $^{0}T_{tool}$ 是一个4x4矩阵。它的左上角3x3子矩阵是旋转矩阵,描述了末端的姿态;最右边一列的前三个元素是位置向量 $(p_x, p_y, p_z)$,描述了末端的位置。这就是模拟器右侧输出的位置和欧拉角的来源。
现实世界中的应用
工业机器人编程与离线仿真:在汽车焊接、喷涂生产线部署机器人前,工程师会在软件中根据DH参数建立虚拟模型,进行轨迹规划和碰撞检测,确保动作精确无误,避免在实际安装后发生昂贵的事故。
机器人操作系统(ROS)模型定义:ROS中广泛使用的URDF机器人描述文件,其关节和连杆的定义本质上就基于DH参数。本工具的计算逻辑可以帮助理解和验证URDF模型的正运动学是否正确。
多体动力学(MBD)与CAE分析:在进行机器人结构强度、振动或疲劳分析时,需要知道各关节在不同姿势下的载荷。通过DH参数和正运动学可以准确确定载荷施加的边界条件和位置,为有限元分析提供输入。
手术机器人及精密操控:手术机器人等精密设备的控制算法都以运动学模型为基础。由关节编码器读数通过正运动学实时求出工具末端的位置和姿态,是实现精确操控的前提。
常见误解与注意事项
开始使用DH参数时,常常会遇到一些陷阱。首先一个主要的误解是认为“DH参数的定义在全球只有一种”。实际上,存在两种主流的约定:标准DH(Standard DH)和修正DH(Modified DH)。本工具采用修正DH(Craig:$^{i-1}T_i = R_x(\alpha_{i-1})\,T_x(a_{i-1})\,R_z(\theta_i)\,T_z(d_i)$,即上方“理论与主要公式”中的矩阵)。许多教材和厂商手册使用标准DH,直接照抄其表格会得到不同的结果,因此务必养成先确认所用约定的习惯。
其次,关于参数“a”和“α”的符号与方向。人们常认为连杆长度“a”总是正值,但根据坐标系设置方式,它也可能为负。例如,当关节旋转轴方向设置相反时就是如此。另外,扭转角“α”的符号由右手法则决定:拇指指向X轴方向,从Y轴向Z轴旋转的方向为正。如果弄错,机器人可能会像镜像一样做出相反的运动。
最后,作为一个实际注意事项,请留意奇异姿态下的计算结果。当机械臂完全伸直或多个关节轴排列在一条直线上时,即处于“奇异姿态”,数学上姿态可能无法唯一确定。在本工具中可以观察到相关现象:选择PUMA预设,保持θ4=30°,将θ5从89°调到90°再到91°,位置不变,但Roll从−180°跳到−90°再到0°,Yaw从−30°跳到60°再到150°。这是因为Pitch达到±90°时ZYX欧拉角的表示不唯一(万向节死锁)。这是计算上的问题而非工具缺陷,请务必心中有数。
具体计算示例
选择PUMA预设(a₂=432 mm、a₃=20 mm、d₃=149 mm、d₄=433 mm,取自Craig的修正DH表并取整),所有关节角为0°时,工具显示X=452.0 mm、Y=149.0 mm、Z=−433.0 mm,基座到末端距离643.4 mm。可以手算验证:修正DH中a₂与a₃都沿x方向,故X=432+20=452;d₃=149出现在Y,d₄=433出现在−Z;√(452²+149²+433²)=643.4。只将θ₂改为−90°,得到X=433.0、Y=149.0、Z=452.0(上臂竖直),距离仍为643.4 mm。选择UR预设且所有关节为0°时,工具显示X=−817.0、Y=−191.0、Z=−6.0 mm,与UR5公称零位姿态(−817.25, −191.45, −5.49)在取整误差内一致。