PLC 与工业控制 / 系统课时
调用PLCopen功能块执行绝对定位
调用PLCopen功能块执行绝对定位
让伺服轴移动到指定坐标,不能只写入目标位置,还必须正确组织轴使能、启动沿、运行状态和异常处理。本课以 TwinCAT 3 的 PLCopen 运动控制功能块为例,实现一次从当前位置移动到 100 mm 的绝对定位,并验证完成信号和实际位置。
学习目标
- 区分
MC_Power、MC_MoveAbsolute的主要输入输出及调用条件。 - 使用 Structured Text 组织单轴使能、绝对定位和启动沿。
- 根据
Done、Busy、CommandAborted和Error判断运动结果并核对定位误差。
先确认轴引用与定位单位
以下示例适用于 Beckhoff TwinCAT 3、Tc2_MC2 运动控制库,并假定 PLC 已配置 NC/PTP 轴及关联驱动器。其他 PLCopen 平台的轴引用类型、功能块输入和使能方式可能不同,不能直接照搬声明。
运行前依次检查:
- 在 TwinCAT 工程中创建 NC/PTP Axis,并将轴与实际驱动器或仿真轴关联。
- 在 PLC 的 Axis 引用与 NC 轴之间建立链接,确保运动功能块操作的是目标轴。
- 完成回零或绝对位置基准确认,使当前位置具有可信的机械坐标意义。
- 确认软限位、硬限位、急停、STO、机械防护及运动方向均符合现场要求。
- 核对轴坐标单位及速度、加速度的工程单位;本例假设位置单位为 mm、速度单位为 mm/s、加速度单位为 mm/s²。
设当前位置为 20 mm,目标绝对位置为 100 mm,则本次位移是 80 mm,而不是再移动 100 mm。若目标超出轴允许行程,必须修改目标值,不能通过关闭安全保护强行运行。
认识功能块的执行状态
MC_Power 通过 Enable 请求轴使能,并用 Status 表示轴是否已准备好接受运动命令。MC_MoveAbsolute 则在 Execute 出现上升沿时接收位置与动态参数,执行到指定绝对坐标的运动。
| 信号 | 功能块 | 实际含义 |
|---|---|---|
Status |
MC_Power |
轴使能状态已建立 |
Execute |
MC_MoveAbsolute |
上升沿触发一次运动指令 |
Busy |
MC_MoveAbsolute |
功能块命令尚未结束 |
Active |
MC_MoveAbsolute |
当前运动命令正在控制该轴 |
Done |
MC_MoveAbsolute |
功能块报告运动成功完成 |
CommandAborted |
MC_MoveAbsolute |
命令被其他运动命令中止 |
Error |
两者 | 功能块出现错误,结合 ErrorID 诊断 |
一次成功定位的典型过程是:轴使能完成,PLC 产生 Execute 上升沿,运动命令进入执行阶段,轴到达目标后 Done 置位。Busy 和 Active 不应当混为一谈;处于排队等待的命令可能 Busy=TRUE,但尚未实际控制轴。

