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 平台的轴引用类型、功能块输入和使能方式可能不同,不能直接照搬声明。

运行前依次检查:

  1. 在 TwinCAT 工程中创建 NC/PTP Axis,并将轴与实际驱动器或仿真轴关联。
  2. 在 PLC 的 Axis 引用与 NC 轴之间建立链接,确保运动功能块操作的是目标轴。
  3. 完成回零或绝对位置基准确认,使当前位置具有可信的机械坐标意义。
  4. 确认软限位、硬限位、急停、STO、机械防护及运动方向均符合现场要求。
  5. 核对轴坐标单位及速度、加速度的工程单位;本例假设位置单位为 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,但尚未实际控制轴。

PLCopen绝对定位指令与状态时序

这里最容易误解的是 Execute:它是边沿触发,不要求整个运动过程持续为 TRUE。再次定位应先使它恢复 FALSE,再产生新的上升沿。Done 也不是永久保存的完成历史,监控程序应在命令结束时记录结果,而不是假定它始终有效。

用ST程序执行一次绝对定位

以下程序采用 TwinCAT 3 的 Structured Text(ST)。创建 PLC 的 MAIN 程序,引用 Tc2_MC2 库,并在工程配置中把变量 Axis 链接到目标 NC 轴。代码中的 Start 是上位机或 PLC 监控界面提供的启动请求,必须由操作人员在轴准备就绪后置位。

iecst
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 轴在线诊断信息读取,不能将指令目标值当成编码器反馈。

建议按以下顺序验收:

  1. 确认 PowerFB.Status=TRUE,且驱动器没有报警;检查轴处于允许定位的状态。
  2. 在 Start=FALSE 时准备监控,随后将其置为 TRUE 一次,再恢复 FALSE。
  3. 观察运动过程中 Busy 和 Active 的变化,并确认实际位置朝目标位置变化。
  4. 运动结束时检查 Done=TRUE,同时确认没有 Error 或 CommandAborted。
  5. 记录目标位置、实际位置及误差,并结合轴设定的定位公差验收。

例如,目标值为 100.000 mm、结束时实际反馈位置为 99.992 mm,绝对误差为:

∣e∣=∣100.000−99.992∣=0.008 mm|e|=|100.000-99.992|=0.008\text{ 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 不足以证明整套机械系统的定位精度合格。

按自己的节奏,确认真正理解。

目录与阅读设置

阅读设置

17

记录一个想法

调用PLCopen功能块执行绝对定位

0 / 10000 · 笔记保存到账号。未提交的修改会在关闭、离开或刷新后丢失。

登录哪都通