CN114161481B - 安全系统、关节组件及机器人 - Google Patents

安全系统、关节组件及机器人 Download PDF

Info

Publication number
CN114161481B
CN114161481B CN202210016707.6A CN202210016707A CN114161481B CN 114161481 B CN114161481 B CN 114161481B CN 202210016707 A CN202210016707 A CN 202210016707A CN 114161481 B CN114161481 B CN 114161481B
Authority
CN
China
Prior art keywords
processor
motor
joint
measured
torque
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
CN202210016707.6A
Other languages
English (en)
Other versions
CN114161481A (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.)
Feixi Technology Co ltd
Flexiv Robotics Ltd
Original Assignee
Feixi Technology Co ltd
Flexiv Robotics 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 Feixi Technology Co ltd, Flexiv Robotics Ltd filed Critical Feixi Technology Co ltd
Publication of CN114161481A publication Critical patent/CN114161481A/zh
Application granted granted Critical
Publication of CN114161481B publication Critical patent/CN114161481B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/06Safety devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J11/00Manipulators not otherwise provided for
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J17/00Joints
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Abstract

本申请涉及一种安全系统,用于关节组件,关节组件包括电机以及与电机连接的制动器,安全系统包括:至少一组传感器,配置为检测与关节组件的安全功能关联的至少一个参数;驱动电路,位于关节组件内,驱动电路连接到电机和制动器;以及第一处理器和第二处理器,位于关节组件内,并配置为从至少一组传感器接收指示该至少一个参数的信号,响应于根据该信号确定的关节故障向驱动电路发送停止命令以停止电机。

Description

