CN114347021B - 一种基于多关节机械臂的安全控制***和方法 - Google Patents

一种基于多关节机械臂的安全控制***和方法 Download PDF

Info

Publication number
CN114347021B
CN114347021B CN202111655603.1A CN202111655603A CN114347021B CN 114347021 B CN114347021 B CN 114347021B CN 202111655603 A CN202111655603 A CN 202111655603A CN 114347021 B CN114347021 B CN 114347021B
Authority
CN
China
Prior art keywords
joint
mechanical arm
protection
working condition
motor
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202111655603.1A
Other languages
English (en)
Other versions
CN114347021A (zh
Inventor
胡鑫
杨斌
肖可
胡娜
刘涛
王俊兰
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
China Nuclear Power Operation Technology Corp Ltd
Original Assignee
China Nuclear Power Operation Technology Corp Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by China Nuclear Power Operation Technology Corp Ltd filed Critical China Nuclear Power Operation Technology Corp Ltd
Priority to CN202111655603.1A priority Critical patent/CN114347021B/zh
Publication of CN114347021A publication Critical patent/CN114347021A/zh
Application granted granted Critical
Publication of CN114347021B publication Critical patent/CN114347021B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/06—Safety devices

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Safety Devices In Control Systems (AREA)
  • Manipulator (AREA)

Abstract

本发明具体涉及一种基于多关节机械臂的安全控制***，包括带电工况的保护***、失电工况的保护***及任何工况下的保护***；所述带电工况的保护***在带电工况下对多关节机械臂相应关节进行接近开关限位保护、电机过载保护、电机力矩过大保护、异常状态急停保护、软件限位保护以及安全电子围栏保护；所述失电工况的保护***在失电工况下对多关节机械臂相应关节进行失电保持保护；所述任何工况下的保护***在任何工况下对多关节机械臂相应关节进行机械限位保护。本发明的基于多关节机械臂的安全控制***，保证多关节机械臂本体在蒸汽发生器内安全高效运行。

Description

一种基于多关节机械臂的安全控制***和方法
技术领域
本发明涉及核工业机器人技术领域，特别是涉及一种基于多关节机械臂的安全控制***和方法。
背景技术
核电站换料大修期间，需要通过一次侧高水位堵板对蒸汽发生器主管道进行隔离，可保证核电站高水位时可同时进行蒸汽发生器内的其他检修工作，节省大修时间。目前一次侧高水位堵板的安装和拆除普遍采取人工操作的方式实现。蒸汽发生器内属于高辐射区域，且空间相对密闭、狭窄，在人工拆装一次侧高水位堵板过程中，存在人员受照剂量大，安装质量受人因因素影响较大的问题，国内已出现多起因人员安装质量导致一回路水大量泄露，造成核岛大面积放射性污染，因此国内外很多研究单位已经开始研究用多关节机械臂完成容器内部的工作。
由于多关节机械臂结合了多自由度机械链路结构、伺服驱动技术、远程实时操控技术、运动学解析等方法，且工况复杂、信号较多、目标位数量较多，受辐射干扰、人员误操作、***逻辑异常等影响，可能引起以下安全事故：
(1)由于各种干扰造成程序跑飞，机械臂不按规定指令动作，与容器内壁发生碰撞；
(2)电机惯性过大，机械臂动作超出安全范围，使机械臂本体产生卡死；
(3)电气元件的老化、损坏产生错误信号，导致机械臂误动作产生机械碰撞；
(4)人员误操作导致机械碰撞。
发明内容
基于此，有必要针对多关节机械臂存在的上述问题，提供一种基于多关节机械臂的安全控制***和方法，保证多关节机械臂本体在蒸汽发生器内安全高效运行。
为了实现上述目的，本发明提供如下技术方案：
一种基于多关节机械臂的安全控制***，包括带电工况的保护***、失电工况的保护***及任何工况下的保护***；所述带电工况的保护***在带电工况下对多关节机械臂相应关节进行接近开关限位保护、电机过载保护、电机力矩过大保护、异常状态急停保护、软件限位保护以及安全电子围栏保护；所述失电工况的保护***在失电工况下对多关节机械臂相应关节进行失电保持保护；所述任何工况下的保护***在任何工况下对多关节机械臂相应关节进行机械限位保护。
进一步地，所述多关节机械臂是将传统的六转动副关节机器人中的将第四关节替换为滑动副，包括第一关节、第二关节、第三关节、第四关节、第五关节和第六关节，所述第一关节、第二关节和第三关节依次连接组成球铰关节，所述第五关节和第六关节连接组成腕关节，所述球铰关节和腕关节通过第四关节滑动副连接。
进一步地，所述带电工况的保护***包括接近限位开关、急停装置、力矩过大及过载保护装置、软件限位装置和安全电子围栏；
所述多关节机械臂的各关节均配置接近限位开关，触发关节上的接近限位开关，所述带电工况的保护***控制相应关节上的电机停止运行并发出报警信号，防止误碰撞；
所述急停装置设置在安全控制***的操作端，当出现异常时，按下急停装置，所述带电工况的保护***控制整个多关节机械臂停止运行，防止事故扩大；
所述力矩过大及过载保护装置监控多关节机械臂的各关节电机电流及扭矩，当关节上的电机电流及扭矩超出安全范围，所述带电工况的保护***控制相应关节上的电机停止运行并发出报警信号，防止误碰撞；
所述多关节机械臂的各关节均配置软件限位装置，所述软件限位装置反馈各关节电机当前位移，当关节电机当前位移超出安全范围，所述带电工况的保护***控制相应关节电机停止运行，防止误碰撞；
所述安全电子围栏设置在安全控制***的软件端，安全电子围栏限制多关节机械臂的动作范围在安全电子围栏内，防止误碰撞。
进一步地，所述软件限位装置为编码器，所述编码器反馈各关节电机当前位移，当关节电机当前位移超出安全范围，所述带电工况的保护***控制相应关节电机停止运行，防止误碰撞。
进一步地，所述第一关节、第二关节、第三、第四关节、第五关节和第六关节上分别配置2个、2个、1个、2个、2个和1个接近限位开关；所述第一关节、第二关节、第三关节、第四关节、第五关节和第六关节电机电流限制分别为12A、12A、12A、2A、1.5A和1.5A；所述第一关节、第二关节、第三关节、第四关节、第五关节和第六关节电机扭矩限制分别为280Nm、250Nm、80Nm、250Nm、30Nm和80Nm；所述第一关节、第二关节、第三、第四关节、第五关节和第六关节的软件限位装置分别反馈第一关节电机180°方向位移，所述第二关节的软件限位装置反馈第二关节电机140°方向位移，所述第三关节的软件限位装置反馈第三关节电机720°方向位移，所述第四关节的软件限位装置反馈第四关节电机400mm处位移，所述第五关节的软件限位装置反馈第五关节电机40°方向位移，所述第六关节的软件限位装置反馈第六关节360°方向位移。
进一步地，所述失电工况的保护***包括失电保持装置，所述第二关节和第四关节均配置失电保持装置，当多关节机械臂失电时抱闸保持使多关节机械臂以及多关节机械臂上的负载保持原位，防止自重导致的多关节机械臂动作而产生误碰撞。
进一步地，所述任何工况下的保护***包括机械限位保护装置，所述第一关节、第二关节、第三关节、第四关节和第五关节均配置机械限位保护装置，当多关节机械臂运动超出接近限位开关限位时，限制多关节机械臂继续运动，直至电机堵转产生超扭矩或超电流致，触发电机过载保护或电机力矩过大保护使电机停止，防止机械臂关节卡死和误碰撞。
本发明还提供一种基于多关节机械臂的安全控制方法，包括如下步骤：
(1)、安全控制***未启动时，对多关节机械臂进行安装，失电工况的保护***控制多关节机械臂在失电工况下保持原位；任何工况下的保护***机械限位保护多关节机械臂，防止安装过程中多关节机械臂乱动作导致误碰撞；
(2)、安全控制***启动后，在多关节机械臂执行过程中，带电工况的保护***接近开关限位、电机电流过载保护、电机力矩过大保护、异常状态急停、软件限位以及安全电子围栏保护多关节机械臂；任何工况下的保护***机械限位保护多关节机械臂；如果操作过程中意外断电，失电工况的保护***控制多关节机械臂保持原位，防止误碰撞；
(3)、操作完毕后断电，对多关节机械臂进行拆卸，失电工况的保护***控制多关节机械臂保持原位，任何工况下的保护***机械限位保护多关节机械臂，防止拆卸过程中多关节机械臂乱动作导致误碰撞。
进一步地，所述多关节机械臂拆装过程中，安全控制***进行如下保护流程：安全控制***保持断电状态，失电工况的保护***和任何工况下的保护***进入保护状态，多关节机械臂相应关节进入保持状态，防止机械臂因为自重而下坠，如过程中触发多关节机械臂某关节机械限位保护，该关节将停止继续动作，防止机械臂与蒸汽发生器碰撞。
进一步地，所述多关节机械臂执行过程中，安全控制***进行如下保护流程：
第一步，多关节机械臂执行指令，安全控制***开始对多关节机械臂进行安全保护；如果安全控制***断电，触发失电工况的保护***对多关节机械臂相应关节进行失电保持保护，多关节机械臂相应关节保持原位，等待处理故障；如果安全控制***有电，进入第二步；
第二步，如果触发任何工况的保护***对多关节机械臂相应关节进行机械限位保护，多关节机械臂相应关节电机堵转，从而触发多关节机械臂相应关节电机力矩过大保护或者电机电流过载保护，多关节机械臂相应关节停止动作并产生报警，等待处理故障；如果未触发任何工况的保护***对多关节机械臂相应关节进行机械限位保护，进入第三步；
第三步，如果触发带电工况的保护***对多关节机械臂相应关节进行接近限位开关保护，多关节机械臂相应关节停止动作并产生报警，等待处理故障；如果未触发带电工况的保护***对多关节机械臂相应关节进行接近限位开关保护，进入第四步；
第四步，如果触发带电工况的保护***对多关节机械臂相应关节电机力矩过大保护或电机电流过载保护，多关节机械臂相应关节停止动作并产生报警，等待处理故障；如果未触发多关节机械臂相应关节电机力矩过大保护或电机电流过载保护，进入第五步；
第五步，如果触发带电工况的保护***对多关节机械臂进行安全电子围栏保护，多关节机械臂所有关节停止动作并产生报警，等待处理故障；如果未触发带电工况的保护***对多关节机械臂进行安全电子围栏保护，进入第六步；
第六步，如果触发带电工况的保护***对多关节机械臂进行异常状态急停保护，多关节机械臂所有关节停止动作并产生报警，等待处理故障；如果没有触发带电工况的保护***对多关节机械臂进行异常状态急停保护，多关节机械臂执行指令；
第七步，多关节机械臂执行过程中，如果检测触发上述某一步骤的保护，将跳转至该步骤，直至多关节机械臂执行完所有指令，保护结束。
本发明的有益技术效果：
本发明的基于多关节机械臂的安全控制***和方法，充分利用多种保护手段，实现多关节机械臂在蒸汽发生器水室内安全、高效地实施拆装及运动控制，有效缩短作业时间，同时多重保护方法的虚实结合，可防止机械臂本身的卡死及机械臂与蒸汽发生器产生的硬碰撞，保证了机械臂本体安全及核设备的安全，具有一定通用性，可推广应用到其它机电设备。
附图说明
图1为多关节机械臂拆装过程中安全控制***的保护流程图；
图2为多关节机械臂执行过程中安全控制***的保护流程图；
图3为多关节机械臂各关节机械限位保护装置和接近限位开关位置示意图；
图4为多关节机械臂各关节失电保持装置位置示意图。
图中，1、第一关节；2、第二关节；3、第三关节；4、第四关节；5、第五关节；6、第六关节；7、接近限位开关；8、机械限位保护装置；9、失电保持装置。
具体实施方式
下面结合附图和实施例对本发明做进一步详细地描述。
本发明提供一种基于多关节机械臂的安全控制***，包括带电工况的保护***、失电工况的保护***及任何工况下的保护***；所述带电工况的保护***在带电工况下对多关节机械臂相应关节进行接近开关限位保护、电机过载保护、电机力矩过大保护、异常状态急停保护、软件限位保护以及安全电子围栏保护；所述失电工况的保护***在失电工况下对多关节机械臂相应关节进行失电保持保护；所述任何工况下的保护***在任何工况下对多关节机械臂相应关节进行机械限位保护。
所述多关节机械臂是将传统的六转动副关节机器人中的将第四关节替换为滑动副，包括第一关节1、第二关节2、第三关节3、第四关节4、第五关节5和第六关节6，所述第一关节1、第二关节2和第三关节3依次连接组成球铰关节，所述第五关节5和第六关节6连接组成腕关节，所述球铰关节和腕关节通过第四关节4滑动副连接。
所述带电工况的保护***包括接近限位开关7、急停装置、力矩过大及过载保护装置、软件限位装置和安全电子围栏；所述多关节机械臂的各关节均配置接近限位开关7，触发关节上的接近限位开关7，所述带电工况的保护***控制相应关节上的电机停止运行并发出报警信号，防止误碰撞；所述急停装置设置在安全控制***的操作端，当出现异常时，按下急停装置，所述带电工况的保护***控制整个多关节机械臂停止运行，防止事故扩大；所述力矩过大及过载保护装置监控多关节机械臂的各关节电机电流及扭矩，当关节上的电机电流及扭矩超出安全范围，所述带电工况的保护***控制相应关节上的电机停止运行并发出报警信号，防止误碰撞；所述多关节机械臂的各关节均配置软件限位装置，所述软件限位装置反馈各关节电机当前位移，当关节电机当前位移超出安全范围，所述带电工况的保护***控制相应关节电机停止运行，防止误碰撞；所述安全电子围栏设置在安全控制***的软件端，安全电子围栏限制多关节机械臂的动作范围在安全电子围栏内，防止误碰撞。
所述软件限位装置为编码器，所述编码器反馈各关节电机当前位移，当关节电机当前位移超出安全范围，所述带电工况的保护***控制相应关节电机停止运行，防止误碰撞。
参见图3，所述第一关节1、第二关节2、第三关节3、第四关节4、第五关节5和第六关节6上分别配置2个、2个、1个、2个、2个和1个接近限位开关7；
所述第一关节1、第二关节2、第三关节3、第四关节4、第五关节5和第六关节6电机电流限制分别为12A、12A、12A、2A、1.5A和1.5A；
所述第一关节1、第二关节2、第三关节3、第四关节4、第五关节5和第六关节6电机扭矩限制分别为280Nm、250Nm、80Nm、250Nm、30Nm和80Nm；
所述第一关节1的软件限位装置反馈第一关节1电机180°方向位移，所述第二关节2的软件限位装置反馈第二关节2电机140°方向位移，所述第三关节33的软件限位装置反馈第三关节3电机720°方向位移，所述第四关节4的软件限位装置反馈第四关节4电机400mm处位移，所述第五关节5的软件限位装置反馈第五关节5电机40°方向位移，所述第六关节6的软件限位装置反馈第六关节6 360°方向位移。
参见图4，所述失电工况的保护***包括失电保持装置9，所述第一关节2和第四关节4均配置失电保持装置9，当多关节机械臂失电时抱闸保持使多关节机械臂以及多关节机械臂上的负载保持原位，防止自重导致的多关节机械臂动作而产生误碰撞。
所述任何工况下的保护***包括机械限位保护装置8，所述第一关节1、第一关节2、第三关节3、第四关节4和第五关节5均配置机械限位保护装置8，当多关节机械臂运动超出接近限位开关7限位时，限制多关节机械臂继续运动，直至电机堵转产生超扭矩或超电流致，触发电机过载保护或电机力矩过大保护使电机停止，防止机械臂关节卡死和误碰撞。
本发明还提供一种基于多关节机械臂的安全控制方法，包括如下步骤：
(1)、安全控制***未启动时，对多关节机械臂进行安装，失电工况的保护***控制多关节机械臂在失电工况下保持原位；任何工况下的保护***机械限位保护多关节机械臂，防止安装过程中多关节机械臂乱动作导致误碰撞；
(2)、安全控制***启动后，在多关节机械臂执行过程中，带电工况的保护***接近开关限位、电机电流过载保护、电机力矩过大保护、异常状态急停、软件限位以及安全电子围栏保护多关节机械臂；任何工况下的保护***机械限位保护多关节机械臂；如果操作过程中意外断电，失电工况的保护***控制多关节机械臂保持原位，防止误碰撞；
(3)、操作完毕后断电，对多关节机械臂进行拆卸，失电工况的保护***控制多关节机械臂保持原位，任何工况下的保护***机械限位保护多关节机械臂，防止拆卸过程中多关节机械臂乱动作导致误碰撞。
参见图1，所述多关节机械臂拆装过程中，安全控制***进行如下保护流程：安全控制***均保持断电状态，失电工况的保护***和任何工况下的保护***进入保护状态，第一关节2和第四关节4进入保持状态，防止机械臂因为自重而下坠，如过程中触发某关节机械限位，该关节将停止继续动作，防止机械臂与蒸汽发生器碰撞。
参见图2，所述多关节机械臂执行过程中，安全控制***进行如下保护流程：
第一步，多关节机械臂执行指令，安全控制***保护开始；如果安全控制***断电，触发失电工况的保护***失电保护，第一关节2和第四关节4立即进入保持状态，等待处理故障，如果安全控制***有电，进入第二步安全检测；
第二步，如果触发某关节机械限位保护，对应电机将堵转，从而触发电机力矩过大保护或者电机电流过载保护，该关节停止动作并产生报警，等待处理故障，如未触发机械限位保护，进入第三步安全检测；
第三步，如果触发某关节接近限位开关7保护，该关节停止动作并产生报警，等待处理故障，如未触发接近限位开关7保护，进入第四步安全检测；
第四步，如果触发某关节电机力矩过大保护或电机电流过载保护，该关节停止动作并产生报警，等待处理故障，如未触发电机力矩过大保护或电机电流过载保护，进入第五步安全检测；
第五步，如果触发安全控制***安全电子围栏保护，所有关节停止动作并产生报警，等待处理故障，如未触发安全控制***安全电子围栏保护，进入第六步安全检测；
第六步，如果触发安全控制***异常状态急停保护，所有关节停止动作并产生报警，等待处理故障，如未触发安全控制***异常状态急停保护，标示安全控制***安全，多关节机械臂可执行指令；
第七步，多关节机械臂执行过程中，如果检测触发上述某一步骤的保护，将跳转至该步骤，直至多关节机械臂执行完所有指令，保护结束。
以上所述实施例仅表达了本发明的几种实施方式，其描述较为具体和详细，但并不能因此而理解为对本发明专利范围的限制。应当指出的是，对于本领域的普通技术人员来说，在不脱离本发明构思的前提下，还可以做出若干变形和改进，这些都属于本发明的保护范围。因此，本发明专利的保护范围应以所附权利要求为准。

Claims (10)

1.一种基于多关节机械臂的安全控制***，其特征在于，包括带电工况的保护***、失电工况的保护***及任何工况下的保护***；所述带电工况的保护***在带电工况下对多关节机械臂相应关节进行接近开关限位保护、电机过载保护、电机力矩过大保护、异常状态急停保护、软件限位保护以及安全电子围栏保护；所述失电工况的保护***在失电工况下对多关节机械臂相应关节进行失电保持保护；所述任何工况下的保护***在任何工况下对多关节机械臂相应关节进行机械限位保护；
安全控制***未启动时，对多关节机械臂进行安装，失电工况的保护***控制多关节机械臂在失电工况下保持原位；任何工况下的保护***机械限位保护多关节机械臂；
安全控制***启动后，在多关节机械臂执行过程中，带电工况的保护***接近开关限位、电机电流过载保护、电机力矩过大保护、异常状态急停、软件限位以及安全电子围栏保护多关节机械臂；任何工况下的保护***机械限位保护多关节机械臂；如果操作过程中意外断电，失电工况的保护***控制多关节机械臂保持原位；
操作完毕后断电，对多关节机械臂进行拆卸，失电工况的保护***控制多关节机械臂保持原位，任何工况下的保护***机械限位保护多关节机械臂。
2.根据权利要求1所述的基于多关节机械臂的安全控制***，其特征在于，所述多关节机械臂包括第一关节(1)、第二关节(2)、第三关节(3)、第四关节(4)、第五关节(5)和第六关节(6)，所述第一关节(1)、第二关节(2)和第三关节(3)依次连接组成球铰关节，所述第五关节(5)和第六关节(6)连接组成腕关节，所述球铰关节和腕关节通过第四关节(4)滑动副连接。
3.根据权利要求2所述的基于多关节机械臂的安全控制***，其特征在于，所述带电工况的保护***包括接近限位开关(7)、急停装置、力矩过大及过载保护装置、软件限位装置和安全电子围栏；所述多关节机械臂的各关节均配置接近限位开关(7)，触发关节上的接近限位开关(7)，所述带电工况的保护***控制相应关节上的电机停止运行并发出报警信号；所述急停装置设置在安全控制***的操作端，当出现异常时，按下急停装置，所述带电工况的保护***控制整个多关节机械臂停止运行；所述力矩过大及过载保护装置监控多关节机械臂的各关节电机电流及扭矩，当关节上的电机电流及扭矩超出安全范围，所述带电工况的保护***控制相应关节上的电机停止运行并发出报警信号；所述多关节机械臂的各关节均配置软件限位装置，所述软件限位装置反馈各关节电机当前位移，当关节电机当前位移超出安全范围，所述带电工况的保护***控制相应关节电机停止运行；所述安全电子围栏设置在安全控制***的软件端，安全电子围栏限制多关节机械臂的动作范围在安全电子围栏内。
4.根据权利要求3所述的基于多关节机械臂的安全控制***，其特征在于，所述软件限位装置为编码器，所述编码器反馈各关节电机当前位移，当关节电机当前位移超出安全范围，所述带电工况的保护***控制相应关节电机停止运行。
5.根据权利要求3所述的基于多关节机械臂的安全控制***，其特征在于，所述第一关节(1)、第二关节(2)、第三、第四关节(4)、第五关节(5)和第六关节(6)上分别配置2个、2个、1个、2个、2个和1个接近限位开关(7)；所述第一关节(1)、第二关节(2)、第三关节(3)、第四关节(4)、第五关节(5)和第六关节(6)电机电流限制分别为12A、12A、12A、2A、1.5A和1.5A；所述第一关节(1)、第二关节(2)、第三关节(3)、第四关节(4)、第五关节(5)和第六关节(6)电机扭矩限制分别为280Nm、250Nm、80Nm、250Nm、30Nm和80Nm；所述第一关节(1)、第二关节(2)、第三关节(3)、第四关节(4)、第五关节(5)和第六关节(6)的软件限位装置分别反馈第一关节(1)电机180°方向位移，所述第二关节(2)的软件限位装置反馈第二关节(2)电机140°方向位移，所述第三关节(3)的软件限位装置反馈第三关节(3)电机720°方向位移，所述第四关节(4)的软件限位装置反馈第四关节(4)电机400mm处位移，所述第五关节(5)的软件限位装置反馈第五关节(5)电机40°方向位移，所述第六关节(6)的软件限位装置反馈第六关节(6)360°方向位移。
6.根据权利要求2所述的基于多关节机械臂的安全控制***，其特征在于，所述失电工况的保护***包括失电保持装置(9)，所述第二关节(2)和第四关节(4)均配置失电保持装置(9)，当多关节机械臂失电时抱闸保持使多关节机械臂以及多关节机械臂上的负载保持原位。
7.根据权利要求2所述的基于多关节机械臂的安全控制***，其特征在于，所述任何工况下的保护***包括机械限位保护装置(8)，所述第一关节(1)、第二关节(2)、第三关节(3)、第四关节(4)和第五关节(5)均配置机械限位保护装置(8)，当多关节机械臂运动超出接近限位开关(7)限位时，限制多关节机械臂继续运动，直至电机堵转产生超扭矩或超电流致，触发电机过载保护或电机力矩过大保护使电机停止。
8.一种基于多关节机械臂的安全控制方法，其特征在于，使用权利要求1-7任意一项所述的基于多关节机械臂的安全控制***，包括如下步骤：
(1)、安全控制***未启动时，对多关节机械臂进行安装，失电工况的保护***控制多关节机械臂在失电工况下保持原位；任何工况下的保护***机械限位保护多关节机械臂；
(2)、安全控制***启动后，在多关节机械臂执行过程中，带电工况的保护***接近开关限位、电机电流过载保护、电机力矩过大保护、异常状态急停、软件限位以及安全电子围栏保护多关节机械臂；任何工况下的保护***机械限位保护多关节机械臂；如果操作过程中意外断电，失电工况的保护***控制多关节机械臂保持原位；
(3)、操作完毕后断电，对多关节机械臂进行拆卸，失电工况的保护***控制多关节机械臂保持原位，任何工况下的保护***机械限位保护多关节机械臂。
9.根据权利要求8所述的基于多关节机械臂的安全控制方法，其特征在于，所述多关节机械臂拆装过程中，安全控制***进行如下保护流程：安全控制***保持断电状态，失电工况的保护***和任何工况下的保护***进入保护状态，多关节机械臂相应关节进入保持状态，如过程中触发多关节机械臂某关节机械限位保护，该关节将停止继续动作。
10.根据权利要求8所述的基于多关节机械臂的安全控制方法，其特征在于，所述多关节机械臂执行过程中，安全控制***进行如下保护流程：
第一步，多关节机械臂执行指令，安全控制***开始对多关节机械臂进行安全保护；如果安全控制***断电，触发失电工况的保护***对多关节机械臂相应关节进行失电保持保护，多关节机械臂相应关节保持原位，等待处理故障；如果安全控制***有电，进入第二步；
第二步，如果触发任何工况的保护***对多关节机械臂相应关节进行机械限位保护，多关节机械臂相应关节电机堵转，从而触发多关节机械臂相应关节电机力矩过大保护或者电机电流过载保护，多关节机械臂相应关节停止动作并产生报警，等待处理故障；如果未触发任何工况的保护***对多关节机械臂相应关节进行机械限位保护，进入第三步；
第三步，如果触发带电工况的保护***对多关节机械臂相应关节进行接近限位开关(7)保护，多关节机械臂相应关节停止动作并产生报警，等待处理故障；如果未触发带电工况的保护***对多关节机械臂相应关节进行接近限位开关(7)保护，进入第四步；
第四步，如果触发带电工况的保护***对多关节机械臂相应关节电机力矩过大保护或电机电流过载保护，多关节机械臂相应关节停止动作并产生报警，等待处理故障；如果未触发多关节机械臂相应关节电机力矩过大保护或电机电流过载保护，进入第五步；
第五步，如果触发带电工况的保护***对多关节机械臂进行安全电子围栏保护，多关节机械臂所有关节停止动作并产生报警，等待处理故障；如果未触发带电工况的保护***对多关节机械臂进行安全电子围栏保护，进入第六步；
第六步，如果触发带电工况的保护***对多关节机械臂进行异常状态急停保护，多关节机械臂所有关节停止动作并产生报警，等待处理故障；如果没有触发带电工况的保护***对多关节机械臂进行异常状态急停保护，多关节机械臂执行指令；
第七步，多关节机械臂执行过程中，如果检测触发上述某一步骤的保护，将跳转至该步骤，直至多关节机械臂执行完所有指令，保护结束。
CN202111655603.1A 2021-12-31 2021-12-31 一种基于多关节机械臂的安全控制***和方法 Active CN114347021B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111655603.1A CN114347021B (zh) 2021-12-31 2021-12-31 一种基于多关节机械臂的安全控制***和方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111655603.1A CN114347021B (zh) 2021-12-31 2021-12-31 一种基于多关节机械臂的安全控制***和方法

Publications (2)

Publication Number Publication Date
CN114347021A CN114347021A (zh) 2022-04-15
CN114347021B true CN114347021B (zh) 2024-01-12

Family

ID=81102625

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111655603.1A Active CN114347021B (zh) 2021-12-31 2021-12-31 一种基于多关节机械臂的安全控制***和方法

Country Status (1)

Country Link
CN (1) CN114347021B (zh)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH10329081A (ja) * 1997-05-27 1998-12-15 Yaskawa Electric Corp ロボットの動作制限装置及び方法
EP2113344A1 (de) * 2008-04-30 2009-11-04 KUKA Roboter GmbH Verfahren und Vorrichtung zur Überwachung eines Manipulators
CN109605344A (zh) * 2019-01-09 2019-04-12 北京精密机电控制设备研究所 一种多自由度开环步进串联机械臂及其控制方法
CN111728820A (zh) * 2020-07-10 2020-10-02 上海电气集团股份有限公司 一种用于康复设备的安全保护***
CN113103281A (zh) * 2021-01-20 2021-07-13 朱少强 一种具有过载保护装置的柔性机器人

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2007111749A2 (en) * 2005-12-20 2007-10-04 Intuitive Surgical, Inc. Method for handling an operator command exceeding a medical device state limitation in a medical robotic system
WO2020200387A1 (en) * 2019-04-02 2020-10-08 Universal Robots A/S Robot arm safety system with runtime adaptable safety limits

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH10329081A (ja) * 1997-05-27 1998-12-15 Yaskawa Electric Corp ロボットの動作制限装置及び方法
EP2113344A1 (de) * 2008-04-30 2009-11-04 KUKA Roboter GmbH Verfahren und Vorrichtung zur Überwachung eines Manipulators
CN109605344A (zh) * 2019-01-09 2019-04-12 北京精密机电控制设备研究所 一种多自由度开环步进串联机械臂及其控制方法
CN111728820A (zh) * 2020-07-10 2020-10-02 上海电气集团股份有限公司 一种用于康复设备的安全保护***
CN113103281A (zh) * 2021-01-20 2021-07-13 朱少强 一种具有过载保护装置的柔性机器人

Also Published As

Publication number Publication date
CN114347021A (zh) 2022-04-15

Similar Documents

Publication Publication Date Title
US9914221B2 (en) Teleoperation of machines having at least one actuated mechanism and a fault detection and recovery system
DE10361132B4 (de) Verfahren zur Überwachung der Bewegung eines sich in mehreren Freiheitsgraden bewegenden Gefahr bringenden Objektes eines Handhabungsgerätes, wie Handhabungsmasse und/oder bewegliche Masse
KR100553274B1 (ko) 여러개의기능적인유니트(units)을가지는공장을감시하기위한방법및장치
CN206509716U (zh) 大型风电设备大螺栓大螺母机器人自动把紧***
JP2001525263A (ja) 高い安全性が要求される技術設備、特にマニピュレータの監視のための監視・制御装置及び方法
CN106475770A (zh) 大型风电设备大螺栓大螺母机器人自动把紧***
CN114347021B (zh) 一种基于多关节机械臂的安全控制***和方法
CN206717867U (zh) 风电轮毂螺栓机器人自动把紧***
CN115021389A (zh) 一种工业机器人断电自我保护方法
US20110295422A1 (en) Method and device for controlling a manipulator system
CN106298303A (zh) 自动分闸装置
CN113894778A (zh) 一种用于灵巧手伺服***及其故障检测、控制保护方法
CN109176606B (zh) 一种六轴机器人一轴的二次保护装置
CN110303468A (zh) 一种双体机器人就地操作高压断路器分合闸方法及***
CN107538486B (zh) 一种关节力控制平台装置、方法及相关装置
CN213971215U (zh) 一种室内消防机器人消防作业机械臂
CN215149145U (zh) 一种巡检机器人
Cui et al. Robotics Safety: An Engineering Teaching Module
US20190015987A1 (en) Arrangement Comprising an Automatic Movement Machine and a Delimiting Device, Delimiting Device for the Arrangement, and Method for Operating the Arrangement
Yu et al. Design of a robot for live-line repairing of transmission line
WO1991009354A1 (en) Protection device in automatic production equipments
Owen Safety
Zeng et al. Application of robot in handling electric field short-circuit fault of electrostatic precipitator without stopping
JPS6250906A (ja) 産業用ロボツトの制御装置
KR102593280B1 (ko) 폐필터 인출 장치의 지령 장치 및 이를 구비하는 제어 시스템

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant