机器人 / 系统课时
处理握手超时与重复启动指令
处理握手超时与重复启动指令
六轴机器人接到启动请求后,若应答迟到、完成位没有清零或现场总线中断,PLC 可能误判节拍并再次发起动作。本课用一套明确的握手约定、分阶段超时和故障锁存,确保异常不会触发自动重试。
学习目标
- 识别启动确认延迟、完成位残留、重复启动与通信中断的不同现象。
- 编写带超时、边沿检测和人工复位条件的 PLC 握手状态机。
- 在离线仿真中逐项注入异常,核对状态、故障码和输出信号。
先约定双方信号的保持与清除条件
下面是一套自定义应用层协议,不代表某品牌机器人现成的系统信号。使用数字 I/O 或工业以太网都可以,但 PLC 与机器人程序必须按同一规则实现。
| 信号 | 方向 | 有效与清除规则 |
|---|---|---|
StartReq |
PLC→机器人 | PLC 发起时置 1,见到 StartAck=1 才清 0 |
StartAck |
机器人→PLC | 接受本次请求后置 1,见到 StartReq=0 后清 0 |
RobotReady、RobotBusy |
机器人→PLC | 空闲可接单时 Ready=1;运行期间 Busy=1 |
RobotDone |
机器人→PLC | 动作完成且 Busy=0 时置 1,保持至 DoneAck=1 |
DoneAck |
PLC→机器人 | PLC 看见完成后置 1,见到 RobotDone=0 后清 0 |
CommHealthy |
总线诊断→PLC | 由从站在线诊断或经超时判断的心跳生成,不可直接当作常量 1 |
正常一次循环有四个关键动作:PLC 保持请求直到确认;机器人确认后只执行一次;机器人完成后保持完成位直到 PLC 确认;双方信号均归零后才能接收下一次启动。机器人侧必须按 StartReq 的新上升沿接单,不能把一直保持的高电平反复解释为新任务。
为每个等待阶段设置独立超时
以单次搬运正常耗时约 6 秒、PLC 周期约 10 毫秒的教学工位为例,可以先采用以下报警门限;正式投产应根据实测最坏延迟、总线刷新周期及工艺最长节拍重新整定。
| 等待阶段 | 门限 | 超时故障码 |
|---|---|---|
启动请求→StartAck=1 |
500 ms | 1 |
撤销请求→StartAck=0 |
500 ms | 2 |
启动确认撤销→RobotBusy=1 |
1500 ms | 3 |
运行中→RobotDone=1 且 Busy=0 |
10 s | 4 |
DoneAck=1→RobotDone=0 |
500 ms | 5 |
CommHealthy 一旦失效,立即锁存故障码 6;机器人故障输入触发故障码 7。完成位在进入运行阶段前出现视为协议异常(故障码 8);空闲启动时发现残留的确认、忙碌或完成位,记故障码 10。所有异常均撤销本次 PLC 请求并禁止新启动,不自动重发。

用结构化文本实现故障锁存
以下逻辑适用于 CODESYS V3.5 的 Structured Text,使用 Standard 库的 TON 与 R_TRIG。新建 ST 类型程序组织单元 PLC_PRG,将第一段放入声明区,第二段放入实现区,并由周期任务调用。变量暂不绑定实际端子,先在仿真监视表中修改输入;投产前再连接经过验证的真实 I/O 与通信诊断。
VAR
StartCmd, ResetCmd : BOOL;
CommHealthy, RobotReady, RobotStartAck : BOOL;
RobotBusy, RobotDone, RobotFault : BOOL;
StartReq, DoneAck, CycleComplete : BOOL;
FaultLatched : BOOL;
FaultCode : INT;
State : INT := 0;
startEdge, resetEdge : R_TRIG;
ackTimer, ackClearTimer, busyTimer : TON;
runTimer, doneClearTimer : TON;
END_VARstartEdge(CLK := StartCmd);
resetEdge(CLK := ResetCmd);
(* 每个TON每个扫描周期都调用;离开状态时IN变0自动复位 *)
ackTimer(IN := State = 10, PT := T#500MS);
ackClearTimer(IN := State = 20, PT := T#500MS);
busyTimer(IN := State = 30, PT := T#1500MS);
runTimer(IN := State = 40, PT := T#10S);
doneClearTimer(IN := State = 50, PT := T#500MS);
StartReq := FALSE;
DoneAck := FALSE;
CycleComplete := FALSE;
(* 通信或机器人故障优先;故障码只记录首次原因 *)
IF State <> 90 THEN
IF NOT CommHealthy THEN
State := 90;
FaultCode := 6;
ELSIF RobotFault THEN
State := 90;
FaultCode := 7;
END_IF;
END_IF;
CASE State OF
0: (* 空闲:只能由新的启动上升沿发起 *)
IF startEdge.Q AND RobotReady THEN
IF RobotStartAck OR RobotBusy OR RobotDone THEN
State := 90;
FaultCode := 10;
ELSE
State := 10;
StartReq := TRUE;
END_IF;
END_IF;
10: (* 保持请求,直到收到接单确认 *)
StartReq := TRUE;
IF RobotStartAck THEN
StartReq := FALSE;
State := 20;
ELSIF ackTimer.Q THEN
StartReq := FALSE;
State := 90;
FaultCode := 1;
END_IF;
20: (* 确认信号必须随请求撤销而清零 *)
IF NOT RobotStartAck THEN
State := 30;
ELSIF ackClearTimer.Q THEN
State := 90;
FaultCode := 2;
END_IF;
30:
IF RobotDone THEN
State := 90;
FaultCode := 8;
ELSIF RobotBusy THEN
State := 40;
ELSIF busyTimer.Q THEN
State := 90;
FaultCode := 3;
END_IF;
40:
IF RobotDone AND NOT RobotBusy THEN
DoneAck := TRUE;
State := 50;
ELSIF runTimer.Q THEN
State := 90;
FaultCode := 4;
END_IF;
50: (* 完成确认保持到机器人撤销Done *)
DoneAck := TRUE;
IF NOT RobotDone THEN
DoneAck := FALSE;
CycleComplete := TRUE;
State := 0;
ELSIF doneClearTimer.Q THEN
DoneAck := FALSE;
State := 90;
FaultCode := 5;
END_IF;
90: (* 仅人工复位;禁止复位时启动按钮仍按住 *)
IF resetEdge.Q AND CommHealthy AND RobotReady
AND NOT RobotStartAck AND NOT RobotBusy
AND NOT RobotDone AND NOT RobotFault
AND NOT StartCmd THEN
State := 0;
FaultCode := 0;
END_IF;
ELSE
State := 90;
FaultCode := 9;
END_CASE;
FaultLatched := State = 90;预期结果: 初始所有输入为 0 时,程序进入 State=90、FaultCode=6,且 StartReq=0。将 CommHealthy、RobotReady 置 1,给 ResetCmd 一次 0→1→0 的脉冲后,状态回到 0。随后逐步模拟 StartCmd、RobotStartAck、RobotBusy、RobotDone 的应答,可依次看到状态 10→20→30→40→50→0;CycleComplete 只在完成确认撤销时为 1 个扫描周期。这里的数字是 PLC 内部应用状态和故障码,不是机器人厂商的系统代码。
注入异常并执行受控复位
在离线仿真中,每次故障测试前先让 StartCmd=0,清除模拟机器人输出,确认 CommHealthy=1、RobotReady=1,再向 ResetCmd 输入新上升沿。不要直接强制修改 State 变量。
| 注入动作 | 预期观测 | 排查重点 |
|---|---|---|
| 启动后始终不给 StartAck | 约 500 ms 后码 1,StartReq 归 0 | 启动许可、I/O 映射、机器人远程模式 |
| Ack 收到后一直不清零 | 约 500 ms 后码 2 | 机器人未按 StartReq 下降沿撤销确认 |
| Ack 已清零,但 Busy 不出现 | 约 1.5 s 后码 3 | 程序是否真正启动、Busy 是否映射 |
| Busy 保持且 Done 不出现 | 约 10 s 后码 4 | 卡在夹爪等待、工艺动作或程序暂停 |
| Done 已出现但始终不清零 | 约 500 ms 后码 5 | 完成位保持逻辑未响应 DoneAck |
| 任一运行阶段令 CommHealthy=0 | 故障码 6,新的启动被禁止 | 总线从站状态、心跳超时和掉线前状态 |
| 运行中反复触发 StartCmd | State 不回 10,不发新请求 | PLC 上升沿门控和机器人端去重 |
实际联调时按通信状态→StartReq/StartAck→Busy→Done/DoneAck的顺序看趋势记录,并保留故障发生前后的信号时间戳。没有收到 Ack 不等于机器人没有执行:Ack 可能只是反馈丢失,所以绝不能在超时后自动再发一次 StartReq。
受控复位必须先查清机器人当前位置、工件是否仍被夹持、夹具和输送线是否处于可恢复状态;再确认通信已恢复、机器人空闲且 StartAck=0、RobotBusy=0、RobotDone=0。操作员松开启动按钮后单独给出复位上升沿,故障码清零但不会自动续跑或补发上一笔命令。