机器人 / 系统课时
设计暂停继续与程序恢复逻辑
设计暂停继续与程序恢复逻辑
为六轴机械臂的取料、夹持和放料循环设计可恢复的运行逻辑:收到暂停请求后先确认停车,继续前核对工件和夹爪状态;遇到故障、断电或信号矛盾时转人工恢复,避免重复抓取与二次放料。
学习目标
- 区分正常暂停、工艺恢复和安全停机,建立明确的状态转换条件。
- 用持久化断点与现场传感器判断下一条允许执行的工艺动作。
- 验证恢复门禁能拦截不确定步骤、未确认的操作和重复抓放。
把停车状态与继续许可分开
正常暂停采用 RUNNING(运行)→ PAUSING(暂停请求已接收)→ PAUSED(控制器报告运动停止)的顺序。发送暂停命令不等于轴已经停止;只有收到停车反馈并冻结当前任务编号后,才允许显示“已暂停”。操作员申请继续时先进入 RECOVERY_CHECK,通过检查后进入 RESUME_READY,再等待独立的启动操作。
需要区分三种触发来源:普通暂停保留工艺断点;碰撞、超限等故障停止要先查明并消除原因;急停或防护装置触发时由设备安全系统处理停机、复位和重新启动许可。本工位采用人工授权后继续的策略,安全回路复位不能直接充当工艺继续命令;不同控制器的防护停止恢复行为必须以设备手册和风险评估为准。

