机器人 / 系统课时

处理握手超时与重复启动指令

处理握手超时与重复启动指令

六轴机器人接到启动请求后,若应答迟到、完成位没有清零或现场总线中断,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 请求并禁止新启动,不自动重发。

机器人与PLC正常握手时序及超时锁存状态图

用结构化文本实现故障锁存

以下逻辑适用于 CODESYS V3.5 的 Structured Text,使用 Standard 库的 TON 与 R_TRIG。新建 ST 类型程序组织单元 PLC_PRG,将第一段放入声明区,第二段放入实现区,并由周期任务调用。变量暂不绑定实际端子,先在仿真监视表中修改输入;投产前再连接经过验证的真实 I/O 与通信诊断。

iecst
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_VAR
iecst
startEdge(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。操作员松开启动按钮后单独给出复位上升沿,故障码清零但不会自动续跑或补发上一笔命令。

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

目录与阅读设置

阅读设置

17

记录一个想法

处理握手超时与重复启动指令

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

登录哪都通