企业官网建设流程全解析

084 运动控制中的坐标系变换：DH参数法

去年调试一台六轴协作机器人，遇到一个诡异的抖动问题。末端执行器走直线轨迹，到某个特定姿态时，关节4和关节5开始高频震颤，像得了帕金森。查了三天，最后发现是坐标系变换矩阵里一个符号写反了——DH参数表中α角的正负号搞反了。这种错误，教科书上不会告诉你，但实际调试中能让你怀疑人生。

为什么DH参数法如此重要

运动控制的核心，说白了就是回答两个问题：电机转多少度，末端能到哪？反过来，末端想去哪，电机该转多少度？这两个问题之间的桥梁，就是坐标系变换。

DH参数法（Denavit-Hartenberg）是建立串联机器人相邻连杆坐标系的标准方法。它用四个参数——θ、d、a、α——就能唯一确定两个坐标系之间的变换关系。这四个参数分别对应：绕Z轴旋转、沿Z轴平移、沿X轴平移、绕X轴旋转。

别小看这四个参数。我见过太多人把DH参数当成死记硬背的公式，结果实际建系时，坐标系原点位置搞错，导致正解算出来末端位置差几厘米。这种问题在仿真里看不出来，一上真机就露馅。

DH参数的核心：四个参数的物理含义

先别急着背矩阵公式。理解这四个参数到底在干什么，比记住矩阵形式重要一百倍。

θ（关节角）：绕当前Z轴旋转的角度。对于旋转关节，这是变量；对于移动关节，这是常量。这里有个容易踩坑的地方：θ的正方向定义。不同机器人厂家对正方向的定义可能不同，有的按右手定则，有的按左手定则。我习惯统一用右手定则，并且在代码里显式注释清楚。

d（连杆偏距）