安全系统、关节组件及机器人
技术领域
本申请涉及机器人技术领域,尤其涉及一种安全系统、具有安全系统的关节组件以及具有关节组件的机器人。
背景技术
功能安全是系统或设备整体安全的一部分,其取决于自动保护以可预测的方式响应其输入或故障时的正确运行。自动保护系统应被设计成能够正确处理可能的人为错误、硬件故障以及操作和/或环境异常。功能安全的目标是通过正确执行一个或多个自动保护功能,即安全功能,使人们直接或间接地免受不可接受的人身伤害或健康损害的风险。一个安全系统通常由一个或多个安全功能组成。
安全功能对于机器人来说特别重要。根据传统的一种机器人,其所有安全功能的检查和监控工作都需要在其位于控制箱中的主安全控制器中完成。主安全控制器需要收集来自所有机器人关节的传感器数据,并进行所有相关的计算以确定是否存在任何功能故障。
发明内容
本申请提供一种改进的安全系统、关节组件及机器人。
本申请一方面提供一种安全系统,用于关节组件,关节组件包括电机以及与电机连接的制动器,安全系统包括:至少一组传感器,配置为检测与关节组件的安全功能关联的至少一个参数;驱动电路,位于关节组件内,驱动电路连接到电机和制动器;以及第一处理器和第二处理器,位于关节组件内,并配置为从至少一组传感器接收指示至少一个参数的信号,响应于根据信号确定的关节故障向驱动电路发送停止命令以停止电机。
在一个实施例中,至少一组传感器包括输入侧位置传感器和输出侧位置传感器,输入侧位置传感器配置为测量电机的转子的位置,输出侧位置传感器配置为测量与电机连接的变速器的输出轴的位置,并且第一处理器和第二处理器中的至少一个配置为根据转子的测量位置和输出轴的测量位置来确定是否存在关节故障。
在一个实施例中,第一处理器和第二处理器中的至少一个配置为比较转子的测量位置和输出轴的测量位置,并根据两者之间的偏差确定是否存在关节故障。
在一个实施例中,第一处理器和第二处理器中的至少一个配置为将转子的测量位置和输出轴的测量位置中的至少一个与对应的预定位置进行比较以确定是否存在关节故障。
在一个实施例中,第一处理器和第二处理器中的至少一个配置为根据转子的测量位置计算转子的转速,以及根据输出轴的测量位置计算输出轴的转速,并根据转子的转速和输出轴的转速之间的偏差确定是否存在关节故障。
在一个实施例中,第一处理器和第二处理器中的至少一个配置为根据转子的测量位置计算转子的转速和根据输出轴的测量位置计算输出轴的转速,并将转子的计算转速和输出轴的计算转速中的至少一个与对应的预定速度进行比较以确定是否存在关节故障。
在一个实施例中,至少一组传感器包括配置为测量电机的电流的电流传感器以及配置为检测连接到电机的变速器的输出扭矩的扭矩传感器,第一处理器和第二处理器中的至少一个配置为根据电机的测量电流和变速器的测量扭矩来确定是否存在关节故障。
在一个实施例中,第一处理器和第二处理器中的至少一个配置为根据测量电流计算电机的估计扭矩,并将电机的计算估计扭矩与变速器的测量扭矩进行比较,以根据两者之间的偏差确定是否存在关节故障。
在一个实施例中,第一处理器和第二处理器中的至少一个配置为根据测量电流计算电机的估计扭矩,并将电机的计算估计扭矩和变速器的测量扭矩中的至少一个与对应的预定扭矩进行比较,以确定是否存在关节故障。
在一个实施例中,第一处理器配置为根据测量电流计算电机的计算估计扭矩,并根据计算估计扭矩确定是否存在关节故障,第二处理器配置为根据变速器的测量扭矩确定是否存在关节故障。
在一个实施例中,第一处理器配置为根据测量电流计算电机的估计扭矩,第二处理器配置为从扭矩传感器获取变速器的测量扭矩,计算估计扭矩与测量扭矩进行比较,以确定是否存在关节故障。
在一个实施例中,至少一组传感器包括:输入侧位置传感器,配置为测量电机的转子的位置;输出侧位置传感器,配置为测量与电机连接的变速器的输出轴的位置;电流传感器,配置为测量电机的电流;以及扭矩传感器,配置为测量变速器输出的扭矩,第一处理器和第二处理器中的一个配置为根据电机的转子的测量位置和变速器的输出轴的测量位置来确定是否存在关节故障,第一处理器和第二处理器中的另一个配置为根据电机的测量电流和变速器的测量扭矩来确定是否存在关节故障。
在一个实施例中,第一处理器和第二处理器配置为相互通信,并在确定存在关节故障时向对方发送通知。
在一个实施例中,第一处理器和第二处理器具有不同的技术规格。
在一个实施例中,第一处理器和第二处理器配置为通过切断扭矩输出或启用制动器来锁定关节组件。
在一个实施例中,安全系统进一步包括主控制器,主控制器配置为与第一处理器和第二处理器通信,并在收到来自第一处理器和第二处理器中的任一个的关节故障通知时,生成使用关节组件的设备的锁定命令。
本申请另一方面提供一种关节组件,包括电机、与电机相连的制动器、以及以上任一实施例的安全系统。
本申请再一方面提供一种机器人,包括至少一个以上任一实施例的关节组件。
在一个实施例中,至少一个关节组件包括至少两个关节组件,每个关节组件分别与一个共同的主控制器进行通信。
在一个实施例中,主控制器包括至少一个处理器,配置为接收至少一个关节组件内的至少一组传感器的信号,根据接收到的信号确定是否存在关节故障,并响应关节故障而锁定机器人。
本发明的一个或多个实施例的细节在下面的附图和描述中提出。本发明的其它特征、目的和优点将从说明书、附图以及权利要求书变得明显。
附图说明
结合描述本申请的各种实施例的附图,通过对本申请的各个方面的以下详细描述,将更容易理解本申请的和其他特征,其中:
图1是根据本申请的一个实施例的关节组件的原理示意图;
图2是根据本申请的一个实施例的关节组件的结构示意图;
图3是根据本申请的另一实施例的关节组件的结构示意图;
图4是根据本申请的另一实施例的关节组件的结构示意图;
图5是显示根据本申请的一个实施例的主控制器和关节组件之间通信的框图;
图6是根据本申请的一个实施例的机器人的结构示意图。
应当注意的是,本申请的附图并非未按比例绘制,附图仅旨在描绘本申请的典型方面,因此不应视为限制本申请的范围。
具体实施方式
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图对本发明的具体实施方式做详细的说明。在下面的描述中阐述了很多具体细节以便于充分理解本发明。但是本发明能够以很多不同于在此描述的其它方式来实施,本领域技术人员可以在不违背本发明内涵的情况下做类似改进,因此本发明不受下面公开的具体实施例的限制。
本申请的一个方面提供了一种关节组件的安全系统。在如图1所示的一个实施例中,关节组件10包括电机20以及与电机20连接的用于停止该电机的制动器30。优选地,关节组件10还包括变速器40,如减速器,其可以改变电机20的速度输出和扭矩输出。制动器30可以直接连接到电机20上,或通过与电机20连接的变速器40而间接地连接到电机20上。基于处理器或控制器的指令,制动器30向电机20或变速器40提供制动力,从而使关节组件10减慢或停止工作,从而使与关节组件10连接并由其驱动的元件如机器人手臂等停止。
继续参照图1,提供了一个安全系统50,以检测关节组件10的关节故障并基于检测到的关节故障锁定关节组件10。安全系统50包括至少一组配置为检测与关节组件10的安全功能关联的至少一个参数的传感器60、与电机20和制动器30连接并位于关节组件10内的驱动电路70,以及布置在关节组件10内的第一处理器80和第二处理器81。具体而言,第一处理器80和第二处理器81可以被固定在关节组件10内的同一或不同的电路板上,并配置为从至少一组传感器60接收指示至少一个参数的信号,并响应于根据该信号确定的关节故障,直接向驱动电路70发送停止命令以停止电机20。该关节故障可以包括,例如,关节组件10的部件的机械或功能故障,或部件之间的物理连接或数字通讯故障。
在图中所示的示例性实施例中,第一处理器80和第二处理器81可以是微控制单元(MCU)。
参照图2,在一个实施例中,至少一组传感器60包括输入侧位置传感器60a和输出侧位置传感器60b,输入侧位置传感器60a配置为测量电机20的转子的位置,输出侧位置传感器60b配置为测量与电机20连接的变速器40的输出轴的位置。第一处理器80和第二处理器81中的至少一个配置为根据电机20的转子的测量位置和变速器40的输出轴的测量位置来确定是否存在接头故障。位置传感器60a、60b可以包括例如霍尔效应位置编码器。
例如,第一处理器80通过接收来自位置传感器60a、60b的信号分别获得电机20的转子的测量位置和变速器40的输出轴的测量位置,并根据电机20的转子的测量位置和变速器40的输出轴的测量位置确定是否存在关节故障。在一个具体实施方式中,第一处理器80将电机20的转子的测量位置与预定位置进行比较,以确定是否存在关节故障。例如,如果预定值和测量值之间的偏差超过一预设阈值,则可以确定存在关节故障。同样地,第一处理器80可以将变速器40的输出轴的测量位置与预定位置进行比较,以确定是否存在关节故障。例如,当二者的偏差超过一预设阈值时,可以确定存在关节故障。在另一个实施方式中,电机20的转子的测量位置和变速器40的输出轴的测量位置分别与对应的预定值进行比较,当其中一个偏差超过对应的预设阈值时,可以确定存在关节故障。在另一个具体实施方式中,第一处理器80可以将电机20的转子的测量位置与变速器40的输出轴的测量位置进行比较,以确定是否存在关节故障。例如,在考虑变速器40的齿轮比的情况下,当电机20的转子的测量位置与变速器40的输出轴的测量位置之间的偏差超过一阈值时,确定存在关节故障。
可以理解的是,前述各种计算和/或比较也可以由第二处理器81完成,或者同时由第一处理器80和第二处理器81分别完成。具体而言,在一个实施例中,第一处理器80和第二处理器81都同时连接到位置传感器60a、60b以接收信号。根据需要,上述计算可以由第一处理器80或第二处理器81执行。或者,第一处理器80和第二处理器81可以分别执行计算的一部分。例如,第一处理器80根据输入侧位置传感器60a的信号执行对关节故障的判断,而第二处理器81根据输出侧位置传感器60b的信号执行对关节故障的另一判断。或者利用第一处理器80和第二处理器81分别进行完整的计算,当任何一个处理器确定存在关节故障时,即可以启动安全措施。
在另一个实施例中,第一处理器80和第二处理器81中的至少一个配置为基于电机20的转子的测量位置计算转子的转速,以及基于变速器40的输出轴的测量位置计算输出轴的转速,并且基于转子和输出轴的转速的偏差来确定是否存在关节故障。
例如,第一处理器80通过接收来自传感器60a、60b的信号分别获得电机20的转子的测量位置和变速器40的输出轴的测量位置,基于电机20的转子的测量位置计算电机20的转子速度,并基于变速器40的输出轴的测量位置计算变速器40的输出轴的转速。具体来说,以一定的时间间隔对电机20的转子位置进行两次采样,以提供两个位置值用于计算电机20的转子速度。同样地,变速器40的输出轴的转速可以根据变速器40的输出轴的位置来计算,位置信息同样以一定的时间间隔通过两次采样获得。在一个示例性实施方式中,在考虑到变速器40的齿轮比的情况下,第一处理器80将电机20的转子的计算速度与变速器40的输出轴的计算速度进行比较,当偏差超过一阈值时,可以确定存在关节故障。在另一个示例性实施方式中,第一处理器80将电机20的转子的计算速度与预定速度进行比较,以确定是否存在关节故障。例如,当两者的偏差超过一阈值时,可以确定存在关节故障。类似地,第一处理器80可以将变速器40的输出轴的计算转速与对应的预定转速进行比较,以确定是否存在关节故障。例如,当二者的偏差超过阈值时,可以确定存在关节故障。
同样可以理解的是,前述各种计算和/或比较也可以由第二处理器81完成,或者由第一处理器80和第二处理器81共同或分别完成。
根据本申请的实施例,传感器数据由第一处理器80和/或第二处理器81本地采集,因此采样频率高,两次采样的时间间隔短,因此电机20的转子的计算速度和变速器40的输出轴的计算转速更加准确。
参照图3,在一个实施例中,至少一组传感器包括配置为检测电机20的电流的电流传感器60c和配置为检测与电机20连接的变速器40的输出扭矩的扭矩传感器60d。第一处理器80和第二处理器81中的至少一个配置为根据测量的电流和测量的扭矩来确定是否存在关节故障。
例如,第一处理器80从电流传感器60c的信号中获得电机20的测量电流,从扭矩传感器60d的信号中获得变速器40的测量扭矩,并基于电机20的测量电流计算出估计扭矩。在考虑变速器40的齿轮比的情况下,第一处理器80进一步将电机20的计算估计扭矩与变速器40的测量扭矩进行比较,如果二者之间的偏差超过一阈值,则确定存在关节故障。
此外,第一处理器80还可以将电机20的计算估计扭矩和变速器40的测量扭矩中的至少一个与对应的预设扭矩进行比较,以确定是否存在关节故障。
同样可以理解的是,上述计算和/或比较可以由第二处理器81完成,或者由第一处理器80和第二处理器81分别完成。具体而言,在一个实施例中,第一处理器80和第二处理器81均同时连接到电流传感器60c和扭矩传感器60d以接收其信号。根据需要,上述计算可以由第一处理器80或第二处理器81执行。或者,可以利用第一处理器80和第二处理器81分别进行上述完整的计算,当任何一个处理器确定存在关节故障时,即可以启动安全措施。
在一个实施例中,第一处理器80和第二处理器81中的一个基于电机20的电流计算电机20的估计扭矩,并且第一处理器80和第二处理器81中的另一个从扭矩传感器60d的信号获得变速器40的测量扭矩。参考前面所描述的,第一处理器80和第二处理器81可以分别通过将计算的估计扭矩和测量扭矩与对应的阈值进行比较,或者通过将电机20的计算的估计扭矩与变速器40的测量扭矩进行比较来确定是否存在关节故障。
在一个实施例中,参照图4,至少一组传感器60包括配置为测量电机20的转子的位置的输入侧位置传感器60a、配置为测量变速器40的输出轴的位置的输出侧位置传感器60b、配置为检测电机20的电流的电流传感器60c、以及配置为检测变速器40输出扭矩的扭矩传感器60d。第一处理器80和第二处理器81中的一个配置为,例如通过前面所描述的方法,根据电机20的转子的测量位置和变速器40的输出轴的测量位置,确定是否存在关节故障,同时第一处理器80和第二处理器81中的另一个配置为,例如通过如上所描述的方法,根据电机20的转子的测量电流和变速器40的输出轴的测量扭矩,确定是否存在关节故障。
在一个实施例中,第一处理器80和第二处理器81相互通信,当其中一个处理器检测到关节故障时,向另一个处理器发送通知信息,从而实现了两个处理器80、81的交叉检查。此外,通过允许第一处理器80和第二处理器81相互通信,一个处理器可以从另一个处理器获取传感器数据,这比直接从传感器收集所有数据更有效率。
在一个实施例中,第一处理器80和第二处理器81采用具有不同技术规格的不同型号,以降低了两个处理器同时发生故障的概率,并允许两个处理器相互验证以识别处理器故障。
当确定存在关节故障时,第一处理器80和/或第二处理器81向驱动电路70发送停止信号,并且驱动电路70根据停止信号切断扭矩输出,例如,通过切断电机20的电流,或者通过启用制动器30来停止电机20,从而锁定关节组件10。
在一个实施例中,参照图5,安全系统进一步包括主控制器90。主控制器90与第一处理器80和第二处理器81进行通信,并且在从第一处理器80和/或第二处理器81接收到关节故障通知时为使用关节组件10的整个设备生成停止命令。例如,在响应关节故障通知时,主控制器90锁定机器人的所有其他关节组件。主控制器90可进一步包括至少一个处理器91,例如MCU,其配置为接收关节组件10内的传感器60的信号,并独立于由关节组件10内的第一处理器80和第二处理器81执行的计算或确定,执行上述各种计算和/或确定。因此,对关节故障的判断可以通过主控制器90中的相关计算进一步确认,从而提高安全检查的可靠性。在一个实施例中,主控制器90对主电源开关有直接控制权,当主控制器90根据从关节组件和/或系统其他地方的传感器收集到的数据,自行确定系统存在故障时,主控制器90将关闭主电源开关,以锁定整个设备。
根据本申请的其他方面,本申请还分别提供了具有根据上述各种实施例中所述的安全组件的关节组件,以及具有关节组件的机器人。参照图6,在一个实施例中,机器人100包括至少两个通过关节组件10相互连接的手臂101,关节组件10使得该手臂101能够旋转,以便调整其末端执行器102例如连接在手臂末端的夹爪的位置。在另一个实施例中,机器人至少包括两个关节组件10。如前面所描述的,每个关节组件10包括一对处理器和至少一组传感器,所有的关节组件10都连接到一个共同的主控制器并与之通信。在这种情况下,主控制器的处理器同时接收所有关节组件10内传感器的信号,并进行如前面所述的各种计算和/或确定,为每个关节组件10的功能失效提供额外的检查。
根据本申请的一些实施例,通过位于关节组件内的两个处理器,关于关节位置极限、关节速度极限或关节扭矩极限的安全功能至少在关节组件内本地完成,而不是完全依靠主控制器来进行所有的计算和检查。与主控制器和关节组件内的传感器之间的通信相比,传感器和本地处理器之间例如基于快速通信协议可以实现更快的通讯速度,从而消除或降低通信失败的风险。此外,当关节组件检测到关节位置、速度或扭矩上的任何安全功能出现异常时,可以安全地立即锁定自己,与现有的关节组件相比,故障检测和反应的延迟可以快得多。
根据本申请的一些实施例,由于两个处理器位于关节组件内,安全检查的计算负担被分配到机器人的关节组件中,而不是集中在具有至少一个处理器的主控制器中。这种负担分担使得检查间隔更短,从而可以更快地发现故障,而且除了主控制器之外,关节组件中的检查也增加了冗余的安全保护。此外,根据一些实施方式,由于关节速度是在关节中本地计算的,与现有的关节组件相比,用于计算关节速度的两个关节位置数据采样点之间的时间间隔要小得多,因此用于安全检查的关节速度要精确得多,这将提高依赖关节速度数据的所有安全功能的检查精度和信赖度。
本文所使用的术语仅出于描述特定实施例的目的,并不旨在限制本申请。如本文所使用的,单数形式“一”,“一个”和“该”也旨在包括复数形式,除非上下文另外明确指出。还将理解的是,当在本说明书中使用术语“包括”时,指的是存在所述特征、步骤、操作、元件和/或部件,但不排除一个或多个其他特征、步骤、操作、元件、部件和/或其组合的存在。“可选的”或“可选地”意指后续描述的事件或情况可能发生也可能不发生,并且描述包括发生以及不发生该事件的情况。
如在整个说明书和权利要求书中所使用的,近似语言可以用于修改可以变化的任何定量表示,而不会导致与之相关的基本功能的变化。因此,由诸如“大约”,“大概”和“基本”的一个或多个术语修饰的值不限于所指定的精确值。在至少一些情况下,近似语言可以对应于用于测量值的仪器的精度。此处并且在整个说明书和权利要求书中,除非上下文或语言另有描述,否则范围限制可以组合并且/或者互换,这样的范围是指定的并且包括被包含在其中的所有子范围。
所附权利要求书中的所有的装置或步骤加功能元件的相应结构、材料、动作和等同形式旨在包括用于执行功能的任何结构、材料、或动作与如具体要求保护的其它要求保护的元件的组合。提供对本发明的描述是为了说明和描述的目的,并不旨在穷尽或将本发明限制在所公开的形式。多种改型和变型对于本领域普通技术人员而言将是显而易见的,而不偏离本发明的范围和精神。实施例被选择和描述成以便最佳解释本发明的原理和实际应用,并且使得其它普通技术人员能够理解本发明的具有多个改型的多个实施例适用于所构想的特定应用。

