简介：这份MATLAB作业项目面向机器人学与智能系统方向的初学者及课程学习者，围绕SCARA机械臂与飞船运动动画两个主题展开，帮助读者理解机器人建模、坐标变换与关节动画的实现思路。资源包共19个文件，以15个.m脚本为核心，辅以2份PDF说明文档、1张示意图和1份README，整体约129KB，体积轻便，便于快速浏览与本地运行。其中Robot文件夹的脚本覆盖坐标轴绘制、连杆建模、变换矩阵构造及旋转/棱柱关节实现，Spaceship文件夹则提供飞船对象层级与运动动画的示例代码，PDF文档对每个模块给出了详细说明。目前已有306人学习下载，适合作为课程作业参考或自学机器人运动学与MATLAB可视化的入门素材，读者可借此掌握从建模到动画的完整流程与代码组织方式。
1. 从一份 SCARA 机器人 MATLAB 作业说起：它到底能跑出什么
如果你正在学机器人学、做运动学仿真，或者被某个 SCARA 机器人 MATLAB 代码的作业卡住，这份资源大概率能帮上忙。它是一套围绕 SCARA 机器人建模与控制展开的 MATLAB 作业项目，核心内容覆盖正运动学、逆运动学、轨迹规划、雅可比矩阵求解以及简单的动力学仿真。和网上那些只丢一个 .m 文件、注释全靠猜的代码包不同，这套东西是按课程作业的逻辑组织的，每个脚本对应一个明确的知识点，变量命名和公式推导能对得上教材。
适合谁用？第一类是做机器人导论、智能系统导论这类课程的学生，作业要求用 MATLAB 实现 SCARA 的运动学解算，但自己从零推公式容易在 DH 参数那一步就翻车。第二类是做自动化设备仿真的工程师，想快速搭一个 SCARA 的验证环境，看看末端轨迹和关节角的关系。第三类是想从 Python 转 MATLAB 做机器人仿真的开发者，需要一份能直接跑通的参考实现。
这套代码不涉及实物控制，纯仿真，所以不需要任何硬件。你只要有 MATLAB 基础环境，把脚本放进工作目录就能跑。下面按“先搞懂模型、再动手跑、最后避坑”的顺序拆开讲。
2. SCARA 运动学建模：DH 参数表和正逆解实现
2.1 为什么 SCARA 的 DH 参数容易设错
SCARA 是 Selective Compliance Assembly Robot Arm 的缩写，四个自由度里前三个是旋转或移动关节，第四个是末端旋转。它的结构特点是前两个关节轴线竖直，第三个关节轴线竖直但带移动，第四个是末端绕竖直轴旋转。这个构型决定了它的 DH 参数表和常见的六轴机械臂差别很大。
常见做法是先把关节类型列清楚：关节 1 和关节 2 是旋转关节 R，关节 3 是移动关节 P，关节 4 是旋转关节 R。然后按标准 DH 或改进 DH 建表。标准 DH 里，连杆长度 a 和连杆偏距 d 的分配方式会直接影响逆解的解析形式。我一般会先用标准 DH 建一遍，跑正运动学验证末端位置，再决定要不要换成改进 DH。
这套作业代码里用的是标准 DH，参数表大致如下：
| 关节 | 类型 | a | alpha | d | theta |
|---|---|---|---|---|---|
| 1 | R | a1 | 0 | d1 | theta1 |
| 2 | R | a2 | 0 | 0 | theta2 |
| 3 | P | 0 | 0 | d3 | 0 |
| 4 | R | 0 | 0 | d4 | theta4 |
注意 d3 是移动关节的变量，不是固定值。很多人在这一步把 d3 写成常数，结果逆解怎么算都不对。正运动学的变换矩阵按 A1 到 A4 连乘，末端位姿就是 T = A1A2A3*A4。
2.2 正运动学代码：从 DH 表到变换矩阵
下面这段是正运动学的核心实现，直接对应上面的 DH 表。代码里把每个关节的变换矩阵单独写出来，方便对照公式检查。
function T = forward_kinematics(theta1, theta2, d3, theta4, params) % 输入：theta1, theta2 为关节1、2的旋转角（弧度） % d3 为关节3的移动量 % theta4 为关节4的旋转角 % params 结构体包含 a1, a2, d1, d4 % 输出：4x4 末端位姿矩阵 T a1 = params.a1; a2 = params.a2; d1 = params.d1; d4 = params.d4; % 关节1变换 A1 = [cos(theta1), 0, sin(theta1), a1*cos(theta1); sin(theta1), 0, -cos(theta1), a1*sin(theta1); 0, 1, 0, d1; 0, 0, 0, 1]; % 关节2变换 A2 = [cos(theta2), 0, sin(theta2), a2*cos(theta2); sin(theta2), 0, -cos(theta2), a2*sin(theta2); 0, 1, 0, 0; 0, 0, 0, 1]; % 关节3移动变换 A3 = [1, 0, 0, 0; 0, 1, 0, 0; 0, 0, 1, d3; 0, 0, 0, 1]; % 关节4旋转变换 A4 = [cos(theta4), -sin(theta4), 0, 0; sin(theta4), cos(theta4), 0, 0; 0, 0, 1, d4; 0, 0, 0, 1]; T = A1 * A2 * A3 * A4; end逻辑说明：每个 A 矩阵对应一个关节的齐次变换。A1 和 A2 的旋转部分绕 Z 轴，但平移部分在 XY 平面内，这是 SCARA 水平臂的特点。A3 只改变 Z 方向高度，A4 只改变末端姿态。参数说明：a1、a2 是两段臂长，d1 是基座到第一关节的高度，d4 是末端执行器的偏置。这些值在作业里通常给的是具体数字，比如 a1=0.3，a2=0.25，单位是米。
跑完正运动学，可以用一个简单测试验证：给定 theta1=0，theta2=0，d3=0.1，theta4=0，末端位置应该是 (a1+a2, 0, d1-d3+d4)。如果对不上，先检查 DH 表的 alpha 和 a 有没有搞反。
2.3 逆运动学：几何法解 theta1 和 theta2
SCARA 的逆运动学有解析解，因为前两个关节在平面内构成一个二连杆机构。给定末端目标位置 (x, y, z) 和姿态 phi，先解 theta1 和 theta2。
function [theta1, theta2, d3, theta4] = inverse_kinematics(x, y, z, phi, params) % 输入：末端目标位置 x, y, z 和目标姿态 phi（弧度） % 输出：四个关节变量 a1 = params.a1; a2 = params.a2; d1 = params.d1; d4 = params.d4; % 平面二连杆逆解 r2 = x^2 + y^2; cos_theta2 = (r2 - a1^2 - a2^2) / (2 * a1 * a2); % 检查是否超出工作空间 if abs(cos_theta2) > 1 error('目标点超出工作空间'); end theta2 = acos(cos_theta2); % 取肘部向上解 % 如果取肘部向下解，用 -acos(cos_theta2) % 解 theta1 theta1 = atan2(y, x) - atan2(a2*sin(theta2), a1 + a2*cos(theta2)); % 解 d3 和 theta4 d3 = d1 + d4 - z; theta4 = phi - theta1 - theta2; end逻辑说明：cos_theta2 用余弦定理算，theta2 有两个解，对应肘部向上和向下。代码里默认取向上解，实际作业里可能要求两个都算出来对比。theta1 用 atan2 解，避免象限判断错误。d3 由 Z 方向高度直接反推，theta4 由姿态角减去前三个关节的累积角度。参数说明：phi 是末端绕 Z 轴的绝对角度，不是相对角度。如果作业里给的是相对角度，需要先转换。
注意工作空间检查那一步不能省。很多人直接 acos 一个大于 1 的数，MATLAB 返回复数，后面全错。加上 error 提示能快速定位问题。
3. 轨迹规划与雅可比矩阵：从点到连续路径的仿真
3.1 关节空间轨迹：三次多项式和五次多项式怎么选
轨迹规划是作业里最容易拉开差距的部分。常见做法有两种：关节空间规划和笛卡尔空间规划。关节空间规划直接对每个关节的角度做插值，计算量小，不会出现奇异点问题。笛卡尔空间规划先规划末端路径，再逆解到关节角，精度高但可能在奇异点附近抖动。
这套代码里用的是关节空间的三次多项式插值。给定起始关节角 q0 和终止关节角 qf，以及时间 T，三次多项式保证位置和速度连续，但加速度不连续。如果作业要求加速度也连续，得用五次多项式。
function [q, qd, qdd] = cubic_trajectory(q0, qf, T, t) % 三次多项式轨迹规划 % 输入：q0 起始关节角，qf 终止关节角，T 总时间，t 时间向量 % 输出：q 位置，qd 速度，qdd 加速度 % 归一化时间 tau = t / T; % 三次多项式系数 a0 = q0; a1 = 0; a2 = 3 * (qf - q0) / T^2; a3 = -2 * (qf - q0) / T^3; % 计算位置、速度、加速度 q = a0 + a1*t + a2*t.^2 + a3*t.^3; qd = a1 + 2*a2*t + 3*a3*t.^2; qdd = 2*a2 + 6*a3*t; end逻辑说明：三次多项式有四个系数，由起始位置、终止位置、起始速度、终止速度四个条件确定。这里假设起止速度都为零。参数说明：T 是总运动时间，t 是仿真时间向量，通常用 linspace(0, T, N) 生成。如果作业要求中间点经过特定位置，需要分段做三次多项式，每段边界速度要连续。
五次多项式多两个系数，可以指定起止加速度。代码结构类似，只是系数矩阵变成 6x6。我一般会先用三次跑通，再根据作业要求决定要不要升级。
3.2 雅可比矩阵：速度映射和奇异点判断
雅可比矩阵描述关节速度到末端速度的映射。SCARA 的雅可比是 6x4 矩阵，但实际只关心 XY 平面和 Z 方向，所以可以简化成 3x4 或 4x4。
function J = jacobian_scara(theta1, theta2, d3, theta4, params) % 计算 SCARA 机器人的雅可比矩阵 % 输出：4x4 雅可比矩阵，行对应 [vx; vy; vz; omega_z] a1 = params.a1; a2 = params.a2; % 位置对关节角的偏导 J = zeros(4, 4); % vx 对 theta1, theta2 的偏导 J(1,1) = -a1*sin(theta1) - a2*sin(theta1+theta2); J(1,2) = -a2*sin(theta1+theta2); J(1,3) = 0; J(1,4) = 0; % vy 对 theta1, theta2 的偏导 J(2,1) = a1*cos(theta1) + a2*cos(theta1+theta2); J(2,2) = a2*cos(theta1+theta2); J(2,3) = 0; J(2,4) = 0; % vz 对 d3 的偏导 J(3,3) = -1; % omega_z 对 theta1, theta2, theta4 的偏导 J(4,1) = 1; J(4,2) = 1; J(4,4) = 1; end逻辑说明：雅可比矩阵的每一列对应一个关节对末端速度的贡献。前两列是旋转关节在 XY 平面的切向速度，第三列是移动关节在 Z 方向的速度，第四列是末端旋转。参数说明：theta1、theta2 是当前关节角，d3 不影响雅可比的位置部分，但影响逆解。奇异点判断看 det(J) 是否接近零。SCARA 的奇异点通常出现在 theta2=0 或 theta2=pi 时，此时臂完全伸直或折叠。
跑轨迹规划时，每个时间步都算一次雅可比，如果 det(J) 小于阈值，说明接近奇异点，需要减速或改变路径。这一步在作业里经常被忽略，但实际仿真时末端速度会突然飙高，就是奇异点导致的。
3.3 仿真主循环：把运动学、轨迹和雅可比串起来
主循环的逻辑是：设定起始和目标关节角，生成时间向量，对每个时刻算轨迹插值，再算正运动学得到末端位姿，最后算雅可比检查奇异点。
% 主仿真脚本 params.a1 = 0.3; params.a2 = 0.25; params.d1 = 0.2; params.d4 = 0.05; q0 = [0; 0; 0.1; 0]; qf = [pi/3; pi/4; 0.15; pi/6]; T = 2; t = linspace(0, T, 100); % 预分配 q_traj = zeros(4, length(t)); for i = 1:4 [q_traj(i,:), ~, ~] = cubic_trajectory(q0(i), qf(i), T, t); end % 逐点计算末端位姿和雅可比 for k = 1:length(t) T_end = forward_kinematics(q_traj(1,k), q_traj(2,k), q_traj(3,k), q_traj(4,k), params); J = jacobian_scara(q_traj(1,k), q_traj(2,k), q_traj(3,k), q_traj(4,k), params); if abs(det(J)) < 1e-6 fprintf('时刻 %.3f 接近奇异点\n', t(k)); end end逻辑说明：先对四个关节分别做三次多项式插值，得到每个时刻的关节角。然后逐点算正运动学和雅可比。参数说明：q0 和 qf 是起始和终止关节角，T 是总时间，t 是时间向量。奇异点阈值 1e-6 是经验值，实际作业里可以根据量纲调整。
这段代码跑完，可以用 plot 画出末端轨迹和关节角变化。如果轨迹出现突变，先检查雅可比那一步的奇异点判断有没有触发。
4. 避坑与排查：SCARA MATLAB 仿真里最容易翻车的五个地方
4.1 现象：正运动学结果和预期差一个固定偏移
原因：DH 表的 d1 或 d4 符号搞反了。SCARA 的基座高度和末端偏置在 Z 方向是叠加关系，如果 d1 写成负值，整个末端位置会下移两倍 d1。
解决：先用零位姿态验证。theta1=0，theta2=0，d3=0，theta4=0 时，末端 Z 坐标应该是 d1 - d3 + d4。如果对不上，检查 d1 和 d4 的符号。常见做法是画一个简单的侧视图，标出每个偏置的方向。
4.2 现象：逆运动学报错“超出工作空间”，但目标点明明在臂长范围内
原因：工作空间判断只用了 cos_theta2 的绝对值，但 SCARA 的移动关节 d3 也有行程限制。如果目标 Z 坐标超出 d1 到 d1+d4 的范围，d3 会算出负值或超限。
解决：在逆解里加 d3 的范围检查。常见做法是设 d3_min 和 d3_max，如果算出的 d3 不在范围内，直接报错并提示目标点 Z 方向超限。另外，cos_theta2 的判断要用 <=1 而不是 <1，边界点要能取到。
4.3 现象：轨迹规划跑出来关节角突变，末端抖动
原因：三次多项式在中间点不连续。如果作业要求经过多个路径点，每段单独做三次多项式，但边界速度没对齐，就会出现突变。
解决：改用五次多项式，或者用样条插值。MATLAB 的 spline 函数可以直接做三次样条，保证二阶连续。我一般会先用 spline 跑一遍看效果，如果作业要求自己实现，再手写五次多项式系数。
4.4 现象：雅可比矩阵行列式接近零，但末端速度没有异常
原因：雅可比矩阵的量纲不统一。旋转关节的列是长度量纲，移动关节的列是无量纲，直接算 det 会被量纲影响。
解决：对雅可比做归一化，或者分别检查位置部分和姿态部分。常见做法是只看位置雅可比的 2x2 子矩阵，即 XY 平面对应的两列。如果这个子矩阵的行列式接近零，才是真正的奇异点。
4.5 现象：MATLAB 报错“索引超出矩阵维度”，但代码看着没问题
原因：q_traj 预分配时用了 zeros(4, length(t))，但循环里赋值时写成了 q_traj(i,:) = ...，如果 cubic_trajectory 返回的是行向量，维度对不上。
解决：统一用列向量或行向量。我一般会在函数里强制 reshape 成行向量，或者在主循环里用 q_traj(i,:) = q(:)'。另外，预分配时确认 length(t) 和实际时间向量长度一致，避免 linspace 的第三个参数写错。
5. 进阶技巧：用 MATLAB 的 Robotics Toolbox 交叉验证你的手写代码
手写运动学跑通之后，下一步是用 Robotics Toolbox 做交叉验证。这个工具箱有现成的 SCARA 模型和逆解函数，可以和你自己的代码对比。如果结果一致，说明 DH 表和公式没问题；如果不一致，大概率是你的 DH 参数和工具箱的默认约定不同。
% 用 Robotics Toolbox 建 SCARA 模型 % 注意：需要先安装 Robotics Toolbox L1 = Link('d', 0.2, 'a', 0.3, 'alpha', 0, 'qlim', [-pi, pi]); L2 = Link('d', 0, 'a', 0.25, 'alpha', 0, 'qlim', [-pi, pi]); L3 = Link('d', 0.1, 'a', 0, 'alpha', 0, 'qlim', [0, 0.3]); L4 = Link('d', 0.05, 'a', 0, 'alpha', 0, 'qlim', [-pi, pi]); scara = SerialLink([L1 L2 L3 L4], 'name', 'SCARA'); % 给定关节角，算正运动学 q_test = [pi/6, pi/4, 0.1, pi/3]; T_toolbox = scara.fkine(q_test); % 和你自己的 forward_kinematics 对比 T_mine = forward_kinematics(q_test(1), q_test(2), q_test(3), q_test(4), params); % 计算误差 error = norm(T_toolbox.t - T_mine(1:3,4)); fprintf('末端位置误差：%.6f 米\n', error);逻辑说明：Robotics Toolbox 的 Link 函数用标准 DH 参数建连杆，SerialLink 把连杆串起来。fkine 算正运动学，返回一个 SE3 对象。参数说明：qlim 是关节限位，SCARA 的移动关节限位要设成实际行程。误差计算用末端位置的欧氏距离，如果大于 1e-6，说明两套 DH 参数有差异。
我一般会先用工具箱跑一遍，确认模型没问题，再回头检查自己的代码。如果工具箱的结果和手写代码差很多，先看 alpha 和 a 的符号。Robotics Toolbox 默认用标准 DH，但有些版本对移动关节的处理和手写不一样。
还有一个技巧是用工具箱的 ikine 做逆解对比。ikine 是数值逆解，可能收敛到不同解，但可以用来验证你的解析逆解是否覆盖了所有可能。如果解析逆解算出的关节角代入正运动学后末端位置对不上，说明逆解公式有误。
从那以后我每次做机器人仿真，都会先用工具箱建一个参考模型，再手写代码对比。这样能在早期发现 DH 参数的错误，避免后面轨迹规划全盘重来。希望帮到你。
本文还有配套的精品资源，点击获取