把抓放动作拆成可核实的断点
以单工件取放循环为例,持久化保存 cycleId(本循环唯一编号)、checkpoint(最近确认完成的步骤)及动作是否处于 inFlight。发出夹取或释放指令前先记录“动作在途”,只有现场传感器确认结果后才把断点更新为 PICK_CONFIRMED 或 PLACE_CONFIRMED。若停电发生在动作完成与写入确认之间,不能凭旧断点自动重试。
| 持久化断点 | 恢复时的现场证据 | 允许的下一步 |
|---|---|---|
READY_PICK |
夹爪无料、取料位有料、放料位无料 | 从已验证的取料入口开始 |
PICK_CONFIRMED |
夹爪有料、取料位无料、放料位无料 | 跳过取料,转放料 |
PLACE_CONFIRMED |
夹爪无料、放料位有料 | 结束本循环,不再放料 |
inFlight=true 或信号矛盾 |
动作是否完成无法证实 | 禁止自动重试,人工核查 |
例如循环 cycleId=<ID> 在夹取后暂停:夹爪检测到工件,取料位和放料位均为空,即使恢复程序的入口仍指向取料,也必须改从经验证的放料入口继续。实际编号由现场系统生成,示例中的 <ID> 需替换为对应循环编号。
仅有“夹爪已闭合”不等于抓取成功,应使用与实际夹具匹配的工件在位、真空压力或夹持确认信号,并检查信号稳定性;信号滤波时间可在联调时从 100 毫秒开始测试,再按传感器响应确定。这是工艺信号参数,不是安全回路的响应时间设置。
持久化记录还需要遵守两个规则:同一 cycleId 不得重复确认放料完成;若动作状态写入失败、控制器重启或外部设备状态改变,必须重新核验物理状态。不能用单纯递增的程序行号代替工艺断点。
用可运行示例验证恢复门禁
下面是 Python 3.9 及以上版本的离线判定模拟,可直接运行,不连接机器人,也不发送运动指令。safety_ready 只是测试输入,实际安全功能必须由符合要求的安全控制系统承担。程序只输出允许的下一工艺步骤,真正发动作前仍须经过控制器的运动和安全许可。
from dataclasses import dataclass, replace
@dataclass(frozen=True)
class Snapshot:
checkpoint: str
robot_stopped: bool
safety_ready: bool
operator_confirmed: bool
in_flight: bool
gripper_has_part: bool
pick_has_part: bool
place_has_part: bool
def decide(s: Snapshot) -> str:
# 停车、复位状态和人工授权缺一不可;本函数不实现安全控制。
if not (s.robot_stopped and s.safety_ready and s.operator_confirmed):
return 'BLOCKED'
if s.in_flight:
return 'MANUAL_RECOVERY'
# 只接受传感器与已确认断点完全吻合的三种组合。
if s.checkpoint == 'READY_PICK':
if not s.gripper_has_part and s.pick_has_part and not s.place_has_part:
return 'RESUME_PICK'
elif s.checkpoint == 'PICK_CONFIRMED':
if s.gripper_has_part and not s.pick_has_part and not s.place_has_part:
return 'RESUME_PLACE'
elif s.checkpoint == 'PLACE_CONFIRMED':
if not s.gripper_has_part and s.place_has_part:
return 'COMPLETE'
return 'MANUAL_RECOVERY'
if __name__ == '__main__':
# 用相互独立的快照测试正常恢复与异常分支。
base = Snapshot(
checkpoint='PICK_CONFIRMED', robot_stopped=True,
safety_ready=True, operator_confirmed=True, in_flight=False,
gripper_has_part=True, pick_has_part=False, place_has_part=False,
)
print('抓取确认:', decide(base))
print('夹持异常:', decide(replace(base, gripper_has_part=False)))
print('放置确认:', decide(replace(
base, checkpoint='PLACE_CONFIRMED',
gripper_has_part=False, place_has_part=True,
)))
print('安全未放行:', decide(replace(base, safety_ready=False)))
print('动作未确认:', decide(replace(base, in_flight=True)))预期输出:
抓取确认: RESUME_PLACE
夹持异常: MANUAL_RECOVERY
放置确认: COMPLETE
安全未放行: BLOCKED
动作未确认: MANUAL_RECOVERY这里的变量名称是示例数据结构,并非任何机器人厂商的控制接口。现场集成时,需把持久化断点映射到机器人或 PLC 的保持型数据,并对接真实的停车反馈、夹爪检测和工件在位信号;状态更新必须具备掉电一致性策略,不能只保存在上位机易失内存里。
RESUME_PICK、RESUME_PLACE 和 COMPLETE 只是工艺决策结果,不代表可以立即驱动机器人。正式程序还应检查当前循环编号、目标位置是否被占用、机器人是否位于允许的轨迹入口,以及动作命令是否已经被本循环确认执行。
恢复操作与工位验收
- **冻结现场。**记录
cycleId、最后已确认步骤、报警代码及各工位传感器;先确认机器人已停止、故障原因已处理,必要时按现场安全规程隔离能源。 - **复核位置和工件。**检查机器人当前位置、工具与工件坐标系、夹持状态及放料位占用情况。若操作员移动过机器人或取走工件,废弃原自动续行许可;按经评估批准的手动恢复路径处理,不能直接跳向原轨迹中间点。
- 确定唯一入口。
READY_PICK进入取料,PICK_CONFIRMED进入放料,PLACE_CONFIRMED只做本循环结算;任何未知动作或信号冲突进入人工恢复,确认后重新采集现场证据。 - **独立授权启动。**安全条件满足和故障复位完成后,由授权人员再次发出继续指令;提交下一步动作前复核当前
cycleId,完成放料后以放料位有料且夹爪无料作为工艺验收条件。
验收至少覆盖四次注入测试:抓取后正常暂停应只执行一次放料;暂停期间人工取走夹爪工件应拒绝续行;夹取命令已发出但结果未确认时应进入人工恢复;安全条件失效时即使点击继续也不得产生新的运动请求。
还应测试通信中断后恢复、机器人重新上电、夹爪反馈延迟和放料位被占用的情况。每次测试记录暂停原因、恢复前后断点、传感器状态、人工确认记录及最终执行动作,并验证同一工件没有被重复夹取或放置。
正常暂停能否沿原插补轨迹续行取决于机器人控制器;断电或位置发生变化后应按设备许可的恢复方式重新进入已验证路径,而不是擅自重放未完成动作。对无法证明动作结果的步骤,保留人工核验入口比自动回退程序行号更可靠。