1. 四轴机械臂基础与项目概述
四轴机械臂是工业自动化和教育领域最常见的机器人类型之一，它由四个旋转关节组成，能够完成抓取、搬运等基础任务。相比六轴机械臂，四轴结构更简单、成本更低，非常适合初学者入门机器人学。这次我们要用Matlab的Robotics Toolbox完成从机械臂建模到轨迹规划的全流程实战。
我去年指导过一个大学生机器人团队，他们刚开始接触机械臂时，最大的困惑就是如何把课本上的理论变成实际可运行的代码。通过这个项目，你将学会用D-H参数法建立机械臂模型，并实现两种不同空间的轨迹规划。整个过程就像搭积木一样，从最基础的坐标系定义开始，逐步构建完整的运动控制系统。
这个项目需要准备：
- Matlab R2016b或更高版本
- Robotics Toolbox（Peter Corke版本）
- 四轴机械臂的尺寸参数（如果没有实物，可以用典型教学用机械臂参数）
2. 机械臂建模实战
2.1 D-H参数法详解
D-H（Denavit-Hartenberg）参数法是机器人学中最常用的建模方法，它用四个参数描述相邻连杆之间的关系。我第一次接触这个方法时，最困惑的就是坐标系定义。后来发现一个实用技巧：把每个关节的Z轴想象成旋转轴，X轴则是当前Z轴指向下一个Z轴的"桥梁"。
以我们的四轴机械臂为例：
- 基座（Joint 1）：Z轴垂直向上，X轴水平向前
- 肩关节（Joint 2）：Z轴水平向前，X轴沿机械臂延伸
- 肘关节（Joint 3）：同上
- 腕关节（Joint 4）：Z轴垂直向下
2.2 建立D-H参数表
根据上述坐标系，我们得到D-H表：
| 关节 | θ（rad） | d（m） | a（m） | α（rad） |
|---|---|---|---|---|
| 1 | 0 | 0 | 0 | π/2 |
| 2 | 0 | 0 | 0.105 | 0 |
| 3 | 0 | 0 | 0.09 | 0 |
| 4 | 0 | 0 | 0.04 | 0 |
注意第一个关节的α是π/2，这是因为Joint 1到Joint 2的Z轴需要旋转90度。这个参数设置不当会导致整个模型错位，我曾在项目中因此浪费了两天时间调试。
2.3 Matlab代码实现
% 定义连杆参数 L1 = Link('d', 0, 'a', 0, 'alpha', pi/2); L2 = Link('d', 0, 'a', 0.105, 'alpha', 0); L3 = Link('d', 0, 'a', 0.09, 'alpha', 0); L4 = Link('d', 0, 'a', 0.04, 'alpha', 0); % 创建机械臂模型 robot = SerialLink([L1 L2 L3 L4], 'name', '4-Axis Arm'); % 显示参数 robot.display() % 可视化 robot.teach()运行这段代码，你会看到一个可交互的3D机械臂模型。点击各个关节可以手动调整角度，这是验证模型正确性的好方法。如果某个关节运动方向不符合预期，很可能是D-H参数设置有问题。
3. 运动学仿真
3.1 正运动学分析
正运动学解决"给定关节角度，求末端位置"的问题。Robotics Toolbox提供了直观的fkine函数：
% 定义一组关节角度（单位：弧度） q = [0, pi/4, -pi/6, 0]; % 计算末端位姿 T = robot.fkine(q); % 提取位置坐标 position = transl(T); disp(['末端位置：', num2str(position)]);在实际项目中，我常用这个方法验证机械臂的工作空间。比如连续生成多组随机角度，计算对应的末端位置，然后绘制点云图，这样可以直观看到机械臂能到达的区域。
3.2 逆运动学求解
逆运动学更复杂，它要解决"给定末端位置，求关节角度"的问题。这里有个关键技巧——mask参数的使用：
% 定义目标位置 target_pos = [0.1, 0.1, 0.2]; % 转换为齐次变换矩阵 T_target = transl(target_pos); % 求解逆运动学 q_sol = robot.ikine(T_target, 'q0', [0 0 0 0], 'mask', [1 1 1 0 0 0]); disp('求解得到的关节角度：'); disp(q_sol);mask参数[1 1 1 0 0 0]表示我们只关心末端的位置(x,y,z)，不关心旋转方向。这是四轴机械臂的典型配置。如果遇到"DOF must be >= the same number of 1s in the mask matrix"错误，说明mask设置不当。
4. 轨迹规划实战
4.1 关节空间轨迹规划
jtraj函数可以生成平滑的关节空间轨迹：
% 定义起点和终点 q_start = [0, 0, 0, 0]; q_end = [pi/2, -pi/3, pi/4, 0]; % 生成轨迹 steps = 100; [q, qd, qdd] = jtraj(q_start, q_end, steps); % 可视化 robot.plot(q);这段代码会生成从q_start到q_end的100步平滑运动。qd和qdd分别是关节速度和加速度，可以用来检查是否超出电机性能限制。
4.2 笛卡尔空间轨迹规划
如果需要末端沿直线运动，可以使用ctraj：
% 计算起点和终点的位姿 T_start = robot.fkine(q_start); T_end = robot.fkine(q_end); % 生成笛卡尔空间轨迹 Tc = ctraj(T_start, T_end, steps); % 转换为位置序列 positions = transl(Tc); % 绘制轨迹 plot3(positions(:,1), positions(:,2), positions(:,3), 'r-');在实际应用中，我通常会将两种方法结合：先用ctraj规划末端路径，再用ikine转换为关节角度，最后用jtraj确保运动平滑。
5. 常见问题与调试技巧
5.1 单位一致性检查
最常见的错误就是单位不统一。Robotics Toolbox默认使用米和弧度，但很多机械臂设计图使用毫米和角度。建议在代码开头添加转换：
% 长度单位转换 mm_to_m = @(x) x/1000; % 角度转换 deg_to_rad = @(x) x*pi/180;5.2 奇异位形处理
当机械臂完全伸直或折叠时，可能会进入奇异位形，导致逆运动学求解失败。解决方法包括：
- 调整初始猜测角度q0
- 限制关节运动范围
- 使用阻尼最小二乘法(ikine的'ilimit'参数)
5.3 可视化调试技巧
robot.plot()虽然简单，但有时需要更详细的调试信息：
% 显示更多轨迹信息 plot(q) % 各关节角度变化 plot(qd) % 关节速度变化 plot(qdd) % 关节加速度变化我在实际项目中发现，加速度曲线最能反映运动是否平滑。如果出现尖峰，说明需要调整轨迹参数。
