CN105459120A - 人类协调机器人系统 - Google Patents

人类协调机器人系统 Download PDF

Info

Publication number
CN105459120A
CN105459120A CN201510493333.7A CN201510493333A CN105459120A CN 105459120 A CN105459120 A CN 105459120A CN 201510493333 A CN201510493333 A CN 201510493333A CN 105459120 A CN105459120 A CN 105459120A
Authority
CN
China
Prior art keywords
mentioned
robot
physical quantity
external environment
mankind
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.)
Granted
Application number
CN201510493333.7A
Other languages
English (en)
Other versions
CN105459120B (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.)
Fanuc Corp
Original Assignee
Fanuc Corp
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 Fanuc Corp filed Critical Fanuc Corp
Publication of CN105459120A publication Critical patent/CN105459120A/zh
Application granted granted Critical
Publication of CN105459120B publication Critical patent/CN105459120B/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
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1674Programme controls characterised by safety, monitoring, diagnostic
    • B25J9/1676Avoiding collision or forbidden zones
    • 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
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1694Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/37Measurements
    • G05B2219/37351Detect vibration, ultrasound
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/40Robotics, robotics mapping to robotics vision
    • G05B2219/40201Detect contact, collision with human
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/40Robotics, robotics mapping to robotics vision
    • G05B2219/40541Identification of contact formation, state from several force measurements
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/42Servomotor, servo controller kind till VSS
    • G05B2219/42288Limit, stop drive current if axis obstructed, blocked, force against stop
    • YGENERAL 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
    • Y10TECHNICAL SUBJECTS COVERED BY FORMER USPC
    • Y10STECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10S901/00Robots
    • Y10S901/02Arm motion controller
    • Y10S901/09Closed loop, sensor feedback controls arm movement

Abstract

本发明的人类协调机器人系统具备:检测部,其直接或者间接地检测与在机器人接触外部环境时机器人所受到的接触力对应地变化的物理量;以及停止指令部,其将由检测部检测到的物理量与第一阈值以及比第一阈值大的第二阈值分别进行比较,当物理量为第一阈值以上而且不足第二阈值时,使机器人根据规定的停止方法停止,并且当物理量为第二阈值以上时,使机器人以比规定的停止方法短的时间停止。

Description

人类协调机器人系统
技术领域
本发明涉及机器人以及人类共用作业空间的人类协调机器人系统。
背景技术
相对于在利用安全护栏从人类的作业空间隔离出的作业空间进行动作的以往的机器人,近几年,进行了机器人以及人类共有作业空间的人类协调机器人的普及。人类协调机器人需要确保安全以便不会对人类施加危害。
JP2012-040626A中公开了如下人类协调机器人系统:在机器人或者在安装于机器人的作业设备上设置的力传感器的检测值超过规定的值时,使机器人停止,或者以使力传感器的检测值变小的方式控制机器人的动作。
JP2010-137312A中公开了如下机器人系统:具备检测机器人臂碰撞到障碍物的情况的碰撞检测装置,基于来自碰撞检测装置的信息,选择性地执行适当的停止方法以便将对于机器人以及障碍物的机械式的损伤抑制为最小限度。具体而言,根据该公知技术,基于伺服马达的旋转方向与碰撞转矩的方向的关系、以及伺服马达的旋转速度等信息,根据紧急停止处理、灵活停止处理、或者全轴拉回处理中任一个方法来使机器人停止。
然而,在JP2012-040626A的公知技术中,当检测到机器人与人类的接触后,总是使机器人执行规定的动作。因此,例如与机器人接触的作业者因紧急停止的机器人而感到危险,实际上尽管危险性低,也会给作业造成妨碍。在选择性地执行各种停止处理的JP2010-137312A的公知技术中,未假定以对与机器人接触的作业者给予安心感的形态使机器人停止。
发明内容
因此,寻求一种人类协调机器人系统,其构成为:能够确保机器人以及机器人的外部环境的安全,并且以对人类给予安心感的方式使机器人平稳地停止。
根据第1方案的发明,提供一种人类协调机器人系统,构成为机器人以及人类共用作业空间,其特征在于,具备:
检测部,其直接或间接地检测与在机器人接触外部环境时机器人所受到的接触力对应地变化的物理量;以及
停止指令部,其将由上述检测部检测到的物理量与第一阈值以及比第一阈值大的第二阈值分别进行比较,在上述物理量为上述第一阈值以上而且不足上述第二阈值时,使上述机器人根据规定的停止方法停止,并且当上述物理量为上述第二阈值以上时,使上述机器人以比上述规定的停止方法短的时间停止。
根据第2方案的发明,在第1方案的发明的人类协调机器人系统中,其特征在于,
上述物理量是上述机器人从上述外部环境受到的力或者转矩。
根据第3方案的发明,在第1方案的发明的人类协调机器人系统中,其特征在于,
上述物理量是从上述外部环境受到的力或者转矩的关于时间的微分值。
根据第4方案的发明,在第1方案的发明的人类协调机器人系统中,其特征在于,
上述物理量是从上述外部环境受到的力或者转矩在规定的频率时的振动的振幅。
根据第5方案的发明,提供一种人类协调机器人系统,其构成为机器人以及人类共用作业空间,其特征在于,具备:
第一检测部,其直接或者间接地检测与在机器人接触外部环境时机器人所受到的接触力对应地变化的第一物理量;
第二检测部,其直接或者间接地检测与在机器人接触外部环境时机器人所受到的接触力对应地变化的第二物理量;以及
停止指令部,其将由上述第一检测部检测到的上述第一物理量与第一阈值进行比较,并且将由上述第二检测部检测到的上述第二物理量与第三阈值进行比较,当上述第一物理量为上述第一阈值以上而且上述第二物理量不足上述第三阈值时,使上述机器人根据规定的停止方法停止,并且当上述第一物理量为上述第一阈值以上而且上述第二物理量为上述第三阈值以上时,使上述机器人以比上述规定的停止方法短的时间停止。
根据第6方案的发明,在第5方案的发明的人类协调机器人系统中,其特征在于,
上述第一物理量是上述机器人从上述外部环境受到的力或者转矩,上述第二物理量是上述机器人从上述外部环境受到的力或者转矩的关于时间的微分值。
根据第7方案的发明,在第5方案的发明的人类协调机器人系统中,其特征在于,
上述第一物理量是上述机器人从上述外部环境受到的力或者转矩,上述第二物理量是从上述外部环境受到的力或者转矩在规定的频率时的振动的振幅。
根据第8方案的发明,在第5方案的发明的人类协调机器人系统中,其特征在于,
上述第一物理量是上述机器人从上述外部环境受到的力或者转矩,上述第二物理量是上述机器人的速度。
根据第9方案的发明,在第5方案的发明的人类协调机器人系统中,其特征在于,
上述第一物理量是上述机器人从上述外部环境受到的力或者转矩的关于时间的微分值,上述第二物理量是上述机器人从上述外部环境受到的力或者转矩。
根据第10方案的发明,在第5方案的发明的人类协调机器人系统中,其特征在于,
上述第一物理量是上述机器人从上述外部环境受到的力或者转矩的关于时间的微分值,上述第二物理量是上述机器人的速度。
根据第11方案的发明,在第5方案的发明的人类协调机器人系统中,其特征在于,
上述第一物理量是从上述外部环境受到的力或者转矩在规定的频率时的振动的振幅,上述第二物理量是上述机器人从上述外部环境受到的力或者转矩。
根据第12方案的发明,在第5方案的发明的人类协调机器人系统中,其特征在于,
上述第一物理量是从上述外部环境受到的力或者转矩在规定的频率时的振动的振幅,上述第二物理量是上述机器人的速度。
通过参照附图所示的本发明的例示的实施方式的详细的说明,本发明的这些以及其它的目的、特征以及优点会变得更加清楚。
附图说明
图1是表示本发明的人类协调机器人系统中使用的机器人的结构例的图。
图2是第一实施方式的人类协调机器人系统的功能框图。
图3是表示由检测部检测的物理量是外力的情况的例子的图表。
图4是表示由检测部检测的物理量是外力的微分值的情况的例子的图表。
图5A是表示由检测部检测的物理量是外力的振动的振幅的情况的例子的图表。
图5B是表示由检测部检测的物理量是外力的振动的振幅的情况的例子的图表。
图6是表示第二实施方式的人类协调机器人系统中检测部的结构的功能框图。
图7A是表示由检测部检测的第一物理量是外力的情况的例子的图表。
图7B是表示由检测部检测的第二物理量是外力的微分值的情况的例子的图表。
图8A是表示由检测部检测的第一物理量是外力的情况的例子的图表。
图8B是表示由检测部检测的第二物理量是外力的振动的振幅的情况的例子的图表。
图9A是表示由检测部检测的第一物理量是外力的情况的例子的图表。
图9B是表示由检测部检测的第二物理量是机器人的速度的情况的例子的图表。
图10A是表示由检测部检测的第一物理量是外力的微分值的情况的例子的图表。
图10B是表示由检测部检测的第二物理量是外力的情况的例子的图表。
图11A是表示由检测部检测的第一物理量是外力的微分值的情况的例子的图表。
图11B是表示由检测部检测的第二物理量是机器人的速度的情况的例子的图表。
图12A是表示由检测部检测的第一物理量是外力的振动的振幅的情况的例子的图表。
图12B是表示由检测部检测的第二物理量是外力的情况的例子的图表。
图13A是表示由检测部检测的第一物理量是外力的振动的振幅的情况的例子的图表。
图13B是表示由检测部检测的第二物理量是机器人的速度的情况的例子的图表。
图14是表示第一变形例中由检测部检测的物理量是外力的情况的例子的图表。
图15A是表示第二变形例中由检测部检测的第一物理量是外力的情况的例子的图表。
图15B是表示第二变形例中由检测部检测的第二物理量是机器人的速度的情况的例子的图表。
具体实施方式
以下,参照附图对本发明的实施方式进行说明。为了有助本发明的理解,适当地变更图示的结构要素的比例尺。并且,对于相同或者对应的构成要素使用相同的符号。
图1是表示本发明的人类协调机器人系统(以下,仅称作“机器人系统”。)的结构例的图。机器人系统10是以机器人3以及人类共用作业空间为目的而构成的。机器人3例如是图示的六轴垂直多关节机器人。然而,机器人3也可以是具有其它任意的结构的公知的机器人。机器人3通过设于各关节轴的伺服马达33(仅图示几个伺服马达)而以具有所希望的位置以及姿势的方式进行动作。机器人3的各伺服马达33根据经由通信电缆5等公知的通信手段从控制装置4送出的控制指令而被驱动。
机器人3通过安装于臂31的前端的手腕32的末端执行器(未图示)而能够执行所希望的作业。末端执行器是能够根据用途而更换的外部装置,例如是把持对象物的手部、焊枪、工具等。
机器人3具备检测机器人3的动作状态的各种传感器(未图示)。传感器例如包括检测作用于机器人3的外力的力传感器、检测作用于机器人3的各关节轴的转矩的转矩传感器、检测机器人3的加速度的加速度传感器、检测伺服马达33的旋转位置的编码器、以及其它三维测定器等,但并不限定于此。各种传感器也可以内置于机器人3的机体内部,也可以安装于机器人3的机体外部。
控制装置4是具有硬件结构的数字计算机,该硬件结构包括CPU、RAM、ROM、以及与显示设备及输入设备等外部装置之间收发信号或数据的接口等。图2是一个实施方式的机器人系统10的功能框图。如图示,控制装置4具备指令制作部41、检测部42以及停止指令部43。
指令制作部41制作针对机器人3的控制指令。例如为了根据存储于ROM的机器人程序44使机器人3执行规定的作业而制作控制指令。并且,指令制作部41根据从后述的停止指令部43送出的信号,制作为了安全而使机器人3停止的停止指令。
检测部42与设于机器人3的各种传感器6配合,来检测与机器人3的动作状态相关的物理量。由检测部42检测的物理量是根据机器人3与外部环境(例如机器人3的周围的物体或者作业者)接触时产生的接触力而变化的物理量。由检测部42检测的物理量具有根据机器人3受到的接触力的大小而增减的性质,例如是作用于机器人3的外力(力或者转矩)、关于时间的外力的微分值、外力的振动的振幅、机器人3的速度等。检测部42从传感器6的检测值直接地取得上述物理量,或者基于传感器6的检测值通过运算而间接地取得上述物理量。
停止指令部43比较由检测部42检测的规定的物理量和预先决定的阈值,基于其比较结果判定是否应该使机器人3紧急停止,或者是否应该使该机器人3平稳停止。“紧急停止”是指使机器人3尽量迅速地停止的停止处理。另一方面,“平稳停止”是指与紧急停止相比,使机器人3花费更长的停止时间平稳地停止的停止处理。当执行平稳停止时,控制装置4例如将减速度限制为规定的值以下,或者使机器人3向作用于机器人3与外部环境之间的接触力变小的方向退避,来使机器人3平稳地停止。
根据一个实施方式,当由检测部42检测的物理量为第一阈值Th1以上、而且不足第二阈值Th2时,停止指令部43以使机器人3平稳停止的方式向指令制作部41送出规定的信号。并且,当物理量为第二阈值Th2以上时,停止指令部43以使机器人3紧急停止的方式向指令制作部41送出对应的信号。此外,当物理量不足第一阈值Th1时,视为不产生机器人3与外部环境的接触。在该情况下,不从停止指令部43向指令制作部41送出信号,机器人3根据机器人程序44的内容继续规定的作业。
在上述的实施方式的机器人系统10中,由于根据检测的物理量的大小来选择性地执行机器人3的停止动作,所以当接触所引起的危险度高时,使机器人3迅速停止,确保机器人以及作业者的安全,并且当接触所引起的危险度比较低时,以对作业者给予安心感的形态使机器人3平稳停止。由此,能够确保机器人以及外部环境的安全,并且可提供作业者能够安心作业的作业环境。
参照图3~图6对第一实施方式的机器人系统10中的停止指令部43所进行的机器人3的停止方法的选择进行说明。
图3是表示由检测部42检测的物理量是作用于机器人3的外力(力或者转矩)的情况的例子的图表。作用于机器人3的外力例如通过设于机器人3的手腕32或机器人3的基体(固定于地板面的非可动部)等机器人3的机体的力传感器、或者设于机器人3的关节轴的转矩传感器等来检测。由检测部42检测的外力是机器人3与外部环境接触时机器人3受到的反作用力。因此,推断随着由检测部42检测的外力增大,而外部环境、例如作业者的危险性增大。
图3的图表的横轴表示时间,纵轴表示外力。图表的点线表示第一阈值Th1,虚线表示第二阈值Th2。在图示的例子中,在时间t1,由检测部42检测的外力达到第一阈值Th1。因此,在时间t1视为机器人3已与外部环境接触,停止指令部43以使机器人3平稳停止的方式向指令制作部41送出信号。
在图示的例子中,使机器人3平稳停止后的结果,能够以使外力不会超过第二阈值Th2的方式停止了机器人3。另一方面,尽管欲使机器人3平稳停止,但在外力达到了第二阈值Th2以上的情况下,停止指令部43向指令制作部41送出信号,而使机器人3紧急停止。此外,在使用多个力传感器或者多个转矩传感器的情况下,当在任一个传感器中检测到机器人与外部环境的接触后,执行机器人3的停止处理。
图4是表示由检测部42检测的物理量是作用于机器人3的外力(力或者转矩)的关于时间的微分值的情况的例子的图表。图4的图表的横轴表示时间,纵轴表示外力的微分值。在该情况下,检测部42基于由传感器6检测的作用于机器人3的外力,来运算外力的微分值。外力的微分值相对于机器人3接触外部环境时的接触力的大小具有相关关系。例如,在与机器人3接触的外部环境是柔软的物体(例如人类的身体)的情况下,物体变形来吸收一部分的力。其结果,外力的变化量、即外力的微分值变小。另一方面,在物体由刚性高的材料形成的情况下,由于与机器人3接触时物体不变形,所以外力的变化量、即外力的微分值变大。因此,可以说有如下趋势:随着外力的微分值增大,机器人3与外部环境的接触所引起的危险性增大。
图4的图表的点线表示第一阈值Th1,虚线表示第二阈值Th2。在图示的例子中,在时间t1,由检测部42检测的外力的微分值取得第一阈值Th1以上的值。因此,在时间t1视为机器人3已与外部环境接触,停止指令部43以使机器人3平稳停止的方式向指令制作部41送出信号。另一方面,尽管欲执行平稳停止,但在外力的微分值达到了第二阈值Th2以上的情况下,停止指令部43向指令制作部41送出信号,而使机器人3紧急停止。
图5A以及图5B是表示由检测部42检测的物理量是作用于机器人3的外力的振动的振幅的情况的例子的图表。图5A的横轴表示时间,纵轴表示外力。图5A的图表所示的外力包括噪声,伴随比较小的振幅而振动。当机器人3与外部环境接触时,机器人3的振动增大,其结果,规定的频率时的外力的振动的振幅增大。
图5B的图表的纵轴表示通过运算从图5A的外力求出的规定的频率时的外力的振动的振幅。即,根据本实施方式,检测部42基于来自传感器6的外力的检测值,运算外力的振动的振幅。在外力的振动的振幅达到了第一阈值Th1以上的时间t1,外力停止指令部43以使机器人3平稳停止的方式向指令制作部41送出信号。并且,在外力的振动的振幅达到了Th2以上的情况下,视为机器人3与外部环境的接触所引起的危险性高,而停止指令部43以使机器人3紧急停止的方式向指令制作部41送出信号。
图6是表示第二实施方式的机器人系统10中检测部42的结构的功能框图。在本实施方式中,机器人系统10基于两种不同物理量(以下,称作“第一物理量”、“第二物理量”。),控制机器人3的停止动作。检测部42如图示地具备第一检测部42a以及第二检测部42b。第一检测部42a以及第二检测部42b分别检测第一物理量以及第二物理量。第一物理量以及第二物理量分别是根据机器人3与外部环境接触时的接触力而变化的物理量。第一物理量以及第二物理量是相互不同的物理量,但也可以分别直接或间接地从相同的传感器6取得。或者,第一物理量以及第二物理量也可以分别从相互不同的传感器取得。
根据本实施方式,在由第一检测部42a检测的第一物理量为第一阈值Th1以上、而且由第二检测部42b检测的第二物理量不足第三阈值Th3时,停止指令部43以使机器人3平稳停止的方式向指令制作部41送出规定的信号。并且,在第一物理量为第一阈值Th1以上、而且第二物理量为第三阈值Th3以上时,停止指令部43以使机器人3紧急停止的方式向指令制作部41送出对应的信号。参照图7A~图13B,对本实施方式的应用例进行说明。
图7A以及图7B分别表示由第一检测部42a检测的第一物理量是作用于机器人3的外力、由第二检测部42b检测的第二物理量是外力的微分值的情况的例子。即,图7A的图表的纵轴是外力,图7B的图表的纵轴是外力的微分值。如图7A所示,由第一检测部42a检测的外力在时间t1达到第一阈值Th1。因此,停止指令部43在时间t1判定为机器人3与外部环境接触。在该情况下,停止指令部43比较图7B所示的外力的微分值和第三阈值Th3,判定是应该使机器人3平稳停止、或者应该使之紧急停止。
即,在外力为第一阈值Th1以上、而且外力的微分值不足第三阈值Th3时,停止指令部43使机器人3平稳停止,并且在外力为第一阈值Th1以上、而且外力的微分值为第三阈值Th3以上时,停止指令部43使机器人3紧急停止。
图8A以及图8B分别表示由第一检测部42a检测的第一物理量是作用于机器人3的外力、由第二检测部42检测的第二物理量是规定频率时的外力的振动的振幅的情况的例子。根据本实施方式,当外力为第一阈值Th1以上、而且外力的振动的振幅不足第三阈值Th3时,停止指令部43使机器人3平稳停止。并且,当外力为第一阈值Th1以上、而且外力的振动的振幅为第三阈值Th3以上时,停止指令部43使机器人3紧急停止。在图示的例子的情况下,如图8B所示,外力的振动的振幅不足第三阈值Th3。因此,停止指令部43以使机器人3平稳停止的方式向指令制作部41送出对应的信号。
图9A以及图9B分别表示由第一检测部42a检测的第一物理量是作用于机器人3的外力、由第二检测部42b检测的第二物理量是机器人3的速度的情况的例子。当机器人3与外部环境接触时,根据机器人3的速度的大小,接触时的冲击变大。因此,能够视为:随着机器人3的速度增大,针对机器人3以及外部环境的危险性增大。例如基于加速度传感器的检测值、或者相对于各个伺服马达33设置的编码器等的检测值,并通过运算而求出机器人3的速度。
即,根据本实施方式,当外力为第一阈值Th1以上、而且机器人3的速度不足第三阈值Th3时,停止指令部43使机器人3平稳停止。另外,当外力为第一阈值Th1以上、而且机器人3的速度为第三阈值以上时,停止指令部43使机器人3紧急停止。
图10A以及图10B分别表示由第一检测部42a检测的第一物理量是作用于机器人3的外力的关于时间的微分值、由第二检测部42b检测的第二物理量是作用于机器人3的外力的情况的例子。即,当外力的微分值为第一阈值Th1以上、而且外力不足第三阈值Th3时,停止指令部43使机器人3平稳停止。另外,当外力的微分值为第一阈值Th1以上、而且外力为第三阈值Th3以上时,停止指令部43使机器人3紧急停止。
图11A以及图11B分别表示由第一检测部42a检测的第一物理量是作用于机器人3的外力的关于时间的微分值、由第二检测部42b检测的第二物理量是机器人3的速度的情况的例子。即,当外力的微分值为第一阈值Th1以上、而且机器人3的速度不足第三阈值Th3时,停止指令部43使机器人3平稳停止。另外,当外力的微分值为第一阈值Th1以上、而且机器人3的速度为第三阈值Th3以上时,停止指令部43使机器人3紧急停止。
图12A以及图12B分别表示由第一检测部42a检测的第一物理量是规定的频率时的外力的振动的振幅、由第二检测部42b检测的第二物理量是作用于机器人3的外力的情况的例子。即,当外力的振动的振幅为第一阈值Th1以上、而且外力不足第三阈值Th3时,停止指令部43使机器人3平稳停止。另外,当外力的振动的振幅为第一阈值Th1以上、而且外力为第三阈值Th3以上时,停止指令部43使机器人3紧急停止。
图13A以及图13B分别表示由第一检测部42a检测的第一物理量是规定的频率时的外力的振动的振幅、由第二检测部42b检测的第二物理量是机器人3的速度的情况的例子。即,当外力的振动的振幅为第一阈值Th1以上、而且机器人3的速度不足第三阈值Th3时,停止指令部43使机器人3平稳停止。另外,当外力为第一阈值Th1以上、而且机器人3的速度为第三阈值Th3以上时,停止指令部43使机器人3紧急停止。
在其它的实施方式中,也可以将物理量与三个以上的阈值进行比较,来阶段性地控制机器人3的停止动作。图14是说明将该思想用于第一实施方式的变形例的图表。图14中以虚线表示第一~第六阈值Th1~Th6。根据由检测部42检测的物理量、即该情况下的外力是否被包括在任意两个阈值之间的范围,停止指令部43阶段性地执行停止处理。即,控制装置4选择执行停止方法,以便在例如外力被包括在第四阈值Th4与第五阈值Th5之间的情况下,以比外力被包括在第三阈值Th3与第四阈值Th4之间的情况短的时间使机器人3停止。因此,指令制作部41根据从停止指令部43送出的信号,与由检测部42检测的外力增大对应,制作停止指令以便以更短的时间使机器人3停止。
图15A以及图15B是对将参照图14而说明的思想应用于第二实施方式的变形例进行说明的图表。在图示的例子中,由第一检测部42a(参照图6)检测的第一物理量是作用于机器人3的外力,由第二检测部42b检测的第二物理量是机器人3的速度。在由第一检测部42a检测的外力为第一阈值Th1以上的情况下,停止指令部43与机器人3的速度是否超过第三阈值Th3~第八阈值Th8中任一个阈值的情况对应,来相对于指令制作部41送出信号。指令制作部41根据从停止指令部43送出的信号,与机器人3的速度增大的情况对应,制作停止指令以便阶段性地以更短的时间使机器人3停止。
发明的效果如下。
根据本发明的人类协调机器人系统,基于与机器人接触外部环境时的接触力对应地变化的物理量,选择性地应用停止时间不同的停止方法而使机器人停止。即,当对于机器人的周围的作业者的危险性高时,使机器人紧急停止,并且当危险性低时使机器人平稳地停止。由此,提供能够确保机器人以及外部环境的安全、同时能够进行对作业者给予安心感的平稳停止的人类协调机器人系统。
以上,对本发明的各种实施方式进行了说明,但若是本领域技术人员,就会理解,通过其它的实施方式也能够实现本发明的期望的作用效果。尤其在不脱离本发明的范围的情况下,能够削除或者置换上述的实施方式的构成要素,或者还能够附加公知的机构。并且,通过任意组合本说明书中明示或者暗示地公开的多个实施方式的特征,也能够实施本发明,这对于本领域技术人员是不言而喻的。

