[发明专利]协作机器人功能安全控制电路，控制方法及协作机器人

说明书

本申请实施例提供一种协作机器人功能安全控制电路，控制方法及协作机器人，本申请实施例通过设置两个第一信号输入单元和第二信号输入单元用于输入停止信号，在本申请实施例中第一信号输入单元输入的是紧急停止信号，如遇到紧急情况需要进行关闭电源等等，第二信号输入单元输入的是保护性停止信号，如果需要降低机器人的运行速度等等，本申请实施例设置两个控制器，且每个控制器均与第一信号输入单元和第二信号输入单元连接，每个控制器均可以控制相同类型的信号输入，本申请具有双路停止信号输入控制和双路关断电源控制的功能，实现了紧急停止和保护性停止的双路冗余设计，如果其中一路出现问题，安全功能也不会丧失。

技术领域

本申请属于安全控制技术领域，具体涉及一种协作机器人功能安全控制电路，控制方法及协作机器人。

背景技术

传统机械手实现功能安全急停需要接安全可编程逻辑控制器(PLC)或者安全继电器模块，实现功能安全IO需要接安全IO模块，即使这样有些安全功能还是受限，需要外接别的板卡来实现主电源回路中电压和电流的监控。

以上不但系统架构复杂，接线复杂，质量风险提高，同时成本高，产品无竞争力。

发明内容

本申请实施例的目的在于提供一种协作机器人功能安全控制电路，机器人及控制方法，用以解决或缓解上述一个或者部分技术问题。

为实现上述目的，第一方面，本申请实施例提供了一种协作机器人功能安全控制电路，所述电路包括：第一控制器，第二控制器，第一信号输入单元，第二信号输入单元，第一切断电路和第二切断电路单元；

第一控制器和第二控制器分别均与第一信号输入单元和第二信号输入单元连接，第一控制器和第二控制器分别通过第一切断电路与电源连接，第一切断电路用于根据第一控制器和第二控制器的控制信号决定是否与电源切断，第一控制器还与第二切断电路单元连接；

所述第二切断电路单元还与电源和关节驱动器连接，所述关节驱动器通过第一通信模块与第一控制器连接以便相互之间进行通信，第一控制器和第二控制器之间相互通信连接，第二控制器通过第二通信模块与机器人控制器连接以便相互之间进行通信；

第一控制器和/或第二控制器根据第一信号输入单元输入的第一停止信号，发送控制信号至第一切断电路以切断与电源连接，同时发送控制信号至第二切断电路单元切断与电源连接，第二控制器通过第二通信模块将停止信号发送至机器人控制器，以便机器人控制器停止发送控制指令；

第一控制器和/或第二控制器根据第二信号输入单元输入的第二停止信号，并发送控制信号至关节驱动器以停止关节驱动器，第二控制器通过第二通信模块将停止信号发送至机器人控制器，以便机器人控制器停止发送控制指令，第一控制器和/或第二控制器发送控制信号至第二切断电路以切断与电源连接。

作为本申请一优选实施例，第一信号输入单元包括第一停止信号输入模块和第二停止信号输入模块，第二信号输入单元包括第三停止信号输入模块和第四停止信号输入模块；

所述第一停止信号输入模块和第二停止信号输入模块分别与所述第一控制器连接；所述第三停止信号输入模块和第四停止输入信号模块分别与所述第二控制器连接。

作为本申请一优选实施例，所述第一信号输入单元还包括第一隔离模块和第二隔离模块，第一停止信号输入模块通过第一隔离模块与第一控制器连接，第二停止信号输入模块通过第二隔离模块与第一控制器连接；

所述第二信号输入单元还包括第三隔离模块和第四隔离模块，第三停止信号输入模块通过第三隔离模块与第一控制器连接，第四停止信号输入模块通过第四隔离模块与第二控制器连接。

作为本申请一优选实施例，所述控制电路还包括第一信号输出模块和第二信号输出模块；

所述第一信号输出模块与第一控制器连接，所述第二信号输出模块与第一控制器连接以便将停止信号输出。