1. 从零开始为什么串联机器人建模绕不开DH参数法如果你刚接触机器人学或者正在用Matlab做机器人相关的毕设、项目大概率会听到一个词DH参数法。这几乎是所有串联机器人运动学建模的“标准答案”就像学微积分绕不开牛顿-莱布尼茨公式一样。但很多人只是机械地记住了DH表的四个参数连杆长度a、连杆转角α、连杆偏距d、关节角θ然后对着公式硬套结果要么是模型动不起来要么是正运动学算出来的位姿和实际对不上最后只能对着Matlab里一堆报错的代码干瞪眼。我刚开始做机器人仿真的时候也踩过这个坑。当时导师扔给我一个六轴机械臂的图纸让我在Matlab里把它的运动模型建出来。我心想这不就是套公式嘛简单。结果光是确定每个关节的坐标系原点就折腾了我整整两天。更别提后来发现不同教材、不同机器人厂商对DH参数的定义还有“标准DH”和“改进DH”之分直接把我给整懵了。后来在项目里反复折腾才算是把这里面的门道摸清楚了。今天我就以一个过来人的身份跟你聊聊怎么在Matlab里用DH参数法给串联机器人建模并且一次就把它搞对。简单来说DH参数法是一套“约定俗成”的规则它用四个参数就能清晰地描述出机器人相邻两个连杆之间的空间关系。它的核心价值在于标准化和可计算性。通过这套规则我们可以把复杂的、三维空间中的机械结构转化成一个整齐的表格DH表和一系列齐次变换矩阵。在Matlab里我们就能利用这些矩阵轻松地计算机械臂末端执行器比如夹爪、焊枪相对于基座的位置和姿态这就是正运动学。反过来如果知道了末端想要到达的位置和姿态去反推每个关节需要转动的角度这就是逆运动学。而这一切的起点就是建立一个正确无误的DH模型。所以这篇文章适合所有需要用Matlab进行机器人仿真、算法开发或者仅仅是完成课程作业的朋友。无论你是想验证自己设计的机械臂结构是否合理还是为后续的轨迹规划、控制算法提供一个精确的“数字孪生”模型一个正确的DH模型都是你必须迈过去的第一道坎。接下来我会手把手带你走完从理解原理、建立参数表到在Matlab中实现和验证的完整流程并分享几个我踩过的大坑和避坑技巧。2. 庖丁解牛彻底搞懂DH参数法的“潜规则”与两种惯例在动手写代码之前我们必须把理论基础打牢。DH参数法的核心思想是在机器人的每个连杆上“安装”一个坐标系然后用四个参数来描述相邻两个坐标系之间的变换关系。听起来简单但魔鬼藏在细节里。最大的 confusion 往往来自于坐标系到底应该怎么装参数到底按什么顺序来2.1 坐标系建立的“黄金法则”给串联机器人的每个连杆建立坐标系遵循一套固定的步骤。这里以最常用的标准DH参数法为例确定关节轴Z轴第 i 个关节的旋转或移动轴线就是连杆 i 的 Z 轴记为 Z_i。对于旋转关节Z轴就是关节的旋转轴对于移动关节 prismatic jointZ轴就是关节的移动方向。确定坐标系原点O_i原点 O_i 是 Z_i 轴和 Z_{i-1} 轴的公垂线common perpendicular与 Z_i 轴的交点。如果两轴平行则公垂线有无数条通常选择使连杆偏距 d_i 为0的那一条。如果两轴相交则原点就是交点。确定X轴X_iX_i 轴的方向沿 Z_{i-1} 轴和 Z_i 轴的公垂线由 Z_{i-1} 轴指向 Z_i 轴。确定Y轴Y_i根据右手定则由 Z_i 轴和 X_i 轴确定 Y_i 轴Y_i Z_i × X_i。这套规则必须严格执行不能凭感觉乱放。一个常见的错误是把坐标系原点直接放在关节的物理中心上这对于某些特定结构的关节比如两个旋转关节轴线相交于一点是成立的但对于大多数情况尤其是轴线异面的情况就会导致后续的变换矩阵出错。2.2 四个参数的物理意义与“标准DH”流程坐标系建好后从坐标系 {i-1} 变换到坐标系 {i}可以通过以下四个有序的变换来实现对应四个DH参数绕 Z_{i-1} 轴旋转 θ_i 角将 X_{i-1} 轴旋转到与 X_i 轴平行的方向。θ_i 是关节变量对于旋转关节它是变化的对于移动关节它是固定的。沿 Z_{i-1} 轴平移 d_i将原点 O_{i-1} 移动到 O_i 在 Z_{i-1} 轴上的投影点。d_i 是连杆偏距。沿 X_i 轴平移 a_i将原点移动到 O_i 点。a_i 是连杆长度即从 Z_{i-1} 轴到 Z_i 轴沿 X_i 轴方向的距离。绕 X_i 轴旋转 α_i 角将 Z_{i-1} 轴旋转到与 Z_i 轴平行的方向。α_i 是连杆转角即从 Z_{i-1} 轴到 Z_i 轴绕 X_i 轴旋转的角度。记住这个顺序旋转θ → 平移d → 平移a → 旋转α。每一步变换都对应一个齐次变换矩阵连乘起来就得到了从 {i-1} 到 {i} 的总变换矩阵A_i。A_i Rot(z, θ_i) * Trans(z, d_i) * Trans(x, a_i) * Rot(x, α_i)把这个矩阵写开就是教科书上那个经典的DH变换矩阵。在Matlab里我们不需要手动输入这个矩阵的每一个元素后面会用到现成的函数来生成它。2.3 “标准DH” vs “改进DH”你必须做的选择题这是新手最容易栽跟头的地方。除了上面讲的标准DHStandard DH还有一种广泛使用的改进DHModified DH也叫Craig版本。它们的主要区别在于坐标系附着在连杆的位置不同标准DH本文主要采用坐标系 {i} 固连在连杆 i 的远端靠近关节 i1 的一端。参数a_i和α_i描述了连杆 i 本身的几何形状。改进DH坐标系 {i} 固连在连杆 i 的近端靠近关节 i 的一端。参数a_{i-1}和α_{i-1}描述了连杆 i-1 的几何形状。为什么会有两种改进DH在描述树状结构或闭链机器人时更清晰且其变换矩阵连乘顺序从基座到末端更直观。而标准DH在传统工业机器人教材中更常见。怎么选注意绝对不要混用一旦你为某个机器人选择了其中一种惯例所有的参数定义、坐标系建立、变换矩阵计算都必须遵循这一种。通常你参考的机器人数据手册或论文会指明它用的是哪种。如果没指明你可以根据变换矩阵的连乘顺序来判断或者选择一种并始终坚持。在Matlab的Robotics System Toolbox中两种都支持但创建机器人对象时需要明确指定。我个人的经验是对于大多数教科书上的经典六轴串联机械臂如PUMA560标准DH资料更多更容易上手。在本文的后续Matlab实操中我们将使用标准DH。3. 实战演练以经典六轴机械臂为例构建DH参数表理论说再多不如动手算一遍。我们以一个简化版的经典六轴旋转关节机械臂为例来推导它的DH参数表。假设它的结构类似于PUMA560但尺寸简化以便理解。我们的目标是得到下面这张表连杆 iθ_i (变量)d_ia_iα_i1θ1L10-90°2θ20L203θ30L3-90°4θ4L4090°5θ500-90°6θ6L600注L1, L2, L3, L4, L6为具体的长度值例如可以设为0.5, 0.4, 0.3, 0.2, 0.1 (米)。3.1 步骤一分析机械臂结构草图首先你需要一张机械臂的示意图或三维模型。明确以下几点所有关节都是旋转关节Revolute Joint。关节1基座关节绕垂直轴Z0旋转。关节2和关节3的轴线平行。关节4、5、6的轴线相交于一点腕部中心点。3.2 步骤二按标准DH规则建立坐标系我们从基座{0}开始一步步建立到末端工具坐标系{6}。坐标系 {0}固定在基座上。Z0沿关节1的旋转轴垂直向上。通常将原点O0放在基座中心X0方向任意一般向前根据右手定则确定Y0。坐标系 {1}Z1轴沿关节2的旋转轴假设水平向前。原点O1是Z0和Z1公垂线与Z1的交点。因为Z0垂直Z1水平公垂线就是它们之间最短的垂直线段。这个线段的长度就是d1 L1基座高度。X1轴沿Z0到Z1的公垂线方向由Z0指向Z1水平向前。此时从{0}到{1}需要绕Z0转θ1再沿Z0平移d1L1就使Z0与Z1共线但原点还差一截。接着沿X1平移a1但此时Z0和Z1已经相交了吗不它们异面。实际上平移a1是沿着X1轴移动但在这个例子中经过旋转和平移d后原点O0已经移动到O1在Z0上的投影点而O1在X1轴上。因为Z0和Z1是垂直异面公垂线就是X1本身所以从投影点到O1的距离就是a1 0。最后需要绕X1轴旋转使Z0与Z1同向。Z0原来是垂直的要变成水平的Z1需要绕X1轴旋转α1 -90°(顺时针90度)。坐标系 {2}Z2轴沿关节3的旋转轴与Z1平行水平向前。原点O2是Z1和Z2公垂线与Z2的交点。因为Z1和Z2平行公垂线是它们之间最短的连线。这段距离就是a2 L2大臂长度。X2轴沿Z1到Z2的公垂线方向。因为两轴平行方向可以选为从Z1指向Z2水平向前与X1同向或反向这里需要根据实际几何判断通常向前。从{1}到{2}绕Z1转θ2沿Z1平移d20因为原点O1已经在公垂线与Z1的交点沿X2平移a2L2绕X2旋转α20因为Z1和Z2平行。坐标系 {3}Z3轴沿关节4的旋转轴假设水平与Z2垂直。原点O3是Z2和Z3公垂线与Z3的交点。这段公垂线长度是a3 L3小臂长度。X3轴沿Z2到Z3的公垂线方向。从{2}到{3}绕Z2转θ3沿Z2平移d30沿X3平移a3L3绕X3旋转α3-90°使水平的Z2变为水平的Z3但方向垂直了所以需要转90度具体符号根据右手定则判断。坐标系 {4}, {5}, {6}腕部三个关节轴线相交于一点腕部中心。这意味着从坐标系{3}的原点O3到腕部中心点需要沿Z3平移d4 L4。然后因为后续关节轴线相交a4, a5, a6 都为0。α4, α5, α6 则描述腕部轴线之间的夹角通常为90°或-90°。具体参数如上面表格所示。这个过程需要极强的空间想象力。一个极其重要的技巧是画图在纸上或绘图软件里把每个坐标系的三根轴清清楚楚地画出来标上XYZ和原点O。这是确保参数正确的唯一可靠方法。3.3 步骤三填写DH参数表并复核将上面分析得到的参数整理成表。填写时务必检查对于旋转关节θ是变量用θ1, θ2...表示d是常数。对于移动关节d是变量θ是常数。a和α总是常数描述连杆的固定几何形状。符号旋转角α和θ遵循右手定则拇指指向旋转轴正方向四指弯曲方向为正。4. 在Matlab中“复活”你的机器人模型参数表有了我们就可以在Matlab里把它变成一个可以驱动、可以计算的模型了。这里主要依赖Robotics System Toolbox它是Matlab中机器人学的“瑞士军刀”。如果你没有这个工具箱需要额外安装。4.1 环境准备与工具箱核心函数简介首先在Matlab命令窗口输入ver查看是否已安装‘Robotics System Toolbox’。如果没有需要通过Matlab的“附加功能”管理器安装。这个工具箱提供了两种主要的机器人对象表示方式rigidBodyTree更现代、更灵活的表示支持标准DH和改进DH是官方推荐的方式。SerialLink(通过Robotics Toolbox Peter Corke版本)一个非常流行且强大的第三方工具箱语法更简洁。但Matlab官方已不再维护其内置的类似功能更推荐使用rigidBodyTree。不过Peter Corke的Toolbox仍然被广泛使用。为了覆盖更广我先介绍官方的rigidBodyTree方法。4.2 使用 rigidBodyTree 构建机器人对象我们按照前面得到的DH表来创建机器人。% 清除工作区关闭所有图形 clear; close all; clc; % 1. 创建空的刚性体树对象 robot rigidBodyTree(DataFormat, row); % row 表示使用行向量表示变换更常见 % 2. 定义连杆的几何参数单位米 L1 0.5; L2 0.4; L3 0.3; L4 0.2; L6 0.1; % 3. 创建第一个连杆Base to Joint1 % 注意基座‘world’是默认存在的。第一个物体是连接在基座上的。 body1 rigidBody(body1); joint1 rigidBodyJoint(joint1, revolute); % 旋转关节 % 设置关节的DH参数使用标准DH惯例 % setFixedTransform(joint, dhparams, dh) 其中dhparams [a alpha d theta] % 注意这里的theta对应的是关节变量在创建时先设为0后续通过关节位置控制。 dhparams1 [0, -pi/2, L1, 0]; % [a1, alpha1, d1, theta1] setFixedTransform(joint1, dhparams1, dh); body1.Joint joint1; addBody(robot, body1, base); % 将body1添加到基座上 % 4. 创建第二个连杆 (Body1 to Body2) body2 rigidBody(body2); joint2 rigidBodyJoint(joint2, revolute); dhparams2 [L2, 0, 0, 0]; % [a2, alpha2, d2, theta2] setFixedTransform(joint2, dhparams2, dh); body2.Joint joint2; addBody(robot, body2, body1); % 将body2连接到body1上 % 5. 创建第三个连杆 (Body2 to Body3) body3 rigidBody(body3); joint3 rigidBodyJoint(joint3, revolute); dhparams3 [L3, -pi/2, 0, 0]; % [a3, alpha3, d3, theta3] setFixedTransform(joint3, dhparams3, dh); body3.Joint joint3; addBody(robot, body3, body2); % 6. 创建第四、五、六个连杆腕部 body4 rigidBody(body4); joint4 rigidBodyJoint(joint4, revolute); dhparams4 [0, pi/2, L4, 0]; % [a4, alpha4, d4, theta4] setFixedTransform(joint4, dhparams4, dh); body4.Joint joint4; addBody(robot, body4, body3); body5 rigidBody(body5); joint5 rigidBodyJoint(joint5, revolute); dhparams5 [0, -pi/2, 0, 0]; % [a5, alpha5, d5, theta5] setFixedTransform(joint5, dhparams5, dh); body5.Joint joint5; addBody(robot, body5, body4); % 末端执行器通常作为一个没有关节的固定连杆 body6 rigidBody(tool); joint6 rigidBodyJoint(fix6, fixed); % 固定关节将工具固定到body5 % 从body5的坐标系到工具坐标系还有一个偏移 d6 dhparams6 [0, 0, L6, 0]; % [a6, alpha6, d6, theta6] setFixedTransform(joint6, dhparams6, dh); body6.Joint joint6; addBody(robot, body6, body5); % 7. 显示机器人详细信息 showdetails(robot)运行showdetails(robot)你会看到机器人每个关节的类型、父物体、子物体以及变换关系这是验证模型结构是否正确的重要一步。4.3 可视化与正运动学验证模型建好了我们让它动起来看看。% 8. 可视化机器人初始状态所有关节角为0 figure(Name, Robot Visualization, Position, [100 100 800 600]); show(robot); title(六轴机械臂模型 (初始零位)); xlabel(X (m)); ylabel(Y (m)); zlabel(Z (m)); view(135, 30); % 设置一个较好的观察视角 grid on; axis equal; % 9. 正运动学计算示例给定一组关节角度计算末端位姿 config [pi/6, -pi/4, pi/3, -pi/6, pi/2, 0]; % 六个关节的角度 [θ1, θ2, θ3, θ4, θ5, θ6] % 注意config的顺序必须和添加body的顺序一致即对应关节1到关节6。 % 设置机器人到这个构型 robot.DataFormat row; % 确保数据格式 config deg2rad([30, -45, 60, -30, 90, 0]); % 也可以用角度制但记得转换 % 获取正运动学变换矩阵 tform getTransform(robot, config, tool); % ‘tool’是我们定义的末端执行器名称 disp(末端执行器相对于基座的变换矩阵 T_0_tool:); disp(tform); % 从变换矩阵中提取位置和欧拉角 position tform(1:3, 4); % 位置向量 orientation tform(1:3, 1:3); % 旋转矩阵 % 将旋转矩阵转换为ZYX欧拉角更直观 eulZYX rotm2eul(orientation, ZYX); disp([末端位置: [, num2str(position), ] m]); disp([末端姿态(ZYX欧拉角): [, num2str(rad2deg(eulZYX)), ] deg]); % 10. 可视化这个特定构型 figure; show(robot, config); title([机器人构型: θ [, num2str(rad2deg(config)), ] deg]); view(135, 30); grid on; axis equal;如果一切正确你将看到机械臂从一个“折叠”的初始状态运动到你指定关节角度的姿态。getTransform函数计算出的变换矩阵T_0_tool就是通过我们输入的DH参数和关节角度一步步从基座坐标系{0}变换到工具坐标系{tool}的结果。这就是正运动学的核心。5. 避坑指南与进阶思考从“能用”到“好用”把模型跑通只是第一步。在实际项目中你会遇到更多问题。下面是我总结的几个关键点和进阶方向。5.1 常见错误排查清单如果你的模型报错或者运动姿态很奇怪请按以下顺序检查DH参数表错误这是最最常见的问题。反复对照第二节的规则检查每个坐标系的Z轴方向、原点位置、X轴方向。特别是α角的符号很容易搞反。一个快速验证的方法是令所有关节角为0看看机器人的初始姿态是否符合你的预期比如是否站立、手臂是否向前伸展。如果初始姿态就歪了肯定是DH参数错了。Matlab代码中的参数顺序setFixedTransform(joint, dhparams, dh)中的dhparams向量顺序是[a, alpha, d, theta]。千万注意这个顺序和你教科书上常见的[theta, d, a, alpha]或[d, theta, a, alpha]可能不同一定要看Matlab官方文档。本文使用的顺序是[a, alpha, d, theta]。“标准DH”与“改进DH”混淆在setFixedTransform中第三个参数指定了惯例。我们用的是dh代表标准DH。如果你参考的模型是改进DH则需要使用mdh并且输入的参数意义完全不同。再次强调不要混用关节类型设置错误旋转关节是revolute移动关节是prismatic。如果设错后续控制会出问题。单位不一致DH参数中的长度单位a, d要一致通常用米(m)。角度单位在输入函数时Matlab默认使用弧度(rad)。如果你习惯用度(deg)记得用deg2rad()函数转换。末端执行器定义我们通常关心工具末端点TCP的位姿。在上面的代码中我们通过一个固定的连杆body6和固定关节‘fix6’来定义了一个工具坐标系它距离最后一个运动关节body5的关节有一个d6L6的偏移。确保这个偏移是你想要的TCP位置。5.2 模型验证与已知模型或实物对比如何确信你的模型是正确的有几个方法与经典模型对比比如PUMA560机器人有公开的、经过验证的DH参数。你可以用你的代码实现PUMA560然后让机器人移动到某个特定姿态如所有关节为0看末端位置是否与文献中一致。正逆运动学互验这是最有力的验证。编写逆运动学算法或使用工具箱的inverseKinematics函数对正运动学计算出的一个末端位姿进行逆解得到的关节角再代回正运动学看是否能回到原来的位姿允许微小误差。轨迹验证让末端走一个简单的已知轨迹如直线、圆观察关节角变化是否平滑、合理。5.3 超越基础将模型用于仿真与控制一个正确的DH模型是你的“数字孪生”机器人它是后续所有高级应用的基础逆运动学求解使用inverseKinematics对象。你可以指定末端位姿的约束位置、方向并设置权重让求解器为你计算所需的关节角度。这对于轨迹规划至关重要。ik inverseKinematics(RigidBodyTree, robot); weights [0.1, 0.1, 0.1, 1, 1, 1]; % 位置权重低姿态权重高 initialGuess config; % 初始猜测关节角 [qSol, solInfo] ik(tool, tform, weights, initialGuess);轨迹规划在关节空间或笛卡尔空间生成一系列路径点。例如使用trapveltraj或polynomialtraj生成平滑的关节角度轨迹然后用show函数以动画形式播放出来检查是否有奇异点或碰撞。与Simulink集成rigidBodyTree对象可以直接导入Simulink的Simscape Multibody环境进行物理仿真或者与控制系统模块结合实现更真实的带动力学和控制的仿真。导出与共享你可以将建好的rigidBodyTree机器人模型保存为.mat文件或URDFUnified Robot Description Format文件方便在其他项目或ROS机器人操作系统中使用。5.4 一个关键技巧使用可视化工具辅助建模对于复杂的机器人纯靠脑子想坐标系非常困难。我强烈推荐一个流程在SolidWorks、Fusion 360或OnShape等CAD软件中画出机器人的简化模型只需要关节轴线和连杆轮廓。在CAD环境中按照标准DH规则在每个连杆上创建坐标系。很多CAD软件可以显示坐标系的变换矩阵。直接从CAD环境中读取相邻坐标系之间的变换关系然后反推出DH参数。这比正向推导更不容易出错。 具体方法是已知从坐标系{i-1}到{i}的变换矩阵T可以通过公式反解出(θ_i, d_i, a_i, α_i)。Matlab也有函数可以帮助完成这个计算。建立机器人运动学模型是机器人编程的基石这个过程充满了对空间几何的理解和严谨的逻辑推导。第一次做可能会觉得繁琐但一旦你成功地把一个物理机器人用一组参数和矩阵在电脑里“复活”过来并且能精确控制它运动时那种成就感是无与伦比的。希望这篇详细的指南能帮你避开我当年踩过的那些坑顺利搭建起属于你自己的机器人仿真世界。记住多画图多验证从简单的二连杆、三连杆开始练习手感自然就来了。