Claims (12)

1.一种人类协调机器人系统,构成为机器人以及人类共用作业空间,其特征在于,具备:
检测部,其直接或者间接地检测与在机器人接触外部环境时机器人所受到的接触力对应地变化的物理量;以及
停止指令部,其将由上述检测部检测到的物理量与第一阈值以及比第一阈值大的第二阈值分别进行比较,在上述物理量为上述第一阈值以上而且不足上述第二阈值时,使上述机器人根据规定的停止方法停止,并且在上述物理量为上述第二阈值以上时,使上述机器人以比上述规定的停止方法短的时间停止。
2.根据权利要求1所述的人类协调机器人系统,其特征在于,
上述物理量是上述机器人从上述外部环境受到的力或者转矩。
3.根据权利要求1所述的人类协调机器人系统,其特征在于,
上述物理量是上述机器人从上述外部环境受到的力或者转矩的关于时间的微分值。
4.根据权利要求1所述的人类协调机器人系统,其特征在于,
上述物理量是从上述外部环境受到的力或者转矩在规定的频率时的振动的振幅。
5.一种人类协调机器人系统,构成为机器人以及人类共用作业空间,其特征在于,具备:
第一检测部,其直接或者间接地检测与在机器人接触外部环境时机器人所受到的接触力对应地变化的第一物理量;
第二检测部,其直接或者间接地检测与在机器人接触外部环境时机器人所受到的接触力对应地变化的第二物理量;以及
停止指令部,其将由上述第一检测部检测到的上述第一物理量与第一阈值进行比较,并且将由上述第二检测部检测到的上述第二物理量与第三阈值进行比较,当上述第一物理量为上述第一阈值以上而且上述第二物理量不足上述第三阈值时,使上述机器人根据规定的停止方法停止,并且当上述第一物理量为上述第一阈值以上而且上述第二物理量为上述第三阈值以上时,使上述机器人以比上述规定的停止方法短的时间停止。
6.根据权利要求5所述的人类协调机器人系统,其特征在于,
上述第一物理量是上述机器人从上述外部环境受到的力或者转矩,上述第二物理量是上述机器人从上述外部环境受到的力或者转矩的关于时间的微分值。
7.根据权利要求5所述的人类协调机器人系统,其特征在于,
上述第一物理量是上述机器人从上述外部环境受到的力或者转矩,上述第二物理量是从上述外部环境受到的力或者转矩在规定的频率时的振动的振幅。
8.根据权利要求5所述的人类协调机器人系统,其特征在于,
上述第一物理量是上述机器人从上述外部环境受到的力或者转矩,上述第二物理量是上述机器人的速度。
9.根据权利要求5所述的人类协调机器人系统,其特征在于,
上述第一物理量是上述机器人从上述外部环境受到的力或者转矩的关于时间的微分值,上述第二物理量是上述机器人从上述外部环境受到的力或者转矩。
10.根据权利要求5所述的人类协调机器人系统,其特征在于,
上述第一物理量是上述机器人从上述外部环境受到的力或者转矩的关于时间的微分值,上述第二物理量是上述机器人的速度。
11.根据权利要求5所述的人类协调机器人系统,其特征在于,
上述第一物理量是从上述外部环境受到的力或者转矩在规定的频率时的振动的振幅,上述第二物理量是上述机器人从上述外部环境受到的力或者转矩。
12.根据权利要求5所述的人类协调机器人系统,其特征在于,
上述第一物理量是从上述外部环境受到的力或者转矩在规定的频率时的振动的振幅,上述第二物理量是上述机器人的速度。
CN201510493333.7A 2014-09-25 2015-08-12 人类协调机器人系统 Active CN105459120B (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2014-195143 2014-09-25
JP2014195143A JP5926346B2 (ja) 2014-09-25 2014-09-25 人間協調ロボットシステム

Publications (2)

Publication Number Publication Date
CN105459120A true CN105459120A (zh) 2016-04-06
CN105459120B CN105459120B (zh) 2017-05-24

Family

ID=55485883

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510493333.7A Active CN105459120B (zh) 2014-09-25 2015-08-12 人类协调机器人系统

Country Status (4)

Country Link
US (1) US9579798B2 (zh)
JP (1) JP5926346B2 (zh)
CN (1) CN105459120B (zh)
DE (1) DE102015012232A1 (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107598968A (zh) * 2017-08-10 2018-01-19 北京康力优蓝机器人科技有限公司 一种服务型机器人末端执行器的力反馈系统及实现方法
CN112440274A (zh) * 2019-09-03 2021-03-05 发那科株式会社 机器人系统
CN116394311A (zh) * 2023-06-08 2023-07-07 上海艾利特机器人有限公司 机器人急停保护处理方法、机器人及存储介质

Families Citing this family (30)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE202013105036U1 (de) * 2013-11-08 2015-02-10 Daimler Ag Erfassungseinrichtung
JP6034900B2 (ja) * 2015-03-06 2016-11-30 ファナック株式会社 動作プログラムの再開を判断するロボット制御装置
JP6259413B2 (ja) * 2015-03-23 2018-01-10 ファナック株式会社 ロボットまたは工作機械の制御装置、無線教示操作盤および自動機械システム
US9868213B2 (en) * 2015-08-11 2018-01-16 Empire Technology Development Llc Incidental robot-human contact detection
US10272568B2 (en) * 2015-09-17 2019-04-30 Canon Kabushiki Kaisha Robot apparatus, robot controlling method, program, recording medium, and assembly manufacturing method
JP6733239B2 (ja) * 2016-03-18 2020-07-29 セイコーエプソン株式会社 制御装置及びロボットシステム
DE102016210060A1 (de) * 2016-06-08 2017-12-14 Kuka Roboter Gmbh Verfahren zum sicheren Stillsetzen eines Manipulators
DE102016007520A1 (de) * 2016-06-20 2017-12-21 Kuka Roboter Gmbh Überwachung einer Roboteranordnung
JP6571618B2 (ja) * 2016-09-08 2019-09-04 ファナック株式会社 人間協調型ロボット
JP6714734B2 (ja) 2017-02-03 2020-06-24 オリンパス株式会社 医療用マニピュレータおよびその作動方法
JP6606145B2 (ja) * 2017-09-25 2019-11-13 ファナック株式会社 ロボットシステム
JP6649416B2 (ja) 2018-02-02 2020-02-19 ファナック株式会社 障害分類装置、障害分類方法及び障害分類プログラム
JP6705845B2 (ja) 2018-02-08 2020-06-03 ファナック株式会社 障害部位特定装置、障害部位特定方法及び障害部位特定プログラム
EP3546134A1 (en) * 2018-03-28 2019-10-02 BAE SYSTEMS plc Collaborative robot system
GB2574297B (en) 2018-03-28 2021-05-12 Bae Systems Plc Collaborative robot system
EP3546135A1 (en) * 2018-03-28 2019-10-02 BAE SYSTEMS plc Collaborative robot system
JP7180165B2 (ja) * 2018-07-23 2022-11-30 セイコーエプソン株式会社 ロボット、制御装置および制御方法
JP2021191594A (ja) * 2018-08-30 2021-12-16 株式会社不二越 ロボット制御装置
JP6836557B2 (ja) 2018-08-30 2021-03-03 ファナック株式会社 人間協調ロボットシステム
US10369701B1 (en) * 2018-10-30 2019-08-06 Mujin, Inc. Automated package registration systems, devices, and methods
JP7211007B2 (ja) * 2018-10-30 2023-01-24 セイコーエプソン株式会社 制御装置、ロボットシステムおよび制御方法
JP7057316B2 (ja) * 2019-04-26 2022-04-19 ファナック株式会社 ロボット
DE102019111168B3 (de) 2019-04-30 2020-08-06 Franka Emika Gmbh Vom Messbereich eines Drehmomentsensors eines Robotermanipulators abhängig erzeugbare Kraft
CN113874174A (zh) * 2019-05-29 2021-12-31 优傲机器人公司 在机器人臂与对象之间的接触的变化的检测
JP7235596B2 (ja) * 2019-05-31 2023-03-08 ファナック株式会社 協働ロボットシステム
JP7283994B2 (ja) * 2019-06-21 2023-05-30 ファナック株式会社 ロボットの制御装置およびプログラミング装置
DE102020106418A1 (de) 2020-03-10 2021-09-16 Bayerische Motoren Werke Aktiengesellschaft Vorrichtung zum Aufbringen von Kräften auf eine Umgebung
US20230120261A1 (en) * 2020-03-12 2023-04-20 Fanuc Corporation Robot control device, robot system, and robot control method
US11897706B2 (en) 2021-03-30 2024-02-13 Dexterity, Inc. Robotic system with zone-based control
WO2023157261A1 (ja) * 2022-02-18 2023-08-24 ファナック株式会社 ロボット制御装置

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101396832A (zh) * 2007-09-27 2009-04-01 发那科株式会社 基于机器人手指部的速度使机器人停止的机器人控制装置
JP2011104740A (ja) * 2009-11-19 2011-06-02 Mitsubishi Electric Corp 力制御装置
CN102785253A (zh) * 2011-04-06 2012-11-21 发那科株式会社 具有机器人的异常检测功能的机器人系统及其控制方法
JP2013111697A (ja) * 2011-11-29 2013-06-10 Kawasaki Heavy Ind Ltd 内圧防爆構造を有する多関節ロボットの制御システム及び方法
CN103157991A (zh) * 2011-12-14 2013-06-19 通用汽车环球科技运作有限责任公司 紧急情况停止事件期间的机器人控制
CN103192413A (zh) * 2012-01-06 2013-07-10 沈阳新松机器人自动化股份有限公司 一种无传感器的机器人碰撞检测保护装置及方法

Family Cites Families (25)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1170490A (ja) * 1997-06-30 1999-03-16 Nachi Fujikoshi Corp 産業用ロボットの衝突検出方法
US6246924B1 (en) * 1998-11-30 2001-06-12 Honda Of America Mfg., Inc. Apparatus and method for automatically realigning an end effector of an automated equipment to prevent a crash
JP3878054B2 (ja) * 2001-05-08 2007-02-07 三菱電機株式会社 ロボット制御装置
WO2007018412A1 (en) * 2005-08-11 2007-02-15 Korea University Industry and Academy Cooperation Foundation Safety unit and safety device with the same
KR101412130B1 (ko) * 2008-03-14 2014-06-27 삼성전자주식회사 컴플라이언트 조인트
WO2009142006A1 (ja) * 2008-05-21 2009-11-26 パナソニック株式会社 ロボットの異常判定方法
JP5375062B2 (ja) 2008-12-10 2013-12-25 株式会社安川電機 ロボットシステムおよび制御方法
JP5177008B2 (ja) * 2009-02-20 2013-04-03 株式会社安川電機 ロボットの制御装置およびロボット
JP5311294B2 (ja) * 2010-04-28 2013-10-09 株式会社安川電機 ロボットの接触位置検出装置
JP5383911B2 (ja) * 2010-06-22 2014-01-08 株式会社東芝 ロボット制御装置
JP4938118B2 (ja) * 2010-08-17 2012-05-23 ファナック株式会社 人間協調ロボットシステム
JP5664543B2 (ja) * 2011-12-26 2015-02-04 東京エレクトロン株式会社 搬送装置及び搬送方法
JP5962020B2 (ja) * 2012-01-17 2016-08-03 セイコーエプソン株式会社 ロボット制御装置、ロボットシステム、ロボット及びロボット制御方法
JP5616478B1 (ja) * 2013-04-18 2014-10-29 ファナック株式会社 ワークを搬送するロボットを備えるロボットシステム
CN104608113B (zh) * 2013-11-01 2018-07-17 精工爱普生株式会社 机器人、机器人系统以及机器人控制装置
EP3070837A4 (en) * 2013-11-13 2017-11-22 Mitsubishi Electric Corporation Control device for rotary machine, and electric power steering apparatus
JP5820013B1 (ja) * 2014-04-30 2015-11-24 ファナック株式会社 ワークを把持して搬送するロボットの安全監視装置
JP2015217451A (ja) * 2014-05-14 2015-12-07 ファナック株式会社 外力監視機能を有するワーク搬送方法システム
JP6193816B2 (ja) * 2014-06-20 2017-09-06 ファナック株式会社 アームの退避機能を有する多関節ロボット
JP6140114B2 (ja) * 2014-07-31 2017-05-31 ファナック株式会社 移動式人協調型ロボット
JP5927284B1 (ja) * 2014-12-22 2016-06-01 ファナック株式会社 人との接触力を検出してロボットを停止させるロボット制御装置
JP5937706B1 (ja) * 2015-01-21 2016-06-22 ファナック株式会社 ロボットに加わる外力に基づいてロボットを制御するロボット制御装置、およびロボットシステム
JP6034895B2 (ja) * 2015-02-20 2016-11-30 ファナック株式会社 外力に応じてロボットを退避動作させる人間協調ロボットシステム
JP6055002B2 (ja) * 2015-02-20 2016-12-27 ファナック株式会社 ロボットを退避動作させる人間協調ロボットシステム
JP6034900B2 (ja) * 2015-03-06 2016-11-30 ファナック株式会社 動作プログラムの再開を判断するロボット制御装置

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101396832A (zh) * 2007-09-27 2009-04-01 发那科株式会社 基于机器人手指部的速度使机器人停止的机器人控制装置
JP2011104740A (ja) * 2009-11-19 2011-06-02 Mitsubishi Electric Corp 力制御装置
CN102785253A (zh) * 2011-04-06 2012-11-21 发那科株式会社 具有机器人的异常检测功能的机器人系统及其控制方法
JP2013111697A (ja) * 2011-11-29 2013-06-10 Kawasaki Heavy Ind Ltd 内圧防爆構造を有する多関節ロボットの制御システム及び方法
CN103157991A (zh) * 2011-12-14 2013-06-19 通用汽车环球科技运作有限责任公司 紧急情况停止事件期间的机器人控制
CN103192413A (zh) * 2012-01-06 2013-07-10 沈阳新松机器人自动化股份有限公司 一种无传感器的机器人碰撞检测保护装置及方法

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107598968A (zh) * 2017-08-10 2018-01-19 北京康力优蓝机器人科技有限公司 一种服务型机器人末端执行器的力反馈系统及实现方法
CN112440274A (zh) * 2019-09-03 2021-03-05 发那科株式会社 机器人系统
CN116394311A (zh) * 2023-06-08 2023-07-07 上海艾利特机器人有限公司 机器人急停保护处理方法、机器人及存储介质
CN116394311B (zh) * 2023-06-08 2023-08-29 上海艾利特机器人有限公司 机器人急停保护处理方法、机器人及存储介质

Also Published As

Publication number Publication date
US20160089790A1 (en) 2016-03-31
DE102015012232A1 (de) 2016-03-31
US9579798B2 (en) 2017-02-28
CN105459120B (zh) 2017-05-24
JP5926346B2 (ja) 2016-05-25
JP2016064474A (ja) 2016-04-28

Similar Documents

Publication Publication Date Title
CN105459120A (zh) 人类协调机器人系统
US9346162B2 (en) Robot system, control device of robot, and robot control device
JP5311294B2 (ja) ロボットの接触位置検出装置
US10564635B2 (en) Human-cooperative robot system
KR102231551B1 (ko) 운동학적 리던던트 로봇의 감시
US8712589B2 (en) System and method for judging success or failure of work of robot
US9333652B2 (en) Safety monitoring system for human-machine symbiosis and method using the same
US11548153B2 (en) Robot comprising safety system ensuring stopping time and distance
US10960549B2 (en) Vibration analyzer and vibration analysis method
CN104626171A (zh) 基于六维力传感器的机械臂碰撞检测与响应方法
CN104626208A (zh) 航天器机械臂辅助装配安全工作空间建立及干涉预警方法
US11511429B2 (en) Method of improving safety of robot and method of evaluating safety of robot
CN106493711A (zh) 控制装置、机器人以及机器人系统
US20200030992A1 (en) Robot System
CN109318244A (zh) 多关节机器人的控制装置
Wisanuvej et al. Blind collision detection and obstacle characterisation using a compliant robotic arm
KR101487624B1 (ko) 로봇 머니퓰레이터 제어 방법
JP5569953B2 (ja) 高速高精度な接触作業に適用するロボット制御システム、ロボット制御方法、ロボット制御装置、およびプログラム
CN112440274A (zh) 机器人系统
CN112621751B (zh) 机器人的碰撞检测方法及装置、机器人
KR20190048663A (ko) 로봇의 안전성 평가 방법
KR102645792B1 (ko) 로봇 매니퓰레이터의 충격량을 산출하는 검출장치 및 방법
KR101968751B1 (ko) 충돌 감지 장치, 그를 갖는 엔드 이펙터, 로봇 및 그를 이용한 충돌 감지 방법
US20230158671A1 (en) Intelligent obstacle avoidance of multi-axis robot arm
JP7327991B2 (ja) 制御方法、制御プログラム、記録媒体、ロボットシステム、物品の製造方法および入力装置

Legal Events

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