CN111331619B - 机器人的安全控制设备及机器人的控制方法、机器人 - Google Patents
机器人的安全控制设备及机器人的控制方法、机器人 Download PDFInfo
- Publication number
- CN111331619B CN111331619B CN202010340781.4A CN202010340781A CN111331619B CN 111331619 B CN111331619 B CN 111331619B CN 202010340781 A CN202010340781 A CN 202010340781A CN 111331619 B CN111331619 B CN 111331619B
- Authority
- CN
- China
- Prior art keywords
- controller
- robot
- safety
- safety loop
- loop
- 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
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
-
- 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/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Manipulator (AREA)
- Safety Devices In Control Systems (AREA)
Abstract
本申请公开了一种机器人的安全控制设备及机器人的控制方法、机器人。其中,该安全控制设备包括:第一控制器、第二控制器、第一安全回路及第二安全回路,其中,第一控制器和第二控制器中任意一个控制器与第一安全回路和第二安全回路连接,用于判断来自机器人外部的报警信号的类型,并控制第一安全回路和第二安全回路执行与报警信号的类型对应的控制指令,第一安全回路与第二安全回路的逻辑相反。本申请解决了机器人的保护性停止电路存在电路同质化严重,存在安全隐患的技术问题。
Description
技术领域
本申请涉及机器人控制领域,具体而言,涉及一种机器人的安全控制设备及机器人的控制方法、机器人。
背景技术
工业机器安全要求机器人应该具有一个或多个保护性停止电路,此停止电路应通过停止的机器人所有运动、撤除机器人驱动器的动力,中止可由机器人***控制的任何其他危险等方式来控制其安全防护的风险。停止功能可由手动或者控制逻辑启动。
在现有的技术中,一般的做法是将具有相同功能的安全模块复制一份,两个模块互为备份,当出现安全告警信号时,两个安全模块同时响应,切断机器人的动力源,当出现一路失效时,另外一路能够响应告警信号。但这种保护性停止电路存在电路同质化严重,存在安全隐患的问题。
针对上述的问题,目前尚未提出有效的解决方案。
发明内容
本申请实施例提供了一种机器人的安全控制设备及机器人的控制方法、机器人,以至少解决机器人的保护性停止电路存在电路同质化严重,存在安全隐患的技术问题。
根据本申请实施例的一个方面,提供了一种机器人的安全控制设备,包括:第一控制器、第二控制器、第一安全回路及第二安全回路,其中,第一控制器和第二控制器中任意一个控制器与第一安全回路和第二安全回路连接,用于判断来自机器人外部的报警信号的类型,并控制第一安全回路和第二安全回路执行与报警信号的类型对应的控制指令,第一安全回路与第二安全回路的逻辑相反。
可选地,第一控制器和第二控制器之间包括第一通信链路,第一控制器和第二控制器通过第一通信链路校验第一安全回路和第二安全回路返回的数据是否存在时序误差,如果第一安全回路和第二安全回路返回的数据存在时序误差,控制断开第一安全回路和第二安全回路,并发送第一报警信息。
可选地,第一通信链路为第一控制器和第二控制器的串行外设接口之间的通信链路。
可选地,第一控制器和第二控制器之间还包括第二通信链路,第一控制器和第二控制器分别通过第二通信链路向对方发送预设字节的数据,如果第一控制器和第二控制器中的任意一方未接收到对方发送的预设字节的数据,控制断开第一安全回路和第二安全回路,并发送第二报警信息。
可选地,第二通信链路为第一控制器和第二控制器的输入/输出接口之间的通信链路。
可选地,第一控制器和第二控制器还用于执行如下控制操作:如果报警信号的类型为第一类型,控制第一安全回路和第二安全回路同时断开,切断机器人的供电电源;如果报警信号的类型为第二类型,将报警信号发送至机器人的控制器;在机器人的控制器控制机器人减速行驶直至机器人停止行驶后,控制第一安全回路和第二安全回路同时断开,切断机器人的供电电源;如果报警信号的类型为第三类型,将报警信号发送至机器人的控制器,机器人的控制器控制机器人减速行驶直至机器人停止行驶。
可选地,第一安全回路和第二安全回路中任意一个安全回路包括一个安全继电器和两个场效应管,其中,两个安全继电器的常开触点均连接第一控制器和第二控制器,第一控制器和第二控制器通过常开触点监控两个安全继电器的运行状态;第一安全回路的两个场效应管为PMOS场效应管,第二安全回路的两个场效应管为NMOS场效应管。
可选地,第一控制器和第二控制器的型号不同。
根据本申请实施例的另一方面,还提供了一种机器人,机器人包括:控制器;以及以上的安全控制设备。
根据本申请实施例的另一方面,还提供了一种机器人的控制方法,包括:第一控制器和第二控制器获取来自机器人外部的报警信号,并判断报警信号的类型;第一控制器和第二控制器控制第一安全回路和第二安全回路执行与报警信号的类型对应的控制指令,第一控制器和第二控制器中任意一个控制器与第一安全回路和第二安全回路连接,第一安全回路与第二安全回路的逻辑相反。
可选地,第一控制器和第二控制器控制第一安全回路和第二安全回路执行与报警信号的类型对应的控制指令,包括:如果报警信号的类型为第一类型,控制第一安全回路和第二安全回路同时断开,切断机器人的供电电源;如果报警信号的类型为第二类型,将报警信号发送至机器人的控制器;在机器人的控制器控制机器人减速运行直至机器人停止运行后,控制第一安全回路和第二安全回路同时断开,切断机器人的供电电源;如果报警信号的类型为第三类型,将报警信号发送至机器人的控制器,机器人的控制器控制机器人减速行驶直至机器人停止行驶。
根据本申请实施例的再一方面,还提供了一种存储介质,存储介质包括存储的程序,其中,在程序运行时控制存储介质所在设备执行以上的机器人的控制方法。
根据本申请实施例的再一方面,还提供了一种处理器,处理器用于运行存储在存储器中的程序,其中,程序运行时执行以上的机器人的控制方法。
在本申请实施例中,提供了一种机器人的安全控制设备,包括:第一控制器、第二控制器、第一安全回路及第二安全回路,其中,第一控制器和第二控制器中任意一个控制器与第一安全回路和第二安全回路连接,用于判断来自机器人外部的报警信号的类型,并控制第一安全回路和第二安全回路执行与报警信号的类型对应的控制指令,第一安全回路与第二安全回路的逻辑相反,本申请提供的安全控制设备采用双CPU控制正反逻辑的双安全回路设计,达到了避免了机器人的安全电路与备份安全电路同质化失效的问题,从而实现了提高机器人运行的稳定性及安全性的技术效果,进而解决了机器人的保护性停止电路存在电路同质化严重,存在安全隐患技术问题。
附图说明
此处所说明的附图用来提供对本申请的进一步理解,构成本申请的一部分,本申请的示意性实施例及其说明用于解释本申请,并不构成对本申请的不当限定。在附图中:
图1是根据本申请实施例的一种机器人的安全控制设备的结构图;
图2是根据本申请实施例的另一种机器人的安全控制设备的结构图;
图3是根据本申请实施例的另一种机器人的安全控制设备的结构图;
图4是根据本申请实施例的一种安全回路的电路图;
图5是根据本申请实施例的一种机器人的结构图;
图6是根据本申请实施例的一种机器人的控制方法的流程图。
具体实施方式
为了使本技术领域的人员更好地理解本申请方案,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分的实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本申请保护的范围。
需要说明的是,本申请的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换,以便这里描述的本申请的实施例能够以除了在这里图示或描述的那些以外的顺序实施。此外,术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、***、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
根据本申请实施例,提供了一种机器人的安全控制设备的实施例,需要说明的是,在附图的流程图示出的步骤可以在诸如一组计算机可执行指令的计算机***中执行,并且,虽然在流程图中示出了逻辑顺序,但是在某些情况下,可以以不同于此处的顺序执行所示出或描述的步骤。
图1是根据本申请实施例的一种机器人的安全控制设备的结构图,如图1所示,该安全控制设备包括:
第一控制器10、第二控制器12、第一安全回路14及第二安全回路16,其中,第一控制器10和第二控制器12中任意一个控制器与第一安全回路14和第二安全回路16连接,用于判断来自机器人外部的报警信号的类型,并控制第一安全回路14和第二安全回路16执行与报警信号的类型对应的控制指令,第一安全回路14与第二安全回路16的逻辑相反。
根据本申请的一个可选的实施例,第一控制器10和第二控制器12的型号不同。
在具体实施时,第一控制器10和第二控制器12采用不同厂家的不同型号的CPU,也可以避免电路同质化失效的问题。
如图1所示,第一控制器10和第二控制器12均与第一安全回路14第二安全回路16连接,用于判断各个安全输入信号的状态,监测安全回路的状态,当检测到机器人处于异常状态时,可以控制安全回路中的MOS管,断开安全回路,切断机器人的供电电源。
通过上述安全控制设备,采用双CPU控制正反逻辑的双安全回路设计,达到了避免了机器人的安全电路与备份安全电路同质化失效的问题,从而实现了提高机器人运行的稳定性及安全性的技术效果。
图2是根据本申请实施例的另一种机器人的安全控制设备的结构图,如图2所示,第一控制器10和第二控制器12之间包括第一通信链路18,第一控制器10和第二控制器12通过第一通信链路18校验第一安全回路14和第二安全回路16返回的数据是否存在时序误差,如果第一安全回路14和第二安全回路16返回的数据存在时序误差,控制断开第一安全回路14和第二安全回路16,并发送第一报警信息。
根据本申请的一个可选的实施例,第一通信链路18为第一控制器10和第二控制器12的串行外设接口之间的通信链路。
为了避免两个安全回路上有时序上的误差,两个控制器之间通过SPI进行相互校验,校验两个安全回路发送至两个控制器的数据是否存在时序误差。如果存在时序误差,控制第一安全回路和第二安全回路均断开,并且发送报警信息。发送语音报警信息可以通过语音播报,或者通过RS485将报警信息发送至与控制器通信连接的终端设备。通过上述时序校验过程,可以避免两个安全回路存在时序误差。
图3是根据本申请实施例的另一种机器人的安全控制设备的结构图,如图3所示,第一控制器10和第二控制器12之间还包括第二通信链路110,第一控制器10和第二控制器12分别通过第二通信链路110向对方发送预设字节的数据,如果第一控制器10和第二控制器12中的任意一方未接收到对方发送的预设字节的数据,控制断开第一安全回路14和第二安全回路16,并发送第二报警信息。
根据本申请的一个可选的实施例,第二通信链路110为第一控制器10和第二控制器12的输入/输出接口之间的通信链路。
两个控制器有一个通过IO接口直接相连的通信链路,两个控制器通过该通信链路定时发送固定字节的数据,若其中一方无法收到对方发送的数,则立马进入保护状态。具体的,控制断开两个安全回路,并发送报警信息。发送语音报警信息可以通过语音播报,或者将报警信息发送至与控制器通信连接的用户终端。
由于本申请提供的的安全控制设备必须在两个CPU均正常工作的情况下,该安全设备才能正常工作,因此通过上述方法实施检测两个CPU的运行状态,可以提高安全控制设备运行的稳定性。
在本申请的一些可选的实施例中,第一控制器10和第二控制器12还用于执行如下控制操作:如果报警信号的类型为第一类型,控制第一安全回路14和第二安全回路16同时断开,切断机器人的供电电源;如果报警信号的类型为第二类型,将报警信号发送至机器人的控制器;在机器人的控制器控制机器人减速行驶直至机器人停止行驶后,控制第一安全回路14和第二安全回路16同时断开,切断机器人的供电电源;如果报警信号的类型为第三类型,将报警信号发送至机器人的控制器,机器人的控制器控制机器人减速行驶直至机器人停止行驶。
根据国标要求并且结合机器人安全模块的具体设计,根据机器人是否能够可控停止分为以下三种停止方式:
0类:外部突然断电或急停信号有效,切断机器人动力源或者触发自由停止或抱闸停止,属于不可控停止;
1类:使机器人快速停止,保持当前规划路径,当机器人停止后,切断机器人动力源,属于可控停止;
2类:使机器人快速停止,保持当前规划路径,当机器人停止后,控制驱动器,不切断机器人动力源,属于可控停止。
本申请提供的上述工业机器人的安全控制设备能够直接应用在工业机器人上,并对外部输入的安全信号进行分类,当出现0类报警信号(上述第一类型的报警信号)时,安全模块能够在软件不控制的情况下直接通过硬件切断机器人动力源,避免因为软件处理出错而导致安全回路故障;出现1类报警信号(上述第二类型的报警信号)时,能够通过软件断开安全回路,断开机器人动力源;发生2类报警信号(上述第三类型的报警信号)时,安全控制设备将报警信息上传至机器人的控制器,机器人控制器控制机器人减速停止。
根据本申请的一个可选的实施例,第一安全回路14和第二安全16中任意一个安全回路包括一个安全继电器和两个场效应管,其中,两个安全继电器的常开触点均连接第一控制器和第二控制器,第一控制器和第二控制器通过常开触点监控两个安全继电器的运行状态;第一安全回路的两个场效应管为PMOS场效应管,第二安全回路的两个场效应管为NMOS场效应管。
图4是根据本申请实施例的一种安全回路的电路图,K11和K12为安全继电器,带强制导向触点,为了保证安全回路的状态,将安全继电器的一组常开触点接回第一控制器10和第二控制器12,用于监控安全继电器的状态,避免安全继电器的触点粘连。将安全继电器辅助触点上的信号反馈回控制器,进而实现对安全继电器的监控可以保证安全回路安全可靠地运行。
机器人的安全接口的安全信号如下表所示,安全接口上包括电源、安全输入和安全输出信号。
其中,安全输入信号包括:安全门、示教器急停1、示教器急停2、外部急停1、外部急停2、限位开关。
急停处理流程:当有急停信号产生时,如示教器急停、外部急停,断开安全回路,则断开了两个安全继电器的线圈,此时安全继电器的常闭触点断开,常开触点闭合,动作信号会通过光耦传导两个控制器,两个控制器会将信号传输到伺服驱动器,伺服驱动器进行减速。安全继电器的输出通过继电器直接断开伺服驱动器的主回路电源用来达到紧急制动的目的。
SAFE_OUT1+和SAFE_OUT1-、SAFE_OUT2+和SAFE_OUT2-属于安全输出信号,Q15、Q16为PMOS,Q14、Q18为NMOS管,避免电路的同质化,提高可靠性,安全输出信号按照以下方式连接:一般常规设计多采用一种类型的MOS管设计方案,未见有两种器件和逻辑类型的设计方案,因为当器件发生失效等故障时有效避免和降低了因一种类型器件(MOS管)失效的带来的故障风险。本申请采用的MOS管方案,使用两种不同类型的开关器件,一种是NMOS管(高电平有效),一种是PMOS管(低电平有效),这是两种不同逻辑控制的方案,在软件逻辑上也起到了互检和保护的作用,避免使用一种控制逻辑导致发生错误的高风险,从而起到更好的安全控制。用安全输出信号直接控制伺服驱动器上的交流接触器,交流接触器在发生0类报警(非外部断电的情况)时断开伺服驱动器的驱动源。只有在两个回路都正常的情况下才能够安全输出才能够正常工作。
其他信号处理流程:
安全门:安全门信号属于1类停止信号,当安全控制设备收到安全门信号时,将安全报警信号发送给机器人控制器,控制器通知伺服模块减速运行,然后再将信号返回给安全控制设备,安全控制设备断开安全回路,切断伺服驱动动力源。
限位信号:限位信号属于2类停止信号,当安全模块收到安全门信号时,将安全报警信号发送给机器人控制器,控制器通知伺服模块减速运行,然后再将信号返回给安全模块,安全输出不断开伺服驱动器动力源,手动将机器人移回安全区域内后可清除报警信号。
其他告警信号属于2类停止信号,安全控制器接收到此类信号时,伺服驱动器减速停止,不断开使能信号,报警消除后可继续保持当前轨迹进行运动。
本申请实施例提供的安全控制设备,不需要增加额外的PLC控制模块,占用空间小,便于接线和安装,可以满足紧凑型控制柜的安装需求;采用软件与硬件相结合控制的方案,软硬件均能控制断开安全回路,在紧急情况下不需要软件参与,能够使用硬件断开伺服驱动器主电源,可以保证工业机器人的安全可靠地运行;此外,还可以实现对输入机器人的告警信号进行分类处理。
图5是根据本申请实施例的一种机器人的结构图,如图5所示,该机器人包括:控制器50;以及以上的安全控制设备52。
为了避免机器人控制器50电源故障导致安全控制设备52的安全回路失效,安全控制设备52中安全回路使用的24V电源必须与机器人控制器50使用24V电源不同。
需要说明的是,图5所示实施例的优选实施方式可以参见图1所示实施例的相关描述,此处不再赘述。
图6是根据本申请实施例的一种机器人的控制方法的流程图,如图6所示,该方法包括以下步骤:
步骤S602,第一控制器和第二控制器获取来自机器人外部的报警信号,并判断报警信号的类型。
步骤S604,第一控制器和第二控制器控制第一安全回路和第二安全回路执行与报警信号的类型对应的控制指令,第一控制器和第二控制器中任意一个控制器与第一安全回路和第二安全回路连接,第一安全回路与第二安全回路的逻辑相反。
根据本申请的一个可选的实施例,步骤S604可以通过以下方法实现:如果报警信号的类型为第一类型,控制第一安全回路和第二安全回路同时断开,切断机器人的供电电源;如果报警信号的类型为第二类型,将报警信号发送至机器人的控制器;在机器人的控制器控制机器人减速运行直至机器人停止运行后,控制第一安全回路和第二安全回路同时断开,切断机器人的供电电源;如果报警信号的类型为第三类型,将报警信号发送至机器人的控制器,机器人的控制器控制机器人减速行驶直至机器人停止行驶。
需要说明的是,图6所示实施例的优选实施方式可以参见图1所示实施例的相关描述,此处不再赘述。
本申请实施例还提供了一种存储介质,存储介质包括存储的程序,其中,在程序运行时控制存储介质所在设备执行以上的机器人的控制方法。
存储介质用于存储执行以下功能的程序:第一控制器和第二控制器获取来自机器人外部的报警信号,并判断报警信号的类型;第一控制器和第二控制器控制第一安全回路和第二安全回路执行与报警信号的类型对应的控制指令,第一控制器和第二控制器中任意一个控制器与第一安全回路和第二安全回路连接,第一安全回路与第二安全回路的逻辑相反。
本申请实施例还提供了一种处理器,处理器用于运行存储在存储器中的程序,其中,程序运行时执行以上的机器人的控制方法。
处理器用于运行执行以下功能的程序:第一控制器和第二控制器获取来自机器人外部的报警信号,并判断报警信号的类型;第一控制器和第二控制器控制第一安全回路和第二安全回路执行与报警信号的类型对应的控制指令,第一控制器和第二控制器中任意一个控制器与第一安全回路和第二安全回路连接,第一安全回路与第二安全回路的逻辑相反。
上述本申请实施例序号仅仅为了描述,不代表实施例的优劣。
在本申请的上述实施例中,对各个实施例的描述都各有侧重,某个实施例中没有详述的部分,可以参见其他实施例的相关描述。
在本申请所提供的几个实施例中,应该理解到,所揭露的技术内容,可通过其它的方式实现。其中,以上所描述的装置实施例仅仅是示意性的,例如所述单元的划分,可以为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个***,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,单元或模块的间接耦合或通信连接,可以是电性或其它的形式。
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
另外,在本申请各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。
所述集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本申请的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的全部或部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可为个人计算机、服务器或者网络设备等)执行本申请各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、只读存储器(ROM,ReGREEd-Only Memory)、随机存取存储器(RGREEM,RGREEndom GREEccess Memory)、移动硬盘、磁碟或者光盘等各种可以存储程序代码的介质。
以上所述仅是本申请的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本申请原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本申请的保护范围。
Claims (11)
1.一种机器人的安全控制设备,其特征在于,包括:第一控制器、第二控制器、第一安全回路及第二安全回路,其中,
所述第一控制器和所述第二控制器中任意一个控制器与所述第一安全回路和所述第二安全回路连接,用于判断来自机器人外部的报警信号的类型,并控制所述第一安全回路和所述第二安全回路执行与所述报警信号的类型对应的控制指令,所述第一安全回路与所述第二安全回路的逻辑相反;
所述第一安全回路和所述第二安全回路中任意一个安全回路包括一个安全继电器和两个场效应管,其中,两个安全继电器的常开触点均连接所述第一控制器和所述第二控制器,所述第一控制器和所述第二控制器通过所述常开触点监控所述两个安全继电器的运行状态;所述第一安全回路的两个场效应管为PMOS场效应管,所述第二安全回路的两个场效应管为NMOS场效应管;
所述第一控制器和所述第二控制器之间包括第一通信链路,所述第一控制器和所述第二控制器通过所述第一通信链路校验所述第一安全回路和所述第二安全回路返回的数据是否存在时序误差,如果所述第一安全回路和所述第二安全回路返回的数据存在时序误差,控制断开所述第一安全回路和所述第二安全回路,并发送第一报警信息。
2.根据权利要求1所述的设备,其特征在于,所述第一通信链路为所述第一控制器和所述第二控制器的串行外设接口之间的通信链路。
3.根据权利要求1所述的设备,其特征在于,所述第一控制器和所述第二控制器之间还包括第二通信链路,所述第一控制器和所述第二控制器分别通过所述第二通信链路向对方发送预设字节的数据,如果所述第一控制器和所述第二控制器中的任意一方未接收到对方发送的所述预设字节的数据,控制断开所述第一安全回路和所述第二安全回路,并发送第二报警信息。
4.根据权利要求3所述的设备,其特征在于,所述第二通信链路为所述第一控制器和所述第二控制器的输入/输出接口之间的通信链路。
5.根据权利要求1所述的设备,其特征在于,所述第一控制器和所述第二控制器还用于执行如下控制操作:
如果所述报警信号的类型为第一类型,控制所述第一安全回路和所述第二安全回路同时断开,切断所述机器人的供电电源;
如果所述报警信号的类型为第二类型, 将所述报警信号发送至所述机器人的控制器;在所述机器人的控制器控制所述机器人减速行驶直至所述机器人停止行驶后,控制所述第一安全回路和所述第二安全回路同时断开,切断所述机器人的供电电源;
如果所述报警信号的类型为第三类型,将所述报警信号发送至所述机器人的控制器,所述机器人的控制器控制所述机器人减速行驶直至所述机器人停止行驶。
6.根据权利要求1所述的设备,其特征在于,所述第一控制器和所述第二控制器的型号不同。
7.一种机器人,其特征在于,所述机器人包括:
控制器;以及
权利要求1至6中任意一项所述的安全控制设备。
8.一种机器人的控制方法,其特征在于,包括:
第一控制器和第二控制器获取来自机器人外部的报警信号,并判断所述报警信号的类型;
所述第一控制器和所述第二控制器控制第一安全回路和第二安全回路执行与所述报警信号的类型对应的控制指令,所述第一控制器和所述第二控制器中任意一个控制器与所述第一安全回路和所述第二安全回路连接,所述第一安全回路与所述第二安全回路的逻辑相反;
所述第一安全回路和所述第二安全回路中任意一个安全回路包括一个安全继电器和两个场效应管,其中,两个安全继电器的常开触点均连接所述第一控制器和所述第二控制器,所述第一控制器和所述第二控制器通过所述常开触点监控所述两个安全继电器的运行状态;所述第一安全回路的两个场效应管为PMOS场效应管,所述第二安全回路的两个场效应管为NMOS场效应管;
所述第一控制器和所述第二控制器之间包括第一通信链路,所述第一控制器和所述第二控制器通过所述第一通信链路校验所述第一安全回路和所述第二安全回路返回的数据是否存在时序误差,如果所述第一安全回路和所述第二安全回路返回的数据存在时序误差,控制断开所述第一安全回路和所述第二安全回路,并发送第一报警信息。
9.根据权利要求8所述的方法,其特征在于,所述第一控制器和所述第二控制器控制第一安全回路和第二安全回路执行与所述报警信号的类型对应的控制指令,包括:
如果所述报警信号的类型为第一类型,控制所述第一安全回路和所述第二安全回路同时断开,切断所述机器人的供电电源;
如果所述报警信号的类型为第二类型, 将所述报警信号发送至所述机器人的控制器;在所述机器人的控制器控制所述机器人减速运行直至所述机器人停止运行后,控制所述第一安全回路和所述第二安全回路同时断开,切断所述机器人的供电电源;
如果所述报警信号的类型为第三类型,将所述报警信号发送至所述机器人的控制器,所述机器人的控制器控制所述机器人减速行驶直至所述机器人停止行驶。
10.一种存储介质,其特征在于,所述存储介质包括存储的程序,其中,在所述程序运行时控制所述存储介质所在设备执行权利要求8或9中任意一项所述的机器人的控制方法。
11.一种处理器,其特征在于,所述处理器用于运行存储在存储器中的程序,其中,所述程序运行时执行权利要求8或9中任意一项所述的机器人的控制方法。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010340781.4A CN111331619B (zh) | 2020-04-26 | 2020-04-26 | 机器人的安全控制设备及机器人的控制方法、机器人 |
PCT/CN2020/139452 WO2021218204A1 (zh) | 2020-04-26 | 2020-12-25 | 机器人的控制设备及机器人的控制方法、机器人 |
JP2022553158A JP2023519155A (ja) | 2020-04-26 | 2020-12-25 | ロボットの制御機器及びロボットの制御方法、ロボット |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010340781.4A CN111331619B (zh) | 2020-04-26 | 2020-04-26 | 机器人的安全控制设备及机器人的控制方法、机器人 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111331619A CN111331619A (zh) | 2020-06-26 |
CN111331619B true CN111331619B (zh) | 2023-08-25 |
Family
ID=71179247
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010340781.4A Active CN111331619B (zh) | 2020-04-26 | 2020-04-26 | 机器人的安全控制设备及机器人的控制方法、机器人 |
Country Status (3)
Country | Link |
---|---|
JP (1) | JP2023519155A (zh) |
CN (1) | CN111331619B (zh) |
WO (1) | WO2021218204A1 (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111331619B (zh) * | 2020-04-26 | 2023-08-25 | 珠海格力电器股份有限公司 | 机器人的安全控制设备及机器人的控制方法、机器人 |
CN114076852B (zh) * | 2020-08-21 | 2024-01-26 | 苏州艾利特机器人有限公司 | 一种用于工业机器人的安全控制***及安全控制方法 |
WO2022037414A1 (zh) * | 2020-08-21 | 2022-02-24 | 苏州艾利特机器人有限公司 | 安全控制方法、装置、工业机器人及计算机存储介质 |
CN113618744A (zh) * | 2021-08-27 | 2021-11-09 | 库卡机器人(广东)有限公司 | 机器人的安全控制方法、装置、电子设备和可读存储介质 |
CN114347025B (zh) * | 2022-01-04 | 2024-02-20 | 深圳市大族机器人有限公司 | 协作机器人功能安全控制电路,控制方法及协作机器人 |
CN115657450B (zh) * | 2022-12-28 | 2023-03-31 | 广东美的制冷设备有限公司 | 工业机器人的安全控制***、电路及方法 |
CN117666452B (zh) * | 2024-02-01 | 2024-05-28 | 季华实验室 | 机器人的多重安全控制方法、装置、电子设备及存储介质 |
Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004237416A (ja) * | 2003-02-07 | 2004-08-26 | Fanuc Ltd | 非常停止回路 |
WO2009155993A1 (en) * | 2008-06-27 | 2009-12-30 | Abb Research Ltd. | A safety system for a machine |
KR20110016315A (ko) * | 2009-08-11 | 2011-02-17 | 삼성중공업 주식회사 | 다축 로봇장치의 비상정지 시스템 |
DE102010025781A1 (de) * | 2010-07-01 | 2012-01-05 | Kuka Laboratories Gmbh | Tragbare Sicherheitseingabeeinrichtung für eine Robotersteuerung |
CN103057725A (zh) * | 2013-01-14 | 2013-04-24 | 蒂森克虏伯机场***(中山)有限公司 | 一种基于sil2 安全等级的机门保护控制装置 |
CN104440923A (zh) * | 2014-11-11 | 2015-03-25 | 沈阳新松机器人自动化股份有限公司 | 一种用于机器人的急停信号控制***及其机器人 |
CN104777805A (zh) * | 2015-02-11 | 2015-07-15 | 北京配天技术有限公司 | 一种工业机器人安全控制***及备份安全电路、安全模块 |
CN106584452A (zh) * | 2015-10-19 | 2017-04-26 | 沈阳新松机器人自动化股份有限公司 | 机器人通用安全控制装置 |
WO2018120209A1 (zh) * | 2016-12-30 | 2018-07-05 | 深圳配天智能技术研究院有限公司 | 一种机器人模式切换告警电路、方法及机器人 |
CN109079793A (zh) * | 2018-09-12 | 2018-12-25 | 珠海格力电器股份有限公司 | 工业机器人安全保护装置及其工作方法、工业机器人及其工作方法 |
CN209408506U (zh) * | 2018-12-29 | 2019-09-20 | 上海新时达机器人有限公司 | 一种机器人控制*** |
CN110794805A (zh) * | 2019-10-08 | 2020-02-14 | 珠海格力电器股份有限公司 | 一种机器人安全电路及其控制方法 |
CN212020795U (zh) * | 2020-04-26 | 2020-11-27 | 珠海格力电器股份有限公司 | 机器人的安全控制设备及机器人 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4320556B2 (ja) * | 2003-04-02 | 2009-08-26 | 株式会社安川電機 | 産業用ロボットの制御装置 |
CA3063206A1 (en) * | 2017-05-09 | 2018-11-15 | Brain Corporation | System and method for motion control of robots |
CN108098751A (zh) * | 2017-12-06 | 2018-06-01 | 珠海格力节能环保制冷技术研究中心有限公司 | 机械手自动急停装置和自动急停控制方法 |
CN111331619B (zh) * | 2020-04-26 | 2023-08-25 | 珠海格力电器股份有限公司 | 机器人的安全控制设备及机器人的控制方法、机器人 |
-
2020
- 2020-04-26 CN CN202010340781.4A patent/CN111331619B/zh active Active
- 2020-12-25 WO PCT/CN2020/139452 patent/WO2021218204A1/zh active Application Filing
- 2020-12-25 JP JP2022553158A patent/JP2023519155A/ja active Pending
Patent Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004237416A (ja) * | 2003-02-07 | 2004-08-26 | Fanuc Ltd | 非常停止回路 |
WO2009155993A1 (en) * | 2008-06-27 | 2009-12-30 | Abb Research Ltd. | A safety system for a machine |
KR20110016315A (ko) * | 2009-08-11 | 2011-02-17 | 삼성중공업 주식회사 | 다축 로봇장치의 비상정지 시스템 |
DE102010025781A1 (de) * | 2010-07-01 | 2012-01-05 | Kuka Laboratories Gmbh | Tragbare Sicherheitseingabeeinrichtung für eine Robotersteuerung |
CN103057725A (zh) * | 2013-01-14 | 2013-04-24 | 蒂森克虏伯机场***(中山)有限公司 | 一种基于sil2 安全等级的机门保护控制装置 |
CN104440923A (zh) * | 2014-11-11 | 2015-03-25 | 沈阳新松机器人自动化股份有限公司 | 一种用于机器人的急停信号控制***及其机器人 |
CN104777805A (zh) * | 2015-02-11 | 2015-07-15 | 北京配天技术有限公司 | 一种工业机器人安全控制***及备份安全电路、安全模块 |
CN106584452A (zh) * | 2015-10-19 | 2017-04-26 | 沈阳新松机器人自动化股份有限公司 | 机器人通用安全控制装置 |
WO2018120209A1 (zh) * | 2016-12-30 | 2018-07-05 | 深圳配天智能技术研究院有限公司 | 一种机器人模式切换告警电路、方法及机器人 |
CN109079793A (zh) * | 2018-09-12 | 2018-12-25 | 珠海格力电器股份有限公司 | 工业机器人安全保护装置及其工作方法、工业机器人及其工作方法 |
CN209408506U (zh) * | 2018-12-29 | 2019-09-20 | 上海新时达机器人有限公司 | 一种机器人控制*** |
CN110794805A (zh) * | 2019-10-08 | 2020-02-14 | 珠海格力电器股份有限公司 | 一种机器人安全电路及其控制方法 |
CN212020795U (zh) * | 2020-04-26 | 2020-11-27 | 珠海格力电器股份有限公司 | 机器人的安全控制设备及机器人 |
Also Published As
Publication number | Publication date |
---|---|
CN111331619A (zh) | 2020-06-26 |
JP2023519155A (ja) | 2023-05-10 |
WO2021218204A1 (zh) | 2021-11-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111331619B (zh) | 机器人的安全控制设备及机器人的控制方法、机器人 | |
CN205043783U (zh) | 一种工业机器人的安全保护控制*** | |
CN110794805B (zh) | 一种机器人安全电路及其控制方法 | |
CN107957692B (zh) | 控制器冗余方法、装置及*** | |
CN104440923B (zh) | 一种用于机器人的急停信号控制***及其机器人 | |
CN107895937B (zh) | 一种电机控制器冗余保护电路和电子设备 | |
CN206374759U (zh) | 列车中央控制单元的冗余控制***及列车 | |
JP2004122258A (ja) | ロボットシステム | |
CN212020795U (zh) | 机器人的安全控制设备及机器人 | |
CN110178306A (zh) | 马达控制装置以及马达控制*** | |
JP5706347B2 (ja) | 二重化制御システム | |
CN112462594B (zh) | 一种基于星型拓扑的10m1553b总线控制器备份方法 | |
KR101457733B1 (ko) | Hmi 이중화 장치 | |
CN109375571A (zh) | 一种仓储物流***的急停装置及*** | |
WO2018155424A1 (ja) | モータ制御装置 | |
CN217882960U (zh) | 冗余切换单元及*** | |
CN111891192B (zh) | 列车超速防护设备、控制方法和双机热备*** | |
CN212935504U (zh) | 一种电机电源管理*** | |
CN114884803A (zh) | 多重冗余状态的处理方法、装置、设备和介质 | |
CN113852396B (zh) | 数据保护控制方法、装置和*** | |
US11954001B2 (en) | Storage system | |
CN114347025B (zh) | 协作机器人功能安全控制电路,控制方法及协作机器人 | |
JP2009130536A (ja) | 回線接続装置及び通信システム | |
JP3107104B2 (ja) | 待機冗長方式 | |
JP2005223998A (ja) | 非常停止信号生成装置内蔵モータドライブ装置 |
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 |