这里最容易误解的是 Execute:它是边沿触发,不要求整个运动过程持续为 TRUE。再次定位应先使它恢复 FALSE,再产生新的上升沿。Done 也不是永久保存的完成历史,监控程序应在命令结束时记录结果,而不是假定它始终有效。
用ST程序执行一次绝对定位
以下程序采用 TwinCAT 3 的 Structured Text(ST)。创建 PLC 的 MAIN 程序,引用 Tc2_MC2 库,并在工程配置中把变量 Axis 链接到目标 NC 轴。代码中的 Start 是上位机或 PLC 监控界面提供的启动请求,必须由操作人员在轴准备就绪后置位。
PROGRAM MAIN
VAR
Axis : AXIS_REF;
Start : BOOL := FALSE;
StartEdge : R_TRIG;
PowerFB : MC_Power;
MoveFB : MC_MoveAbsolute;
MoveRequest : BOOL;
END_VAR
// 每个PLC周期持续调用使能功能块,确保轴状态正常更新。
PowerFB(
Axis := Axis,
Enable := TRUE,
Enable_Positive := TRUE,
Enable_Negative := TRUE,
Override := 100.0
);
// 只允许已使能的轴接收一次新的定位启动沿。
StartEdge(CLK := Start);
MoveRequest := StartEdge.Q AND PowerFB.Status;
MoveFB(
Axis := Axis,
Execute := MoveRequest,
Position := 100.0,
Velocity := 20.0,
Acceleration := 100.0,
Deceleration := 100.0,
Jerk := 1000.0
);这是依赖已配置 NC 轴及有效轴链接的工程程序示例,并非脱离 TwinCAT 运行环境的独立程序。R_TRIG 用于检测 BOOL 信号上升沿;Velocity、Acceleration、Deceleration 和 Jerk 的单位跟随轴工程单位及时间基准,设定前须核对设备能力与 TwinCAT 轴配置。示例使用默认的运动缓冲行为,测试期间不要同时发送其他运动命令。
Start 必须先保持 FALSE,待 PowerFB.Status=TRUE 后再由 FALSE 切换为 TRUE。如果在轴尚未使能时发出短脉冲,MoveRequest 会因使能条件不成立而丢失;正式项目应采用待执行请求锁存及超时机制。
预期结果:在轴已建立位置基准、无其他命令干预且参数有效的条件下,启动一次后,实际位置从约 20 mm 向 100 mm 移动,正常完成时出现 MoveFB.Done=TRUE,MoveFB.Error=FALSE。这些是满足条件时的预期状态,不是固定的控制台输出。
联机验证实际位置与功能块结果
打开 TwinCAT PLC 在线监控或 Watch 视图,观察 PowerFB.Status、MoveFB.Busy、MoveFB.Active、MoveFB.Done、MoveFB.CommandAborted、MoveFB.Error 和 MoveFB.ErrorID。实际位置应从 NC 轴在线诊断信息读取,不能将指令目标值当成编码器反馈。
建议按以下顺序验收:
- 确认
PowerFB.Status=TRUE,且驱动器没有报警;检查轴处于允许定位的状态。 - 在
Start=FALSE时准备监控,随后将其置为 TRUE 一次,再恢复 FALSE。 - 观察运动过程中
Busy和Active的变化,并确认实际位置朝目标位置变化。 - 运动结束时检查
Done=TRUE,同时确认没有Error或CommandAborted。 - 记录目标位置、实际位置及误差,并结合轴设定的定位公差验收。
例如,目标值为 100.000 mm、结束时实际反馈位置为 99.992 mm,绝对误差为:
如果本项目规定最大允许静态定位误差为 0.020 mm,则 0.008 mm 满足要求。这个 0.020 mm 是示例验收标准,不是 PLCopen 统一规定,也不能替代设备精度规格和实际测量。
应区分三种不同结果:功能块 Done 表示控制器报告运动正常结束;NC 轴反馈位置表示编码器测得的位置;机械端实际精度则可能受丝杠间隙、弹性变形和传动结构影响。高精度设备需要使用百分表、激光干涉仪等外部量测手段复核。
处理未启动、中断与报错
现场调试时可按故障信号顺序定位,而不是不断重复触发 Start。
| 现象 | 优先检查 | 处理方式 |
|---|---|---|
Status=FALSE |
轴链接、驱动就绪、使能条件 | 核实硬件状态与报警,不直接强制运动 |
Status=TRUE 但不移动 |
Start 是否形成上升沿、目标是否有效 |
先复位启动请求,再在安全条件下触发 |
CommandAborted=TRUE |
是否有其他定位、停止或接管命令 | 查明命令来源,避免多个功能块争用轴 |
Error=TRUE |
ErrorID 及 NC、驱动器诊断 |
按实际错误码排查并执行规定复位流程 |
Done=TRUE 但精度不达标 |
反馈误差、定位公差、机械传动 | 检查轴参数、负载、机械间隙与测量方法 |
需要特别注意:功能块的 Error 不能简单等同于驱动器故障,更不能认为将 Execute 清零就一定清除了所有轴报警。不同故障可能需要独立的 MC_Reset、驱动器故障复位或重新建立安全许可,具体应遵循设备手册。
对于实际设备,推荐额外加入使能超时、运动超时、软限位检查、互斥运动请求和停止逻辑。示例为单次定位演示,没有实现完整的故障恢复与安全停机状态机,不能直接作为未经风险评估的生产设备控制程序。
一次合格的绝对定位测试,应同时具备有效的轴基准、明确的启动沿、正常的运动完成状态,以及可量测且满足项目公差的实际位置;仅看到 Done=TRUE 不足以证明整套机械系统的定位精度合格。