机器人 / 系统课时

定义工件到位与夹持确认条件

定义工件到位与夹持确认条件

单件搬运不能只凭机器人报告“动作结束”就认定抓取成功。本课将取料检测、夹爪位置、工件保持及放料反馈组成四段确认条件,并用离线模拟复现缺料、虚夹和放置失败,形成可用于工位联调的状态判定与故障验收表。

学习目标

  • 区分取料到位、夹爪闭合、确实夹住工件和放置成功四类反馈。
  • 为每个动作阶段设置持续确认、超时和故障锁存条件。
  • 运行离线模拟,逐项核对正常搬运与三类异常的结果。

定义输入信号与确认依据

以一个取料台、一个放料台和一台双指夹爪六轴机器人为例。下列是项目内约定的逻辑变量名,不是任何品牌的固定 I/O 地址;接线时须核对传感器的常开/常闭类型与失电状态。

确认对象 需要的反馈 有效条件
取料就绪 PartAtPick、RobotAtPick 工件确实在取料位,机器人已处于正确取料点
夹持成功 GripClosed、HeldOK、GripOpen 闭合到位、独立持件检测有效、张开反馈无效
搬运结束 MotionDone、RobotAtPlace 本次运动已完成,末端到达放料位置
放置成功 GripOpen、PartAtPlace、GripClosed 夹爪已张开、工件出现在放料位、闭合反馈无效

HeldOK 应来自经工艺验证的工件在爪检测、夹持力或压力监测,而不是直接复制 GripClosed。空夹时夹爪同样可能闭合到位;若没有独立持件检测,就不能声称已验证工件被抓住。MotionDone 也必须对应本次运动指令,启动前清除上周期的完成锁存,避免把旧完成信号当作新反馈。

按状态发出动作许可

演示工位采用 100 ms 采样周期,要求条件连续两次成立,即稳定 200 ms 才迁移状态。下列超时均为教学设定,投产时应按夹爪规格、PLC 任务周期及实际最长路径重新测量。

当前状态 连续 200 ms 的通过条件 通过后的动作 超时与异常
WAIT_PART 取料就绪 发夹紧命令,进入 VERIFY_GRIP 2000 ms 缺料报警,不启动运动
VERIFY_GRIP 夹持成功 允许向放料位运动,进入 WAIT_PLACE 800 ms 夹持未确认
WAIT_PLACE 搬运结束且持件反馈持续有效 撤销新运动许可,发松爪命令 5000 ms 未到位;持件丢失立即故障
VERIFY_RELEASE 放置成功 报告 DONE,等待本周期完成信号被确认 1200 ms 放置未确认

在进入 WAIT_PLACE 前还要检查放料位未被占用;如果 GripOpen 与 GripClosed 同时有效,直接锁存反馈冲突。正常生产的 DONE 必须经过 PLC 完成握手清除后才能再次接收启动指令,不能仅因传感器仍保持高电平就重复执行。

搬运工位的四阶段确认与三类故障分支

离线模拟缺料、虚夹与放置失败

以下脚本使用 Python 3.9 及以上版本的标准库语法,模拟各状态下的传感器反馈,不连接 PLC、机器人或安全回路。每 100 ms 采样一次;未夹紧 场景故意让夹爪闭合反馈出现,但 HeldOK 始终为假,用来暴露“闭合即抓牢”的错误判断。

python
# Python 3.9+;离线模拟传感器,不连接真实机器人
STEP_MS = 100
LIMITS = {
    "WAIT_PART": (2000, "VERIFY_GRIP", "缺料超时"),
    "VERIFY_GRIP": (800, "WAIT_PLACE", "夹持未确认"),
    "WAIT_PLACE": (5000, "VERIFY_RELEASE", "未到放料位"),
    "VERIFY_RELEASE": (1200, "DONE", "放置未确认"),
}

def sensors(case, state, elapsed):
    closing = state == "VERIFY_GRIP" and elapsed >= 300
    moving = state == "WAIT_PLACE"
    releasing = state == "VERIFY_RELEASE" and elapsed >= 300
    # 闭合位置反馈与持件检测独立,避免把空夹误判为抓取成功
    return {
        "pick": state == "WAIT_PART" and case != "缺料" and elapsed >= 100,
        "at_pick": state == "WAIT_PART",
        "closed": closing or moving,
        "held": (closing or moving) and case != "未夹紧",
        "motion_done": moving and elapsed >= 500,
        "at_place": moving and elapsed >= 500,
        "opened": releasing,
        "placed": releasing and case != "放置失败",
    }

def simulate(case):
    state, elapsed, stable_ms = "WAIT_PART", 0, 0
    for _ in range(100):
        s = sensors(case, state, elapsed)
        # 反馈矛盾或运输途中失持,必须在超时前拦截
        if s["closed"] and s["opened"]:
            return "故障锁存:夹爪反馈冲突"
        if state == "WAIT_PLACE" and not s["held"]:
            return "故障锁存:搬运中失持"
        conditions = {
            "WAIT_PART": s["at_pick"] and s["pick"],
            "VERIFY_GRIP": s["closed"] and s["held"] and not s["opened"],
            "WAIT_PLACE": s["motion_done"] and s["at_place"],
            "VERIFY_RELEASE": s["opened"] and s["placed"] and not s["closed"],
        }
        limit, next_state, error = LIMITS[state]
        # 连续两个 100 ms 样本为真才切换状态
        stable_ms = stable_ms + STEP_MS if conditions[state] else 0
        if stable_ms >= 200:
            state, elapsed, stable_ms = next_state, 0, 0
            if state == "DONE":
                return "完成"
            continue
        if elapsed >= limit:
            return "故障锁存:" + error
        elapsed += STEP_MS
    raise RuntimeError("模拟步数不足")

for case in ("正常", "缺料", "未夹紧", "放置失败"):
    print(f"{case}:{simulate(case)}")

预期输出:

text
正常:完成
缺料:故障锁存:缺料超时
未夹紧:故障锁存:夹持未确认
放置失败:故障锁存:放置未确认

四组结果分别证明:无料不能触发夹紧;只有闭合反馈不能许可搬运;到达放料点且夹爪张开仍不等于工件已落在目标位置。模拟器的传感器值按阶段注入,因此用于检查判定与超时,不代表真实运动时间或现场 I/O 接线。

故障锁存后的现场验收

  1. **缺料测试:**断开取料存在信号并保持 2 s,确认夹紧和运动命令均未发出,仅生成可识别的缺料超时报警;补料后按工位规定确认复位。
  2. **虚夹测试:**让 GripClosed=1、HeldOK=0,确认在 800 ms 后禁止移动;不得通过短接 HeldOK 使工位继续运行。
  3. **放置失败测试:**模拟 GripOpen=1、PartAtPlace=0,确认不发送本周期完成信号,也不自动执行下一次取料。
  4. **反馈冲突与搬运中失持:**同时置位开、闭到位反馈,或在搬运中撤销 HeldOK,确认序列锁存故障并按经过验证的方式请求机器人受控停止。停止前不能贸然松开夹爪。

复位时应先确认机器人已处于允许人工处理的状态、工件位置明确、放料区空闲以及异常原因消除,再由操作员确认复位并重新发起新的周期。复位只清除工艺序列的故障锁存,不应自动重新下发旧运动命令。

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

目录与阅读设置

阅读设置

17

记录一个想法

定义工件到位与夹持确认条件

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

登录哪都通