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

别再被Craig的《机器人学导论》搞晕了！一文讲透MDH与SDH参数建模的核心差异

news 2026/5/6 20:14:27

机器人学入门避坑指南：MDH与SDH参数建模的本质差异与实战应用

第一次翻开Craig的《机器人学导论》时，我被第3章那个六轴机械臂的坐标变换图困住了整整三天。明明按照书上的步骤推导，为什么MATLAB里算出的末端位置总是差了几厘米？直到我发现教材使用的MDH（Modified DH）参数和网上OpenRAVE教程里的SDH（Standard DH）参数根本不是一回事——这个认知让我既崩溃又兴奋。本文将从实际工程视角，解剖这两种建模方法的基因级差异，帮你避开这个让无数机器人初学者栽跟头的"参数陷阱"。

1. 坐标系战争：SDH与MDH的建模哲学之争

在机器人运动学中，坐标系就像语言的语法规则。SDH和MDH本质是两种不同的"语法体系"，它们对同一个机械结构的描述方式存在根本性差异。理解这一点，需要先破除一个常见误解：不存在所谓"更正确"的DH参数，只有"更适合特定场景"的建模选择。

1.1 坐标系锚点：远端的SDH vs 近端的MDH

"为什么我的URDF文件导入MoveIt后机械臂姿态全乱了？"——这个问题背后往往藏着坐标系锚点的认知偏差：

**SDH（标准DH）**采用"远端附着"原则：

# 典型SDH坐标系定义（以i关节为例） z_axis = joint_axis[i] # Z轴沿关节轴线 x_axis = cross(z_axis[i-1], z_axis[i]) # X轴为前后Z轴公垂线 origin = joint_position[i] # 坐标系原点在关节远端

**MDH（改进DH）**则坚持"近端附着"策略：

# 典型MDH坐标系定义（以i关节为例） z_axis = joint_axis[i] # Z轴仍沿关节轴线 x_axis = cross(z_axis[i], z_axis[i+1]) # X轴变为当前与下一Z轴公垂线 origin = joint_position[i-1] # 坐标系原点在连杆近端

这种差异直接导致参数表的变化。以PUMA560机器人为例：

参数类型	SDH顺序	MDH顺序	物理意义对比
旋转参数	θ_i	θ_i	关节转角相同
偏移参数	d_i	d_i	关节偏移相同
连杆长度	a_i	a_{i-1}	MDH使用前一连杆长度
扭转角	α_i	α_{i-1}	MDH使用前一连杆扭转角

1.2 X轴定向规则：历史债还是工程优化？

SDH的X轴确定规则源自1955年Denavit和Hartenberg的原始论文，其核心是当前关节与前一关节的关系。而MDH在1986年由Craig引入时，改为当前关节与后一关节的关系。这种改变绝非随意：

SDH在闭链结构中会引发歧义：当机器人存在分支或闭环时，同一个关节可能对应多个"前一关节"
MDH的递推特性更适合现代算法：ROS的tf2库、MATLAB Robotics Toolbox都默认采用MDH格式
工业机器人领域的隐藏规则：Fanuc、KUKA等厂商的控制器内部多使用MDH参数

实践提示：在Gazebo中加载URDF模型时，若发现关节旋转方向相反，首先检查<axis>标签是否与MDH的Z轴定义一致。

2. 参数迷宫：从理论公式到代码实现

翻开任何一本机器人学教材，DH参数表都像某种神秘符文。让我们用Python代码和具体数值拆解这个"黑箱"。

2.1 四参数的本质解构

DH参数的四个变量其实对应着机械设计的四个基本约束：

θ（关节角）：旋转关节的变量参数
d（连杆偏移）：移动关节的变量参数
a（连杆长度）：两关节轴线的最短距离
α（连杆扭转）：两关节轴线的夹角

用NumPy实现变换矩阵时，两种方法的差异显而易见：

# SDH变换矩阵实现 def sdh_transform(theta, d, a, alpha): ct, st = np.cos(theta), np.sin(theta) ca, sa = np.cos(alpha), 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] ]) # MDH变换矩阵实现（注意参数顺序和乘法顺序变化） def mdh_transform(alpha, a, theta, d): ct, st = np.cos(theta), np.sin(theta) ca, sa = np.cos(alpha), np.sin(alpha) return np.array([ [ct, -st, 0, a], [st*ca, ct*ca, -sa, -sa*d], [st*sa, ct*sa, ca, ca*d], [0, 0, 0, 1] ])

2.2 工业机器人参数对照实战

以SCARA机器人为例，对比两种表示法的参数差异：

关节	SDH参数 (θ,d,a,α)	MDH参数 (α,a,θ,d)	物理含义
J1	θ1, d1, 0, 0	0, 0, θ1, d1	基座旋转
J2	θ2, 0, L1, 0	0, L1, θ2, 0	肩关节
J3	0, d3, L2, 0	0, L2, 0, d3	肘关节
J4	θ4, d4, 0, 0	0, 0, θ4, d4	腕关节

当使用ROS的MoveIt配置该机器人时，若误将SDH参数直接填入MDH格式的URDF文件，会导致：

运动学解算器计算出错
碰撞检测失效
轨迹规划异常

3. 工程抉择：何时该用哪种DH表示法

在2010年代后期，机器人学界曾有过一场关于DH参数标准化的争论。最终实践表明，没有放之四海而皆准的黄金法则，但有明确的场景选择指南：

3.1 优先选择SDH的场景

教学演示：SDH的直观性更适合初学者理解
传统工业机器人：Stäubli、早期ABB机型使用SDH
简单开链结构：如3DOF平面机械臂

3.2 必须使用MDH的情况

树状结构机器人：如波士顿动力的Atlas双足机器人
闭链机构：并联机器人、Delta机械臂
现代算法框架：ROS MoveIt、OMPL规划库
协作机器人：UR、Franka Emika全系列

3.3 转换方法论：参数迁移公式

遇到需要转换的情况时，使用以下映射关系（i表示连杆序号）：

SDH参数	→ MDH参数转换公式
θ_i	θ_i (保持不变)
d_i	d_i (保持不变)
a_i	a_{i-1}
α_i	α_{i-1}

def sdh_to_mdh(sdh_params): """将SDH参数转换为MDH参数""" mdh_params = [] mdh_params.append([0, 0, sdh_params[0][0], sdh_params[0][1]]) # 第一连杆特殊处理 for i in range(1, len(sdh_params)): mdh_params.append([ sdh_params[i-1][3], # α_{i-1} sdh_params[i-1][2], # a_{i-1} sdh_params[i][0], # θ_i sdh_params[i][1] # d_i ]) return mdh_params

4. 前沿演进：超越DH的建模新范式

虽然DH参数统治了机器人学半个世纪，但新一代建模方法正在崛起：

4.1 指数积公式（PoE）的挑战

优势：无需繁琐的坐标系定义
典型应用：现代协作机器人标定
对比实验：在7DOF机械臂上，PoE标定精度比DH高0.2mm

4.2 双连杆参数法的工业实践

核心思想：每个关节关联两个坐标系
采用厂商：安川电机最新一代控制器
兼容方案：通过中间转换矩阵与DH参数互操作

在ROS2的robot_state_publisher中，已经可以看到这两种方法的融合实现：

// 现代ROS2中的混合表示示例 void publishTransforms() { // DH参数用于基础描述 vector<DHParam> dh_chain = parseURDF(); // PoE用于动态误差补偿 vector<PoETwist> poe_corrections = loadCalibration(); // 最终发布优化后的tf树 publishTF(combineModels(dh_chain, poe_corrections)); }