Claims (18)

1.一种安全系统,用于关节组件,所述关节组件包括电机以及与所述电机连接的制动器,其特征在于,
所述安全系统包括:
至少一组传感器,配置为检测与所述关节组件的安全功能关联的至少一个参数;
驱动电路,位于所述关节组件内,所述驱动电路连接到所述电机和所述制动器;以及
第一处理器和第二处理器,位于关节组件内,并配置为从所述至少一组传感器接收指示所述至少一个参数的信号,响应于根据所述信号确定的关节故障向所述驱动电路发送停止命令以停止所述电机;
所述至少一组传感器包括配置为测量所述电机的电流的电流传感器以及配置为检测连接到所述电机的变速器的输出扭矩的扭矩传感器,所述第一处理器和所述第二处理器中的至少一个配置为根据所述电机的测量电流和所述变速器的测量扭矩来确定是否存在关节故障;所述第一处理器和所述第二处理器中的至少一个配置为根据所述测量电流计算所述电机的估计扭矩,并将所述电机的计算估计扭矩与所述变速器的测量扭矩进行比较,以根据两者之间的偏差确定是否存在关节故障;两者之间的偏差超过一阈值,则确定存在关节故障。
2.根据权利要求1所述的安全系统,其特征在于,
所述至少一组传感器包括输入侧位置传感器和输出侧位置传感器,所述输入侧位置传感器配置为测量所述电机的转子的位置,所述输出侧位置传感器配置为测量与所述电机连接的变速器的输出轴的位置,并且所述第一处理器和所述第二处理器中的至少一个配置为根据所述转子的测量位置和所述输出轴的测量位置来确定是否存在关节故障。
3.根据权利要求2所述的安全系统,其特征在于,
所述第一处理器和所述第二处理器中的至少一个配置为比较所述转子的测量位置和所述输出轴的测量位置,并根据两者之间的偏差确定是否存在关节故障。
4.根据权利要求2所述的安全系统,其特征在于,
所述第一处理器和所述第二处理器中的至少一个配置为将所述转子的测量位置和所述输出轴的测量位置中的至少一个与对应的预定位置进行比较以确定是否存在关节故障。
5.根据权利要求2所述的安全系统,其特征在于,
所述第一处理器和所述第二处理器中的至少一个配置为根据所述转子的测量位置计算所述转子的转速,以及根据所述输出轴的测量位置计算所述输出轴的转速,并根据所述转子的转速和所述输出轴的转速之间的偏差确定是否存在关节故障。
6.根据权利要求2所述的安全系统,其特征在于,
所述第一处理器和所述第二处理器中的至少一个配置为根据所述转子的测量位置计算所述转子的转速和根据所述输出轴的测量位置计算所述输出轴的转速,并将所述转子的计算转速和所述输出轴的计算转速中的至少一个与对应的预定速度进行比较以确定是否存在关节故障。
7.根据权利要求1所述的安全系统,其特征在于,
所述第一处理器和所述第二处理器中的至少一个配置为根据所述测量电流计算所述电机的估计扭矩,并将所述电机的计算估计扭矩和所述变速器的测量扭矩中的至少一个与对应的预定扭矩进行比较,以确定是否存在关节故障。
8.根据权利要求1所述的安全系统,其特征在于,
所述第一处理器配置为根据所述测量电流计算所述电机的计算估计扭矩,并根据所述计算估计扭矩确定是否存在关节故障,所述第二处理器配置为根据所述变速器的测量扭矩确定是否存在关节故障。
9.根据权利要求1所述的安全系统,其特征在于,
所述第一处理器配置为根据所述测量电流计算所述电机的估计扭矩,所述第二处理器配置为从所述扭矩传感器获取所述变速器的测量扭矩,计算估计扭矩与所述测量扭矩进行比较,以确定是否存在关节故障。
10.根据权利要求1所述的安全系统,其特征在于,
所述至少一组传感器包括:
输入侧位置传感器,配置为测量所述电机的转子的位置;
输出侧位置传感器,配置为测量与所述电机连接的变速器的输出轴的位置;
电流传感器,配置为测量所述电机的电流;以及
扭矩传感器,配置为测量所述变速器输出的扭矩,
所述第一处理器和所述第二处理器中的一个配置为根据所述电机的转子的测量位置和所述变速器的输出轴的测量位置来确定是否存在关节故障,第一处理器和第二处理器中的另一个配置为根据所述电机的测量电流和所述变速器的测量扭矩来确定是否存在关节故障。
11.根据权利要求1所述的安全系统,其特征在于,
所述第一处理器和所述第二处理器配置为相互通信,并在确定存在关节故障时向对方发送通知。
12.根据权利要求1所述的安全系统,其特征在于,
所述第一处理器和所述第二处理器具有不同的技术规格。
13.根据权利要求1所述的安全系统,其特征在于,
所述第一处理器和所述第二处理器配置为通过切断扭矩输出或启用所述制动器来锁定所述关节组件。
14.根据权利要求1所述的安全系统,其特征在于,
所述安全系统进一步包括主控制器,所述主控制器配置为与所述第一处理器和所述第二处理器通信,并在收到来自所述第一处理器和所述第二处理器中的任一个的关节故障通知时,生成使用所述关节组件的设备的锁定命令。
15.一种关节组件,其特征在于,
包括电机、与所述电机相连的制动器、以及根据权利要求1-14中任一项所述的安全系统。
16.一种机器人,其特征在于,
包括至少一个根据权利要求15所述的关节组件。
17.根据权利要求16所述的机器人,其特征在于,
所述至少一个关节组件包括至少两个关节组件,每个所述关节组件分别与一个共同的主控制器进行通信。
18.根据权利要求17所述的机器人,其特征在于,
所述主控制器包括至少一个处理器,配置为接收至少一个所述关节组件内的至少一组传感器的信号,根据接收到的信号确定是否存在关节故障,并响应所述关节故障而锁定所述机器人。
CN202210016707.6A 2021-10-12 2022-01-07 安全系统、关节组件及机器人 Active CN114161481B (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN2021111868713 2021-10-12
CN202111186871.3A CN113696229A (zh) 2021-10-12 2021-10-12 安全系统、关节组件及机器人

Publications (2)

Publication Number Publication Date
CN114161481A CN114161481A (zh) 2022-03-11
CN114161481B true CN114161481B (zh) 2024-08-20

Family

ID=78662812

Family Applications (2)

Application Number Title Priority Date Filing Date
CN202111186871.3A Pending CN113696229A (zh) 2021-10-12 2021-10-12 安全系统、关节组件及机器人
CN202210016707.6A Active CN114161481B (zh) 2021-10-12 2022-01-07 安全系统、关节组件及机器人

Family Applications Before (1)

Application Number Title Priority Date Filing Date
CN202111186871.3A Pending CN113696229A (zh) 2021-10-12 2021-10-12 安全系统、关节组件及机器人

Country Status (1)

Country Link
CN (2) CN113696229A (zh)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114198480A (zh) * 2021-12-13 2022-03-18 上海非夕机器人科技有限公司 减速器、减速传动系统及包括减速传动系统的机器人关节和机器人
CN114323718B (zh) * 2021-12-14 2023-12-15 合肥欣奕华智能机器股份有限公司 一种机器人故障预测方法及装置
CN116919602B (zh) * 2022-04-06 2025-04-22 瑞龙诺赋(上海)医疗科技有限公司 器械驱动控制系统及方法

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102431043A (zh) * 2010-09-15 2012-05-02 株式会社安川电机 减速器的异常判定方法、装置和机器人及机器人系统
CN110849616A (zh) * 2018-08-21 2020-02-28 恩格尔奥地利有限公司 操作装置和用于识别操作装置动力传动系机械故障的方法

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4391381B2 (ja) * 2004-10-06 2009-12-24 株式会社安川電機 多関節ロボットの減速機の異常判定装置及び多関節ロボットの減速機の異常判定方法
JP2006281421A (ja) * 2005-04-05 2006-10-19 Yaskawa Electric Corp ロボットおよびロボットの異常検出方法
JP7309344B2 (ja) * 2018-11-13 2023-07-18 川崎重工業株式会社 駆動機構の故障診断装置及び故障診断方法並びに前記故障診断装置を備える機械装置

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102431043A (zh) * 2010-09-15 2012-05-02 株式会社安川电机 减速器的异常判定方法、装置和机器人及机器人系统
CN110849616A (zh) * 2018-08-21 2020-02-28 恩格尔奥地利有限公司 操作装置和用于识别操作装置动力传动系机械故障的方法

Also Published As

Publication number Publication date
CN113696229A (zh) 2021-11-26
CN114161481A (zh) 2022-03-11

Similar Documents

Publication Publication Date Title
CN114161481B (zh) 安全系统、关节组件及机器人
EP1882922B1 (en) Method of diagnosing abnormality of reduction gear and apparatus for carry out the method
KR101654497B1 (ko) 전기모터제어
KR101951247B1 (ko) 전동식 파워 스티어링 시스템 및 전자 제어 장치의 페일 세이프 처리 방법
US6112156A (en) Apparatus and method for detecting abnormality of motor
EP1366346B1 (en) Method and apparatus for monitoring a transmission part
KR102024550B1 (ko) 전동식 동력 조향 시스템의 페일 세이프 제어장치 및 제어방법
EP3196096A1 (en) Electric power steering device
CN113460122A (zh) 电动道岔转辙机系统的状态检测方法、装置、设备及介质
US10060983B2 (en) Method and apparatus for determining a physical quantity of a multiphase synchronous machine
CN110831730B (zh) 机器人系统
US12318920B2 (en) Safety system, joint assembly with safety system, and robot having joint assembly
JP7395731B2 (ja) 監視制御装置及び監視制御方法
JPH09140175A (ja) 電動機制御装置
TWI621002B (zh) 伺服控制診斷系統
JP2006158031A (ja) モータ制御装置およびその制御方法
CN114851186B (zh) 机器人控制装置及机器人系统
KR102596214B1 (ko) 로봇의 이상감지 시스템 및 그 제어방법
JPH06239261A (ja) パワーステアリング制御装置
JP2020183146A (ja) 分岐器密着度合変化検出方法および分岐器密着度合監視装置
JP2001333589A (ja) モータの過負荷状態検出装置
JPS639275Y2 (zh)
CN116968015A (zh) 机器人关节控制系统及方法
JP2002329284A (ja) センサー装置及び検出データ送信装置
JPH06305429A (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