2. 工业机械臂基础
在进入PLCopen运动控制编程之前，必须先建立对机械臂本体结构的系统性认知。伺服运动控制的核心任务，是让机械臂各关节按照规划轨迹精确运动，而关节的物理布局、自由度配置和工作空间边界，直接决定了运动学建模、插补算法和轨迹规划策略的选择。本章将围绕机械臂的结构类型、自由度、工作空间和典型应用场景四个维度展开，为后续PLCopen状态机设计、轴组运动学和坐标变换等内容奠定基础。
2.1 机械臂结构类型与选型逻辑
2.1.1 核心原理：四大主流结构
工业机械臂的结构类型决定了其运动学模型、刚度特性、控制复杂度和适用场景。在PLCopen运动控制中，不同结构对应不同的轴组配置（AXIS_GROUP）和运动学变换方式。目前工业现场最常用的四类结构如下：
| 结构类型 | 关节构成 | 自由度典型值 | 工作空间形状 | 控制特点 |
|---|---|---|---|---|
| 关节型（垂直多关节） | 底座回转+肩+肘+腕 | 6 | 近似球体（有空洞） | 逆解复杂，需处理奇异点 |
| 直角坐标型（龙门式） | 3个正交线性轴 | 3-6 | 长方体 | 运动学简单，控制线性 |
| SCARA型 | 2个旋转轴+1个线性轴 | 4 | 圆柱体（部分） | 平面内灵活，垂直刚度高 |
| 并联型（Delta） | 3组平行连杆+旋转驱动 | 3-6 | 倒锥体/圆顶 | 动力学耦合强，需高速插补 |
关节型机械臂是目前六轴工业机器人的主流，其结构类似人类手臂，由底座、大臂、小臂和手腕组成。每个关节由伺服电机经RV减速器或谐波减速器驱动，关节间的运动耦合使得末端执行器可以在三维空间中实现任意姿态。直角坐标型则采用三个互相垂直的线性模组（通常为滚珠丝杠或同步带驱动），运动学关系为纯平移变换，控制最为直接，但占用空间较大且灵活性受限。SCARA型（Selective Compliance Assembly Robot Arm）在水平面内具有柔顺性，在垂直方向具有高刚性，特别适合垂直插入类装配任务。并联型Delta机器人通过三组并联连杆驱动末端平台，具有极高的加速度和重复定位精度，但工作空间相对较小。
2.1.2 判断方法：根据工艺需求选型
在PLCopen项目启动阶段，选型判断应遵循以下流程：
- 负载评估：末端执行器+工件的总质量，决定机械臂的额定负载等级（3kg/6kg/10kg/50kg等）。
- 工作空间需求：测量工艺所需的XYZ范围，对比各类型机械臂的包络空间。若需覆盖较大立体空间且姿态多变，优先关节型；若只需平面内搬运，SCARA或直角坐标更经济。
- 精度与速度权衡：重复定位精度要求≤±0.02mm时，考虑直角坐标或高精度SCARA；要求节拍时间≤1s且负载轻，Delta并联是首选。
- 环境约束：洁净室环境避免使用油脂润滑的关节型，可选用无尘润滑的直角坐标或特殊涂层SCARA。
MC_GROUP_KIN运动学变换功能块，而直角坐标型可直接使用线性轴组（MC_GROUP_LINEAR），无需逆解计算。选型时务必确认PLCopen库是否支持对应运动学模型。
2.1.3 案例拆解：3C电子装配线的SCARA选型
某3C电子工厂需要为手机主板上的连接器装配工位选择机械臂。工艺要求：在300mm×250mm的平面区域内完成取放料，Z轴行程80mm，负载0.8kg（含夹爪），节拍要求2.5s/次，重复定位精度±0.03mm。初始方案考虑六轴关节型机器人，但经过工作空间分析发现，六轴机器人在该小范围内存在大量冗余自由度，且成本较高。改用SCARA型（臂展400mm）后，其平面内两个旋转轴配合Z轴线性运动完全覆盖需求，且垂直方向的高刚性保证了插入连接器时的对位精度。实际运行中，SCARA的4轴联动通过PLCopen的MC_MoveDirectAbsolute指令实现，运动学变换简单，调试周期缩短了40%。
2.1.4 常见误区与总结
- 误区一：自由度越多越好。多余自由度会增加控制复杂度和成本，且可能引入奇异点风险。满足工艺需求即可。
- 误区二：忽略手腕负载。关节型机械臂的腕部允许力矩有限，安装较重末端工具时需校核腕部额定扭矩。
- 误区三：直角坐标型只能做简单搬运。实际上，配备旋转轴和摆动轴的5-6自由度直角坐标机器人也能完成复杂曲面加工。
2.2 自由度与运动学约束
2.2.1 核心原理：自由度的本质
自由度（Degree of Freedom, DOF）是指机械臂末端执行器在空间中独立运动的参数个数。三维空间中，一个刚体具有6个自由度——3个位置自由度（X、Y、Z）和3个姿态自由度（绕X、Y、Z轴的旋转，即Roll、Pitch、Yaw）。机械臂的自由度数量必须大于等于6才能实现末端任意位姿。当自由度大于6时（如7轴冗余机器人），系统存在冗余解，可用于避障或优化关节力矩分配。
在PLCopen运动控制中，自由度直接映射到轴组的轴数量。例如，6轴关节型机械臂对应一个包含6个伺服轴的轴组（AXIS_REF数组长度为6）。运动学变换将笛卡尔空间的目标位姿（X,Y,Z,A,B,C）映射为各关节角度（J1-J6）。需要特别注意的是，自由度并不等于可独立控制的轴数——某些结构（如Delta并联）虽然只有3个驱动电机，但末端平台具有3个平移自由度，若加上旋转平台则可扩展至4-6自由度。
2.2.2 判断方法：自由度与工作空间的关系
工作空间（Workspace）是机械臂末端执行器参考点所能达到的所有空间位置的集合。工作空间分为：
- 可达工作空间：末端至少以一个姿态到达的区域。
- 灵活工作空间：末端以任意姿态到达的区域。
关节型机械臂的工作空间受限于关节转角范围（如J1轴±170°、J2轴-90°~+135°等）和连杆长度。在PLCopen中，每个轴都有软件限位（MC_Home后设置软限位），这些限位共同定义了实际可编程的工作空间。逆运动学求解时，若目标点超出工作空间，PLCopen运动学功能块会返回错误状态（ErrorID），因此编程前必须进行可达性验证。
2.2.3 小型场景化说明：六轴机械臂的奇异点
考虑一个典型的六轴关节型机械臂，当腕部中心（J4、J5、J6轴交点）位于J1轴中心线上方时，J1轴角度变化不会改变末端位置，此时机械臂处于奇异位形。在PLCopen中，若程序试图通过奇异点，逆解计算会产生无穷多解或极大关节速度。实际处理方法是：在轨迹规划时添加奇异点规避逻辑，或采用阻尼最小二乘法（DLS）进行数值逆解。例如，在焊接应用中，当焊枪经过工件上方时，可调整焊接姿态或增加过渡点来避开奇异区域。
2.2.4 常见误区与总结
2.3 典型应用场景与PLCopen控制要点
2.3.1 核心原理：场景驱动的控制需求
不同应用场景对运动控制的要求差异巨大，这直接影响PLCopen程序架构和功能块选择。下表归纳了四类典型场景的控制特征：
| 应用场景 | 机械臂类型 | 运动特征 | PLCopen关键功能块 | 性能指标 |
|---|---|---|---|---|
| 点焊/弧焊 | 关节型6轴 | 连续轨迹，姿态恒定 | MC_MoveLinear、MC_TrackConveyor | 轨迹精度±0.5mm，速度均匀 |
| 高速分拣 | Delta并联 | 门型轨迹，频繁启停 | MC_MovePath、MC_SetPosition | 节拍≤0.5s，加速度≥10g |
| 精密装配 | SCARA/直角坐标 | 低速高精度，力控 | MC_MoveDirect、MC_ForceControl | 重复精度±0.01mm |
| 码垛/搬运 | 关节型4-6轴 | 点到点，路径简单 | MC_MoveAbsolute、MC_MoveRelative | 负载大，节拍稳定 |
2.3.2 操作流程：从工艺需求到PLCopen实现
- 工艺分析：明确末端执行器类型（焊枪、吸盘、夹爪）、运动轨迹（点对点/连续路径）、速度/加速度要求。
- 轴组配置：在PLCopen配置中定义轴组类型（
AXIS_GROUP_6）、轴映射关系和运动学模型。 - 坐标系定义：设置基坐标系、工具坐标系（TCP）和用户坐标系。TCP的准确性直接影响轨迹精度。
- 轨迹编程：使用
MC_MoveLinear（直线插补）或MC_MovePath（路径规划）编写运动指令，设置速度、加速度和加加速度。 - 信号交互：通过
MC_DigitalOutput控制焊机/气阀，使用MC_InputCapture同步外部传感器信号。
2.3.3 案例拆解：汽车焊装线的多机械臂协同
某汽车焊装车间需要两台六轴机械臂协同完成车身侧围的点焊作业。工艺约束：两臂工作空间有重叠区域，需避免碰撞；焊接节拍为60s/台；焊点数量120个。初始方案采用独立编程，但调试中发现两臂在重叠区域存在干涉风险。改进方案：在PLCopen中配置主从轴组，使用MC_GroupSync功能块实现两轴组的同步协调运动。具体实施时，将焊接任务划分为两个区域，主臂负责前段60个焊点，从臂负责后段60个焊点，在重叠区设置互锁信号（MC_ReadBool检测对方状态）。通过PLCopen的MC_AddAxisToGroup动态调整轴组，实现了两臂的时序协同。最终节拍缩短至52s，且消除了碰撞风险。
2.3.4 常见误区与总结
- 误区一：忽略TCP标定。TCP误差1mm会导致末端轨迹偏差数毫米，必须使用四点法或六点法进行精确标定。
- 误区二：过度依赖示教器。对于复杂轨迹，应使用离线编程软件生成路径点，再通过PLCopen的
MC_WriteMotion下载，减少停机时间。 - 误区三：忽视安全区域。在PLCopen中应使用
MC_SetSafetyZone定义软限位区域，防止机械臂超出允许范围。