1. 从零理解D-H参数机械臂建模的基石刚接触机械臂建模时我总被各种坐标系绕得头晕眼花直到弄明白D-H参数这个坐标系转换说明书。简单来说它就像乐高说明书里的拼接步骤——告诉你每个关节的旋转角度θ和连杆长度d以及相邻关节间的相对位置a和扭转角度α。这四大参数组合起来就能把机械臂每个关节的坐标系像串珍珠一样连起来。实际建模时遇到过这样的场景要给六轴机械臂写运动控制算法但不同厂家的机械臂参数表里有的标标准型D-H参数有的写改进型D-H参数。有次直接混用导致机械臂末端偏移了15cm差点撞到实验设备。后来发现这两种方法在坐标系取向上有本质区别——就像同样描述向左转有人以自身为参照有人以地面标记为参照。2. 标准型D-H参数经典坐标系构建法2.1 第0杆的特殊处理技巧标准型的第0杆坐标系基坐标系建立有个实用口诀能重合就重合。具体操作时我会让Z₀轴与第一个关节轴同向X₀轴则尽量指向第一个运动方向。比如常见的垂直关节型机械臂通常这样处理Z₀轴沿第一关节旋转轴通常是竖直方向X₀轴指向第二关节的延伸方向Y₀轴按右手定则自动确定这种处理方式的优势在于当第一个关节处于零位时末端执行器的位置可以直接用后续关节的变换矩阵计算省去额外的坐标系转换。2.2 连续杆件的坐标系接力规则从第1杆开始标准型的建立规则就像接力赛跑Zᵢ轴永远沿着第i1个关节的旋转/移动方向Xᵢ轴要同时满足两个条件与Zᵢ和Zᵢ₋₁的公垂线重合方向从Zᵢ₋₁指向Zᵢ当两轴平行时Xᵢ轴取与前一坐标系Xᵢ₋₁相同的方向实际建模时有个易错点两关节轴线相交的情况。这时公垂线长度aᵢ0但Xᵢ轴方向仍要按Zᵢ×Zᵢ₋₁的叉积确定。去年调试SCARA机器人时就因为忽略这点导致平面运动轨迹出现Z轴抖动。3. 改进型D-H参数更直观的建模方案3.1 坐标系锚点的变化逻辑改进型最显著的特点是坐标系搬家了——每个坐标系固定在连杆的远端而非近端。这就好比描述房屋位置时标准型是用前门坐标而改进型是用后门坐标。具体差异体现在Zᵢ轴仍沿关节轴方向Xᵢ轴变为Zᵢ和Zᵢ₊₁的公垂线原点设在Zᵢ和Zᵢ₊₁的公垂线交点这种改变带来的直接好处是当需要修改某个连杆参数时只需调整该连杆对应的坐标系不会像标准型那样产生连锁反应。在开发可重构机械臂时这个特性让我们的参数维护工作量减少了40%。3.2 参数物理意义的转变四参数的含义在改进型中发生了微妙变化aᵢ连杆长度现在是Zᵢ到Zᵢ₊₁沿Xᵢ的距离αᵢ扭转角Zᵢ到Zᵢ₊₁绕Xᵢ的旋转角度dᵢ偏置距离Xᵢ₋₁到Xᵢ沿Zᵢ的距离θᵢ关节角Xᵢ₋₁到Xᵢ绕Zᵢ的旋转角度这种定义方式使得相邻关节间的关系更直观。最近给协作机械臂做碰撞检测时用改进型参数可以直接把安全距离约束转化为对aᵢ和dᵢ的限制条件比标准型少一次坐标系转换。4. 两种方法的实战对比六轴机械臂建模案例4.1 UR5机械臂的标准型建模以UR5机械臂为例其标准型参数表如下关节θ(°)d(mm)a(mm)α(°)1q189.20902q20-42503q30-39204q4109.30905q594.750-906q682.500建立坐标系时要注意关节1的Z₀垂直向上X₀水平向前关节2的Z₁与Z₀垂直X₁沿Z₀×Z₁方向关节3的Z₂与Z₁平行X₂继续沿相同方向4.2 同一机械臂的改进型建模同样的UR5改用改进型时参数表变为关节θ(°)d(mm)a(mm)α(°)1q100902q2-89.2-42503q30-39204q400905q5-109.30-906q6-94.7500最明显的变化是d参数迁移到了下一行这是因为坐标系定义位置不同导致的。实际验证时两种方法得到的末端位置矩阵完全一致但改进型的正向运动学计算量更少。5. 选择依据何时用标准型何时用改进型经过多个项目实践我总结出这样的选择指南标准型更适合教学演示和理论分析经典教材多用此法串联型机械臂如传统工业机械臂需要与现有系统保持参数兼容的情况改进型更推荐用于树状或并联结构机械臂需要频繁修改连杆参数的研发场景实时性要求高的运动控制计算量减少约15%有个容易忽略的细节某些运动规划库如ROS的MoveIt内部使用特定类型的参数如果选错类型会导致轨迹规划异常。去年就遇到过将改进型参数误输入标准型解析器导致机械臂运动中出现抽搐的情况。
机器人学D-H参数详解：标准型与改进型的坐标系构建差异及机械臂建模实践
1. 从零理解D-H参数机械臂建模的基石刚接触机械臂建模时我总被各种坐标系绕得头晕眼花直到弄明白D-H参数这个坐标系转换说明书。简单来说它就像乐高说明书里的拼接步骤——告诉你每个关节的旋转角度θ和连杆长度d以及相邻关节间的相对位置a和扭转角度α。这四大参数组合起来就能把机械臂每个关节的坐标系像串珍珠一样连起来。实际建模时遇到过这样的场景要给六轴机械臂写运动控制算法但不同厂家的机械臂参数表里有的标标准型D-H参数有的写改进型D-H参数。有次直接混用导致机械臂末端偏移了15cm差点撞到实验设备。后来发现这两种方法在坐标系取向上有本质区别——就像同样描述向左转有人以自身为参照有人以地面标记为参照。2. 标准型D-H参数经典坐标系构建法2.1 第0杆的特殊处理技巧标准型的第0杆坐标系基坐标系建立有个实用口诀能重合就重合。具体操作时我会让Z₀轴与第一个关节轴同向X₀轴则尽量指向第一个运动方向。比如常见的垂直关节型机械臂通常这样处理Z₀轴沿第一关节旋转轴通常是竖直方向X₀轴指向第二关节的延伸方向Y₀轴按右手定则自动确定这种处理方式的优势在于当第一个关节处于零位时末端执行器的位置可以直接用后续关节的变换矩阵计算省去额外的坐标系转换。2.2 连续杆件的坐标系接力规则从第1杆开始标准型的建立规则就像接力赛跑Zᵢ轴永远沿着第i1个关节的旋转/移动方向Xᵢ轴要同时满足两个条件与Zᵢ和Zᵢ₋₁的公垂线重合方向从Zᵢ₋₁指向Zᵢ当两轴平行时Xᵢ轴取与前一坐标系Xᵢ₋₁相同的方向实际建模时有个易错点两关节轴线相交的情况。这时公垂线长度aᵢ0但Xᵢ轴方向仍要按Zᵢ×Zᵢ₋₁的叉积确定。去年调试SCARA机器人时就因为忽略这点导致平面运动轨迹出现Z轴抖动。3. 改进型D-H参数更直观的建模方案3.1 坐标系锚点的变化逻辑改进型最显著的特点是坐标系搬家了——每个坐标系固定在连杆的远端而非近端。这就好比描述房屋位置时标准型是用前门坐标而改进型是用后门坐标。具体差异体现在Zᵢ轴仍沿关节轴方向Xᵢ轴变为Zᵢ和Zᵢ₊₁的公垂线原点设在Zᵢ和Zᵢ₊₁的公垂线交点这种改变带来的直接好处是当需要修改某个连杆参数时只需调整该连杆对应的坐标系不会像标准型那样产生连锁反应。在开发可重构机械臂时这个特性让我们的参数维护工作量减少了40%。3.2 参数物理意义的转变四参数的含义在改进型中发生了微妙变化aᵢ连杆长度现在是Zᵢ到Zᵢ₊₁沿Xᵢ的距离αᵢ扭转角Zᵢ到Zᵢ₊₁绕Xᵢ的旋转角度dᵢ偏置距离Xᵢ₋₁到Xᵢ沿Zᵢ的距离θᵢ关节角Xᵢ₋₁到Xᵢ绕Zᵢ的旋转角度这种定义方式使得相邻关节间的关系更直观。最近给协作机械臂做碰撞检测时用改进型参数可以直接把安全距离约束转化为对aᵢ和dᵢ的限制条件比标准型少一次坐标系转换。4. 两种方法的实战对比六轴机械臂建模案例4.1 UR5机械臂的标准型建模以UR5机械臂为例其标准型参数表如下关节θ(°)d(mm)a(mm)α(°)1q189.20902q20-42503q30-39204q4109.30905q594.750-906q682.500建立坐标系时要注意关节1的Z₀垂直向上X₀水平向前关节2的Z₁与Z₀垂直X₁沿Z₀×Z₁方向关节3的Z₂与Z₁平行X₂继续沿相同方向4.2 同一机械臂的改进型建模同样的UR5改用改进型时参数表变为关节θ(°)d(mm)a(mm)α(°)1q100902q2-89.2-42503q30-39204q400905q5-109.30-906q6-94.7500最明显的变化是d参数迁移到了下一行这是因为坐标系定义位置不同导致的。实际验证时两种方法得到的末端位置矩阵完全一致但改进型的正向运动学计算量更少。5. 选择依据何时用标准型何时用改进型经过多个项目实践我总结出这样的选择指南标准型更适合教学演示和理论分析经典教材多用此法串联型机械臂如传统工业机械臂需要与现有系统保持参数兼容的情况改进型更推荐用于树状或并联结构机械臂需要频繁修改连杆参数的研发场景实时性要求高的运动控制计算量减少约15%有个容易忽略的细节某些运动规划库如ROS的MoveIt内部使用特定类型的参数如果选错类型会导致轨迹规划异常。去年就遇到过将改进型参数误输入标准型解析器导致机械臂运动中出现抽搐的情况。
