CN110497400B - 一种机器人控制方法和装置 - Google Patents
一种机器人控制方法和装置 Download PDFInfo
- Publication number
- CN110497400B CN110497400B CN201910286543.7A CN201910286543A CN110497400B CN 110497400 B CN110497400 B CN 110497400B CN 201910286543 A CN201910286543 A CN 201910286543A CN 110497400 B CN110497400 B CN 110497400B
- Authority
- CN
- China
- Prior art keywords
- robot
- person
- area
- movement
- region
- 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
Images
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
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
- B25J9/1666—Avoiding collision or forbidden zones
-
- 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
- B25J9/1676—Avoiding collision or forbidden zones
-
- 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/1694—Programme 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
- B25J9/1697—Vision controlled systems
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/406—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by monitoring or safety
- G05B19/4061—Avoiding collision or forbidden zones
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40201—Detect contact, collision with human
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40202—Human robot coexistence
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40203—Detect position of operator, create non material barrier to protect operator
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40559—Collision between hand and workpiece, operator
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
本发明涉及机器人技术领域,尤其涉及一种机器人控制方法和装置,用以在人与机器人交互中保护人的安全。其中,该方法包括:检测人(10)的当前位置;根据检测到的所述人(10)的当前位置,确定围绕所述人(10)的至少两个区域(30);控制所述机器人(20)在所述至少两个区域(30)的任一区域(30)内的运动,以在所述人(10)与所述机器人(20)的交互过程中保护所述人(10)的安全。由于区域是围绕着人来设置的,人移动不会影响人与机器人的交互。并且以被保护的对象为目标,控制机器人在围绕着人的各个区域内的运动,与将机器人限制在固定空间内相比,无论人如何移动,都能够有效保护人的安全。
Description
技术领域
本发明涉及机器人技术领域,尤其涉及一种机器人控制方法和装置。
背景技术
在生产制造等工业领域中,越来越多的任务需要依赖于人和机器人的合作来完成。其中一个亟需解决的问题是如何进行人和机器人之间的安全检测。
以往在进行机器人安全防护时,通常将机器人限制在一个固定区域内(比如:锁在一个笼子里),机器人只能在该固定区域内活动。由于机器人被限制在固定区域内,无法配合人的移动而移动,进而限制了人与机器人的交互。并且当人突然移动落入该固定区域内时,机器人可能会对人造成伤害。
发明内容
有鉴于此,本公开提供一种机器人控制方法和装置,既能够有效保护人的安全,又能够保证人与机器人的交互。其中,通过检测人的当前位置来确定围绕人的各个区域,并通过控制机器人在这些区域内的运动来保护人在与机器人交互过程中的安全。由于这些区域是围绕着人来设置的,会随着人的移动而移动,因此即使人移动也不会影响人与机器人的交互。并且这种围绕人来设置区域的方式,以被保护的对象为目标,控制机器人在围绕着人的各个区域内的运动,与将机器人限制在固定空间内相比,无论人如何移动,都能够有效保护人的安全。
本公开目的是通过权利要求1提供的机器控制方法,权利要求8、14提供的机器人控制装置以及权利要求15提供的机器可读介质来实现的。其中,本公开优选的实施例由从属权利要求提供。从属权利要求中的特征可与相应的独立权利要求中的特征相结合,并且除非特别声明,各从属权利要求也可以相互接合。
第一方面,提供一种机器人控制方法,用于对与一个人进行交互的一个机器人进行控制,包括:
检测所述人的当前位置;
根据检测到的所述人的当前位置,确定围绕所述人的至少两个区域;
控制所述机器人在所述至少两个区域的任一区域内的运动,以在所述人与所述机器人的交互过程中保护所述人的安全。
第二方面,提供一种机器人控制装置,用于对与一个人进行交互的一个机器人进行控制,包括:
一个检测模块,用于检测所述人的当前位置;
一个区域确定模块,用于根据所述检测模块检测到的所述人的当前位置,确定围绕所述人的至少两个区域;
一个机器人控制模块,用于控制所述机器人在所述至少两个区域的任一区域内的运动,以在所述人与所述机器人的交互过程中保护所述人的安全。
第三方面,提供一种机器人控制装置,包括:
至少一个存储器,用于存储机器可读代码;
至少一个处理器,用于调用所述机器可读代码执行上述第一方面提供的方法。
第四方面,提供一种机器可读介质,所述机器可读介质上存储有机器可读代码,所述机器可读代码在被至少一个处理器调用时,执行上述第一方面提供的方法。
可选地,可通过如下方式控制机器人的运动:
检测所述机器人的当前位置;
确定所述机器人的当前位置所进入的区域;
按照所述机器人的当前位置所进入的区域对应配置的控制方式,控制所述机器人的运动。
可选地,围绕所述人的所述至少两个区域的类型包括下列类型中的至少一种:禁止运动区域;允许交互区域;自由运动区域,其中可禁止所述机器人在所述禁止运动区域中运动;允许所述机器人在所述允许交互区域中与所述人进行交互;允许所述机器人在所述自由运动区域中自由运动。
可选地,所述禁止运动区域可包括下列区域中的至少一个:
围绕着所述人的除了与所述机器人交互时所使用的交互部位之外的其他部位的第一禁止运动区域;
根据记录的所述人的最高位置而确定的第二禁止运动区域,其中,所述第二禁止运动区域用于在所述人突然移动时保护所述人的安全;以及
包围所述允许交互区域的第三禁止运动区域。
可选地,所述至少两个区域的类型还包括缓慢运动区域,其中,所述缓慢运动区域包围所述禁止运动区域,其中,可控制所述机器人在所述缓慢运动区域中运动的速度不高于预设的速度阈值。
其中对围绕人的各个区域进行上述分类设置,通过禁止机器人在禁止运动区域内运动来保护人的关键部位的安全;通过将人与机器人进行交互的部位(比如:手)周围设置为允许交互区域,控制机器人在该区域内与人交互,在保证人的安全前提下使得人与机器人可以有效交互;通过将围绕着允许交互区域的一个区域设置为禁止运动区域,这样当机器人与人接近时停止,而由人主动向机器人移动,从而使机器人进入允许交互区域,由人来主导交互过程而非机器人,可以更有效地保护人的安全;通过将围绕着禁止运动区域的外围区域设置为缓慢运动区域,使得机器人在向人的移动过程中,进入禁止区域之前能够有足够的时间将速度降下来,保证机器人在禁止运动区域内静止,有效保护人的安全;考虑到人的突然移动,比如跌倒、挥手等,根据记录的人的最高位置而设置一个禁止运动区域,这样即使人突然移动机器人也不会对人造成伤害。
可选地,可为各种类型的区域分别配置优先级,当不同优先级的区域重叠时,可按照高优先级类型的区域对应配置的控制方式控制所述机器人在重叠区域内的运动。这样,就解决了不同区域重叠时对机器人控制的问题,通过设置优先级,既能够保护人的安全,又能够在人安全的前提下实现人与机器人的交互。
可选地,本公开提供的方案中对所述机器人的控制可独立于所述机器人内部控制装置而执行。其中,通过独立于机器人内部控制装置的外部装置来实现来检测人的位置、确定围绕人的各个区域,并控制机器人在这些区域内的运动,对机器人的控制不依赖于机器人内置的传感器,即使机器人内部传感器失效,也能够有效控制机器人,避免对人造成伤害。
附图说明
图1为本发明实施例中机器人控制装置控制工作方式示意图。
图2A~图2C为本发明实施例中机器人控制装置的可选的工作方式的示意图。
图3为本发明实施例提供的机器人控制方法的流程图。
图4为本发明实施例中安全区域的示意图。
图5为本发明实施例提供的机器人控制装置的一种结构示意图。
图6为本发明实施例提供的机器人控制装置的另一种结构示意图。
附图标记列表:
具体实施方式
如前所述,以往通过将机器人限制在一个固定区域进行安全防护的方式,限制了人与机器人之间的交互。也无法有效避免人在突然移动时,机器人可能对人造成的伤害。
本发明实施例中,通过检测人的当前位置来确定围绕人的各个区域,并通过控制机器人在这些区域内的运动来保护人在与机器人交互过程中的安全。由于这些区域是围绕着人来设置的,会随着人的移动而移动,因此即使人移动也不会影响人与机器人的交互。并且这种围绕人来设置区域的方式,以被保护的对象为目标,控制机器人在围绕着人的各个区域内的运动,与将机器人限制在固定空间内相比,无论人如何移动,都能够有效保护人的安全。
以往的安全防护方法大都依赖于机器人内置的传感器对机器人进行控制,避免机器人对人造成伤害,但是当机器人失控时,与机器人交互的人就处于比较危险的情况。本发明实施例中,可通过独立于机器人内部控制装置的外部装置来实现来检测人的位置、确定围绕人的各个区域,并控制机器人在这些区域内的运动,对机器人的控制不依赖于机器人内置的传感器,即使机器人内部传感器失效,也能够有效控制机器人,避免对人造成伤害。
本发明实施例,还可对围绕人的各个区域分类设置,比如:将围绕着人的头部和躯干的区域设置为禁止运动区域,禁止机器人在该区域内运动,从而保护人的关键部位的安全;将人与机器人进行交互的部位(比如:手)周围设置为允许交互区域,控制机器人在该区域内与人交互,在保证人的安全前提下使得人与机器人可以有效交互;将围绕着允许交互区域的一个区域设置为禁止运动区域,这样当机器人与人接近时停止,而由人主动向机器人移动,从而使机器人进入允许交互区域,由人来主导交互过程而非机器人,可以更有效地保护人的安全。此外,还可将围绕着禁止运动区域的外围区域设置为缓慢运动区域,使得机器人在向人的移动过程中,进入禁止区域之前能够有足够的时间将速度降下来,保证机器人在禁止运动区域内静止,有效保护人的安全。此外,考虑到人的突然移动,比如跌倒、挥手等,根据记录的人的最高位置而设置一个禁止运动区域,这样即使人突然移动机器人也不会对人造成伤害。
下面结合附图对本发明实施例进行详细说明。
图1示出了本发明实施例中,机器人控制装置40在人10与机器人20的交互过程中,控制机器人20的方式示意图。
其中,机器人控制装置40检测人10的当前位置,并根据检测到的人10的当前位置,确定围绕人10的至少两个区域30,进而控制机器人20在至少两个区域30的任一区域30内的运动,以在人10与机器人20的交互过程中保护人10的安全。
其中,机器人控制装置40可独立于机器人20内部控制装置而运行,也可由机器人20内部控制装置来实现。当机器人控制装置40独立于机器人20内部控制装置运行时,可独立地检测人的位置、确定围绕人的各个区域,并控制机器人在这些区域内的运动,对机器人的控制不依赖于机器人内置的传感器,即使机器人内部传感器失效,也能够有效控制机器人。
当机器人控制装置40独立于机器人20内部控制装置运行时,可能存在的一种情况是,按照机器人20内部控制装置的控制逻辑,机器人20在当前时刻需要运动以执行某种操作;而根据机器人控制装置40的判断,机器人20已进入了离人10的头部非常近的区域,需要停止运动(以避免对人10造成伤害),则一种实现方式时,机器人控制装置40对机器人20控制的优先级高于机器人20内部控制装置,机器人20按照机器人控制装置40的指令停止运动。
机器人控制装置40在检测人10的当前位置以及控制机器人20时有多种可选的实现方式,这里以图2A~图2C为例加以说明。可采用的方式不限于这些示例。
图2A所示的例子中,机器人控制装置40通过至少一个摄像头跟踪人10和机器人20,采用图像识别等技术确定人10的当前位置,以及机器人20的当前位置,据此确定至少两个区域30,并控制机器人20在这些区域30中的运动。
图2B所示的例子中,机器人控制装置40通过至少一个摄像头跟踪人10以及机器人20上的标签412,通过确定的这些标签412的位置来确定人10的当前位置,以及机器人20的当前位置,据此确定至少两个区域30,并控制机器人20在这些区域30中的运动。
图2C所示的例子中,机器人控制装置40通过至少一个无线检测器跟踪人10以及机器人20上的标签412,其中这些标签412具有无线发射功能,可发射无线信号,无线检测器具有无线接收功能,可接收无线信号。各个标签412可以相同的发射功率发射,机器人控制装置40可将无线检测器接收到的无线信号的功率与预先知道的各个标签412的发射功率进行比较,根据信号衰减确定各个标签412与无线检测器之间的距离。并且通过无线检测器检测各个标签412发射的信号到达无线检测器时的到达角,进而无线检测器根据到达角和距离确定标签412的位置。
这里,将用于检测人10和/或机器人20的位置的摄像头、无线检测器等称为“检测器411”,将图2B和图2C中用于标记人10和/或机器人20各个部位的设备称为“标签412”。
可选地,可在不同的位置设置多个检测器411,以避免当10和/或机器人20在某些位置时,部分部位被其他部位挡住,而无法准确确定位置的问题。标签412可设置在人10穿着的保护衣物上,比如头盔、上衣、裤子、鞋、手套上。
图2B和图2C中,标签412可放置在人10的几个关键部位,比如:人的头部、躯干、手部等与机器人20交互的部位、上肢、下肢等,从而对人10的各个部位进行标记,机器人控制装置40在确定人10的当前位置时,可分别确定各个部位的位置。标签412也可放置在机器人20的几个关键部位。以机械臂为例,标签412可放置在机械臂的各个关节处以及夹子处,机器人控制装置40在确定机器人20的当前位置时,可分别确定这些被标记的各个部位的位置。机器人控制装置40在判断机器人20进入哪种区域30时,可判断机器人20的各个标签412与人10的各个标签412之间的位置关系,进而根据判断结果确定机器人20进入哪种区域30。或者,也可分别根据人10的各个标签412确定人的各个部位的位置,根据机器人20的各个标签412判断机器人20的各个部位的位置,进而根据确定的人的各个部位的位置和机器人20的各个部位的位置,判断机器人20进入哪种区域30。
下面,结合图3说明本发明实施例提供的机器人控制方法的流程。该方法可由机器人控制装置40执行。如图3所示,该流程可包括如下步骤:
S301:检测人10的当前位置。
比如可确定前述的人的各个关键部位的当前位置。
S302:确定围绕人10的至少两个区域30。
这些区域30可分为多种类型,比如:禁止运动区域301、允许交互区域302、自由运动区域303和缓慢运动区域304。其中,禁止运动区域301又可以分为第一禁止运动区域3011、第二禁止运动区域3012和第三禁止运动区域3013。这里以人10的手作为与机器人20交互的交互部位来举例说明。
S303:控制机器人20在至少两个区域30的任一区域30内的运动。
其中步骤S303又可以分为以下几个子步骤:
S3031:检测机器人20的当前位置。
S3032:确定机器人20的当前位置所进入的区域30。
S3033:按照机器人20的当前位置所进入的区域30对应配置的控制方式,控制机器人20的运动。
下面,结合图4、下表对区域30的各种类型加以说明。
上述各区域是围绕人10而设置的,区域的边界与人10的距离可依工程实践灵活设置,比如:根据机器人20的体积、人10与机器人20交互的动作等,保证人10的安全又不影响人10与机器人20交互。比如:第一禁止运动区域3011的边界与人10的头或躯干的距离不大于第一距离阈值,第二禁止运动区域3012的边界与记录的人10的最高位置之间的距离不大于第二距离阈值,允许交互区域302的边界与人10的交互部位的距离不小于第三距离阈值且不大于第四距离阈值,缓慢运动区域304的边界与禁止运动区域301的边界的距离不大于第五距离阈值等。
如上表中最后一列所示,上述各种类型的区域被分别配置优先级,步骤S303中,当不同优先级的区域30重叠时,当机器人控制装置40可按照高优先级类型的区域30对应配置的控制方式控制机器人20在重叠区域内的运动。上表中优先级从高到低依次为“最高->高->中->低”。
比如:当人10将手靠近身体时,允许交互区域302可以和第一禁止运动区域3011部分重叠,由于第一禁止运动区域3011和禁止运动区域具有“最高”优先级,而允许交互区域302具有“高”优先级,因此,当机器人20进入该重叠区域内时,按照具有较高优先级的第一禁止运动区域3011对应的控制方式,禁止机器人20在该重叠区域内的运动,从而避免机器人20对人造成伤害。另一方面,考虑到人与机器人交互时,比如通过手与机器人交互,通常会向机器人伸出手臂,而不是将手拉近身体,因此,当人的手靠近身体时,通常不是要与机器人交互。通过设置第一禁止运动区域3011、禁止运动区域和自由运动区域303的优先级,另一方面确认了人10与机器人20的交互意图。
以上介绍了本发明实施例中机器人控制装置40控制机器人的流程。下面,介绍机器人控制装置40的几种可选实现方式。
如图6所示,机器人控制装置40可包括至少一个存储器404,用于存储机器可读代码;以及至少一个处理器405,用于调用机器可读代码执行前述的机器人控制流程。
如图5所示,机器人控制装置40可包括一个检测模块401,用于检测人10的当前位置;一个区域确定模块402,用于根据检测模块401检测到的人10的当前位置,确定围绕人10的至少两个区域30;一个机器人控制模块403,用于控制机器人20在至少两个区域30的任一区域30内的运动,以在人10与机器人20的交互过程中保护人10的安全。
其中图5中的各模块可为机器人控制装置40中实现各个功能的功能模块,比如:检测模块401可用于检测人10和/或机器人20的当前位置;区域确定模块402可用于确定围绕人10的各个区域30;机器人控制模块403可用于控制机器人20在各个区域30的运动,以保证人10的安全。这些功能模块的控制逻辑可预先烧制到诸如现场可编程逻辑门阵列(FieldProgrammable Gate Array,FPGA)、复杂可编程逻辑器件(Complex Programmable LogicDevice,CPLD)、系统级芯片(System on Chip,SoC)等芯片上,芯片上电后,实现这些预先烧制的控制逻辑,实现对机器人20的控制。
其中,图5中的各模块也可视为机器人控制装置40中存储在至少一个存储器404中的机器可读代码。该机器可读代码可包括上述各模块,通过至少一个处理器405的调用,执行本发明实施例提供的机器人控制流程。
此外,本发明实施例还提供一种机器可读介质,其上存储有机器可读指令,该机器可读指令在被处理器执行时,使处理器执行前述的任一种方法。具体地,可以提供配有机器可读介质的系统或者装置,在该机器可读介质上存储着实现上述实施例中任一实施例的功能的软件程序代码,且使该系统或者装置的计算机或处理器读出并执行存储在该机器可读介质中的机器可读指令。
在这种情况下,从机器可读介质读取的程序代码本身可实现上述实施例中任何一项实施例的功能,因此机器可读代码和存储机器可读代码的机器可读介质构成了本发明的一部分。
机器可读介质的实施例包括软盘、硬盘、磁光盘、光盘(如CD-ROM、CD-R、CD-RW、DVD-ROM、DVD-RAM、DVD-RW、DVD+RW)、磁带、非易失性存储卡和ROM。可选择地,可以由通信网络从服务器计算机上或云上下载程序代码。
需要说明的是,上述各流程和各系统结构图中不是所有的步骤和模块都是必须的,可以根据实际的需要忽略某些步骤或模块。各步骤的执行顺序不是固定的,可以根据需要进行调整。上述各实施例中描述的系统结构可以是物理结构,也可以是逻辑结构,即,有些模块可能由同一物理实体实现,或者,有些模块可能分由多个物理实体实现,或者,可以由多个独立设备中的某些部件共同实现。
以上各实施例中,硬件单元可以通过机械方式或电气方式实现。例如,一个硬件单元可以包括永久性专用的电路或逻辑(如专门的处理器,FPGA或ASIC)来完成相应操作。硬件单元还可以包括可编程逻辑或电路(如通用处理器或其它可编程处理器),可以由软件进行临时的设置以完成相应操作。具体的实现方式(机械方式、或专用的永久性电路、或者临时设置的电路)可以基于成本和时间上的考虑来确定。
上文通过附图和优选实施例对本发明进行了详细展示和说明,然而本发明不限于这些已揭示的实施例,基于上述多个实施例本领域技术人员可以知晓,可以组合上述不同实施例中的代码审核手段得到本发明更多的实施例,这些实施例也在本发明的保护范围之内。
Claims (11)
1.机器人控制方法,用于对与一个人(10)进行交互的一个机器人(20)进行控制,其特征在于,包括:
检测所述人(10)的当前位置;
根据检测到的所述人(10)的当前位置,确定围绕所述人(10)的至少两个区域(30);
控制所述机器人(20)在所述至少两个区域(30)的任一区域(30)内的运动,以在所述人(10)与所述机器人(20)的交互过程中保护所述人(10)的安全,
所述至少两个区域(30)的类型包括下列类型中的至少一种:
禁止运动区域(301);
允许交互区域(302);
自由运动区域(303);
控制所述机器人(20)在所述至少两个区域(30)的任一区域(30)内的运动,包括:
禁止所述机器人(20)在所述禁止运动区域(301)中运动;
允许所述机器人(20)在所述允许交互区域(302)中与所述人(10)进行交互;
允许所述机器人(20)在所述自由运动区域(303)中自由运动,
所述至少两个区域的类型还包括缓慢运动区域(304),其中,所述缓慢运动区域(304)包围所述禁止运动区域(301);
控制所述机器人(20)在所述至少两个区域(30)的任一区域(30)内的运动,包括控制所述机器人(20)在所述缓慢运动区域(304)中运动的速度不高于预设的速度阈值。
2.如权利要求1所述的方法,其特征在于,控制所述机器人(20)在所述至少两个区域(30)的任一区域(30)内的运动,包括:
检测所述机器人(20)的当前位置;
确定所述机器人(20)的当前位置所进入的区域(30);
按照所述机器人(20)的当前位置所进入的区域(30)对应配置的控制方式,控制所述机器人(20)的运动。
3.如权利要求1所述的方法,其特征在于,所述禁止运动区域(301)包括下列区域中的至少一个:
围绕着所述人(10)的除了与所述机器人(20)交互时所使用的交互部位之外的其他部位的第一禁止运动区域(3011);
根据记录的所述人(10)的最高位置而确定的第二禁止运动区域(3012),其中,所述第二禁止运动区域(3012)用于在所述人(10)突然移动时保护所述人(10)的安全;以及
包围所述允许交互区域(302)的第三禁止运动区域(3013)。
4.如权利要求1~3任一项所述的方法,其特征在于,
所述方法还包括:为各种类型的区域分别配置优先级;
控制所述机器人(20)在所述至少两个区域(30)的任一区域(30)内的运动,包括:当不同优先级的区域(30)重叠时,按照高优先级类型的区域(30)对应配置的控制方式控制所述机器人(20)在重叠区域内的运动。
5.如权利要求1~3任一项所述的方法,其特征在于,所述方法由独立于所述机器人(20)内部控制装置的外部控制装置所执行。
6.机器人控制装置(40),用于对与一个人(10)进行交互的一个机器人(20)进行控制,其特征在于,包括:
一个检测模块(401),用于检测所述人(10)的当前位置;
一个区域确定模块(402),用于根据所述检测模块(401)检测到的所述人(10)的当前位置,确定围绕所述人(10)的至少两个区域(30);
一个机器人控制模块(403),用于控制所述机器人(20)在所述至少两个区域(30)的任一区域(30)内的运动,以在所述人(10)与所述机器人(20)的交互过程中保护所述人(10)的安全,
所述区域确定模块(402)确定的所述至少两个区域(30)的类型包括下列类型中的至少一种:
禁止运动区域(301);
允许交互区域(302);
自由运动区域(303);
所述机器人控制模块(403)具体用于:
禁止所述机器人(20)在所述禁止运动区域(301)中运动;
允许所述机器人(20)在所述允许交互区域(302)中与所述人(10)进行交互;
允许所述机器人(20)在所述自由运动区域(303)中自由运动,
所述区域确定模块(402)所确定的所述至少两个区域的类型还包括缓慢运动区域(304),其中,所述缓慢运动区域(304)包围所述禁止运动区域(301);
所述机器人控制模块(403),具体用于控制所述机器人(20)在所述缓慢运动区域(304)中运动的速度不高于预设的速度阈值。
7.如权利要求6所述的机器人控制 装置(40),其特征在于,
所述检测模块(401),还用于检测所述机器人(20)的当前位置;
所述机器人控制模块(403),具体用于确定所述机器人(20)的当前位置所进入的区域(30),并按照所述机器人(20)的当前位置所进入的区域(30)对应配置的控制方式,控制所述机器人(20)的运动。
8.如权利要求6所述的机器人控制 装置(40),其特征在于,所述区域确定模块(402)确定的所述禁止运动区域(301)包括下列区域中的至少一个:
围绕着所述人(10)的除了与所述机器人(20)交互时所使用的交互部位之外的其他部位的第一禁止运动区域(3011);
根据记录的所述人(10)的最高位置而确定的第二禁止运动区域(3012),其中,所述第二禁止运动区域(3012)用于在所述人(10)突然移动时保护所述人(10)的安全;以及
包围所述允许交互区域(302)的第三禁止运动区域(3013)。
9.如权利要求6~8任一项所述的机器人控制 装置(40),其特征在于,
所述区域确定模块(402)还用于为各种类型的区域分别配置优先级;
所述机器人控制模块(403),具体用于当不同优先级的区域(30)重叠时,按照高优先级类型的区域(30)对应配置的控制方式控制所述机器人(20)在重叠区域内的运动。
10.机器人控制装置(40),其特征在于,包括:
至少一个存储器(404),用于存储机器可读代码;
至少一个处理器(405),用于调用所述机器可读代码执行如权利要求1~5任一项所述的方法。
11.机器可读介质,所述机器可读介质上存储有机器可读代码,其特征在于,所述机器可读代码在被至少一个处理器调用时,执行如权利要求1~5任一项所述的方法。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
EP18172912.0 | 2018-05-17 | ||
EP18172912.0A EP3569366B1 (en) | 2018-05-17 | 2018-05-17 | Robot control method and apparatus |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110497400A CN110497400A (zh) | 2019-11-26 |
CN110497400B true CN110497400B (zh) | 2023-04-07 |
Family
ID=62196479
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910286543.7A Active CN110497400B (zh) | 2018-05-17 | 2019-04-10 | 一种机器人控制方法和装置 |
Country Status (3)
Country | Link |
---|---|
US (1) | US11780089B2 (zh) |
EP (1) | EP3569366B1 (zh) |
CN (1) | CN110497400B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110861124B (zh) * | 2019-11-27 | 2021-05-11 | 山东大学 | 一种机械臂作业状态下安全防碰系统 |
CN113940820B (zh) * | 2021-10-18 | 2023-01-24 | 亿慧云智能科技(深圳)股份有限公司 | 一种智能陪护座椅机器人装置及其训练学习方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104723350A (zh) * | 2015-03-16 | 2015-06-24 | 珠海格力电器股份有限公司 | 工业机器人安全防护智能控制方法及系统 |
WO2017163251A2 (en) * | 2016-03-24 | 2017-09-28 | Polygon T.R Ltd. | Systems and methods for human and robot collaboration |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004243427A (ja) * | 2003-02-12 | 2004-09-02 | Yaskawa Electric Corp | ロボット制御装置およびロボット制御方法 |
DE102009040145A1 (de) * | 2009-09-04 | 2011-03-10 | Kuka Roboter Gmbh | Verfahren und Vorrichtung zum Stillsetzen eines Manipulators |
TW201123031A (en) * | 2009-12-24 | 2011-07-01 | Univ Nat Taiwan Science Tech | Robot and method for recognizing human faces and gestures thereof |
WO2013176762A1 (en) * | 2012-05-22 | 2013-11-28 | Intouch Technologies, Inc. | Social behavior rules for a medical telepresence robot |
US9694497B2 (en) * | 2012-07-10 | 2017-07-04 | Siemens Aktiengesellschaft | Robot arrangement and method for controlling a robot |
DE202013104264U1 (de) * | 2013-09-18 | 2015-01-09 | Daimler Ag | Arbeitsstation |
US9649766B2 (en) * | 2015-03-17 | 2017-05-16 | Amazon Technologies, Inc. | Systems and methods to facilitate human/robot interaction |
EP3243609A1 (en) * | 2016-05-09 | 2017-11-15 | OpiFlex Automation AB | A fenceless industrial robot system |
TW201807523A (zh) * | 2016-08-22 | 2018-03-01 | 金寶電子工業股份有限公司 | 移動式機器人的即時導航方法 |
JP6687573B2 (ja) * | 2017-09-07 | 2020-04-22 | ファナック株式会社 | ロボットシステム |
-
2018
- 2018-05-17 EP EP18172912.0A patent/EP3569366B1/en active Active
-
2019
- 2019-04-10 CN CN201910286543.7A patent/CN110497400B/zh active Active
- 2019-05-15 US US16/412,653 patent/US11780089B2/en active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104723350A (zh) * | 2015-03-16 | 2015-06-24 | 珠海格力电器股份有限公司 | 工业机器人安全防护智能控制方法及系统 |
WO2017163251A2 (en) * | 2016-03-24 | 2017-09-28 | Polygon T.R Ltd. | Systems and methods for human and robot collaboration |
Also Published As
Publication number | Publication date |
---|---|
US11780089B2 (en) | 2023-10-10 |
CN110497400A (zh) | 2019-11-26 |
US20190351552A1 (en) | 2019-11-21 |
EP3569366B1 (en) | 2023-06-28 |
EP3569366A1 (en) | 2019-11-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3315268B1 (en) | Monitoring device and monitoring method | |
US10521625B2 (en) | Safety control device, method of controlling safety control device, and recording medium | |
CN110497400B (zh) | 一种机器人控制方法和装置 | |
JP7393857B2 (ja) | 人、ロボットおよび機械の協調作業を保護するための安全システム | |
EP3363602B1 (en) | Monitoring system, monitoring device, and monitoring method | |
JP6571288B2 (ja) | フィールド・プログラマブル・ゲート・アレイのためのファームウェア・セキュリティ・インターフェース | |
JP5846145B2 (ja) | ロボットシステム、及び、ロボットシステムの制御方法 | |
CN111226178B (zh) | 监视设备、工业系统、用于监视的方法及计算机程序 | |
US9513606B1 (en) | Safety systems and methods for production environments | |
EP2772336B1 (en) | Recognition-based industrial automation control with position and derivative decision reference | |
US20160279752A1 (en) | Device for Protecting an Operator from being Injured by a Machine Tool, and Method for this Purpose | |
CN105094080B (zh) | 访问控制系统中的动态主体跟踪和多标记的系统和方法 | |
CN111678026A (zh) | 机器的防护 | |
KR20140077726A (ko) | 유아용 모니터링 로봇 | |
US10379514B2 (en) | Systems and methods for controlling a home automation system based on identifying a user location via a wi-fi fingerprint | |
EP2772812B1 (en) | Recognition-based industrial automation control with redundant system input support | |
WO2015140770A2 (en) | Wearable safety device and system for sawing, cutting and milling machines | |
CN110161987A (zh) | 用于保护人员免受自主操作机器影响的系统 | |
CN109794967B (zh) | 用于在使用阶段期间保护机器人的工作区域的方法和设备 | |
US11571815B2 (en) | Safety control module for a robot assembly and method of same | |
US20170097626A1 (en) | Method for automated control of a machine component | |
KR20210098478A (ko) | 정의된 객체를 식별하고 사용자에게 알리기 위한 시스템 및 방법 | |
US20170075329A1 (en) | Apparatus for workplace danger zone | |
JP2020189379A (ja) | 作業ロボットおよびその制御方法 | |
KR20110138711A (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 |