CN106346482B - 对柔性调节机器人的控制 - Google Patents

对柔性调节机器人的控制 Download PDF

Info

Publication number
CN106346482B
CN106346482B CN201610548401.XA CN201610548401A CN106346482B CN 106346482 B CN106346482 B CN 106346482B CN 201610548401 A CN201610548401 A CN 201610548401A CN 106346482 B CN106346482 B CN 106346482B
Authority
CN
China
Prior art keywords
robot
boundary
monitoring
current position
restoring force
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
CN201610548401.XA
Other languages
English (en)
Other versions
CN106346482A (zh
Inventor
M·罗梅尔
T·雷克尔
京特·施赖伯
H·默尼希
M·米勒-萨默
乌韦·博宁
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.)
KUKA Deutschland GmbH
Original Assignee
KUKA Roboter GmbH
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 KUKA Roboter GmbH filed Critical KUKA Roboter GmbH
Publication of CN106346482A publication Critical patent/CN106346482A/zh
Application granted granted Critical
Publication of CN106346482B publication Critical patent/CN106346482B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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/1628Programme controls characterised by the control loop
    • B25J9/1633Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
    • 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
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1679Programme controls characterised by the tasks executed
    • B25J9/1689Teleoperation
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B34/00Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
    • A61B34/30Surgical robots
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B34/00Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
    • A61B34/70Manipulators specially adapted for use in surgery
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/08Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/085Force or torque sensors
    • 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/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
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1679Programme controls characterised by the tasks executed
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/42Recording and playback systems, i.e. in which the programme is recorded from a cycle of operations, e.g. the cycle of operations being manually controlled, after which this record is played back on the same machine
    • G05B19/425Teaching successive positions by numerical control, i.e. commands being entered to control the positioning servo of the tool head or end effector
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/42Recording and playback systems, i.e. in which the programme is recorded from a cycle of operations, e.g. the cycle of operations being manually controlled, after which this record is played back on the same machine
    • G05B19/423Teaching successive positions by walk-through, i.e. the tool head or end effector being grasped and guided directly, with or without servo-assistance, to follow a path
    • 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/39Robotics, robotics to robotics hand
    • G05B2219/39342Adaptive impedance control
    • 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/40359Constraint, physical limitations

Abstract

一种控制柔性调节机器人的方法,包括:对机器人进行边界监控;如果机器人在激活边界监控时已处于禁止区域的位置上,通过控制技术设定第一回位力,其使机器人从该位置回到边界;如果机器人在激活边界监控后才占据禁止区域的该位置,则通过控制技术设定第二回位力,其使机器人从该位置回到边界,其中,第一回位力至少暂时小于第二回位力,特别是等于零;和/或,如果机器人朝向或平行于边界地运动一段路程,与当前位置相对于边界的距离无关地通过控制技术设定第一回位力,其使机器人从该位置回到边界;如果机器人运动离开边界相同的路程,特别是如果机器人在激活边界监控后才处于禁止区域的位置上,通过控制技术设定另一回位力,其大于第一回位力。

Description

对柔性调节机器人的控制
技术领域
本发明涉及用于控制柔性调节机器人的一种方法和一种控制器,本发明还涉及一种用于实施该方法的计算机程序产品和一种具有所述控制器的机器人组。
背景技术
由专利文献US2004/0128026A1可知一种用于控制柔性调节机器人的方法,在此,在第一自由区域中,用于生成外科手术操纵力的机器人导纳较高,而通过控制技术使被机器人束缚在当前位置上的刚性和缓冲性则较低。
在被禁止的第三区域中,通过控制技术使机器人被束缚在位于禁止区域边界上最靠近其当前位置的位置上的刚性和缓冲性非常高,以便机器人能够从禁止区域运行回去。
在第一区域和第三区域之间的第二区域中,导纳将降低,而通过控制技术使机器人被束缚在其当前位置上的刚性和缓冲性则升高。
如果在机器人在禁止区域的内部已经远离边界时激活这种边界监控,会立即使机器人产生猛烈的回位运动,这会导致意外的和/或不期望的行为。
发明内容
本发明的目的在于,对柔性调节机器人的运行进行改进。
本发明的目的通过一种用于控制柔性调节机器人的方法来实现。本发明的目的还通过一种控制器或一种用于实施所述方法的计算机程序产品或一种具有在此所述控制器的机器人组来实现。优选的扩展方案由下述的内容给出。
根据本发明的一个方面,用于控制柔性调节机器人的方法包括如下步骤:对机器人执行边界监控,在此,一旦或者说根据机器人是否在激活边界监控的情况下已经处于禁止区域中的当前位置上,通过控制技术设定或者说指定、特别是施加第一回位力,该第一回位力使得或者试图使机器人从禁止区域中的当前位置运行回到该区域的边界,并且,一旦或者说根据机器人是否在激活边界监控之后才占据或具有禁止区域中的该位置,通过控制技术设定或者说指定、特别是施加第二回位力,该第二回位力使得或试图使机器人从该(同一)位置运行回到边界,在此,第一回位力始终或至少暂时、特别是至少在激活边界监控之后小于第二回位力,特别是始终或至少暂时、特别是至少在激活边界监控之后等于零;和/或始终或至少暂时、特别是至少在激活边界监控之后最高为第二回位力的75%,特别是最高为50%,尤其是最高为25%。
根据本发明的一个方面,控制器被设计用于特别是通过硬件技术和/或软件技术来执行在此所述的方法,和/或该控制器包括:用于对机器人实行边界监控的装置;用于一旦或者说根据机器人是否在激活边界监控的情况下当前已经处于禁止区域中的一位置上,则通过控制技术设定或者说指定、特别是施加第一回位力的装置,该第一回位力使得或试图使机器人从禁止区域中的该当前位置运行回到该区域的边界;以及用于一旦或者说根据机器人是否在激活边界监控之后才占据或具有在禁止区域中的该位置,通过控制技术设定或者说指定、特别是施加第二回位力的装置,该第二回位力使得或试图使机器人从该(同一)位置运行回到边界,在此,第一回位力始终或至少暂时、特别是至少在激活边界监控之后小于第二回位力,特别是始终或至少暂时、特别是至少在激活边界监控之后等于零;和/或始终或至少暂时、特别是至少在激活边界监控之后最高为第二回位力的75%,特别是最高为50%,尤其是最高为25%。
由此可以有利地防止或者至少能够减少:由于在激活边界监控时或者说由于激活边界监控而使得机器人从禁止区域回到其边界所导致的意外和/或不期望的、由控制技术诱发的猛烈的回位运动。
相应地,在一种实施方式中确定或区分:机器人在禁止区域中所处的当前位置是否在激活边界监控时已经存在,或者是在激活边界监控之后才占据,并相应可选地设定或者说指定、特别是通过控制技术施加第一回位力或者第二回位力。相应地,在一种实施方式中,控制器具有用于进行如下确定或区分的装置:机器人在禁止区域中所处的当前位置是否在激活边界监控时已经存在,或者是在激活边界监控之后才占据。
在一种实施方式中,设定一虚拟弹簧的刚性,该虚拟弹簧通过控制技术将机器人束缚在锚固位置(Ankerposition)上,特别是束缚在边界上,在此,如果机器人在激活边界监控时已经处于禁止区域中(在一位置上),则设定、特别是实现第一刚性;如果机器人在激活边界监控之后才占据或具有禁止区域中的该同一位置或进入到禁止区域中,则设定、特别是实现第二刚性,在此,第一刚性始终或至少在激活边界监控时小于第二刚性,特别是等于零或者最高为第二刚性的75%,特别是最高为50%,尤其是最高为25%。
相应地,在一种实施方式中,控制器具有用于设定虚拟弹簧的刚性的装置,该虚拟弹簧通过控制技术将机器人束缚在锚固位置上,特别是束缚在边界上,在此,在一种实施方式中,该装置具有:用于一旦机器人在激活边界监控时已经处于禁止区域中(在一位置上),则设定第一刚性的装置;和用于如果机器人在激活边界监控之后才占据或具有禁止区域中的该同一位置或进入禁止区域,则设定第二刚性的装置,在此,第一刚性始终或至少在激活边界监控时小于第二刚性,特别是等于零,或者是最高为第二刚性的75%,特别是最高为50%,尤其是最高为25%。
在一种实施方式中,附加地或替代地,根据相对于激活边界监控的时间间隔,设定、特别是实现虚拟弹簧的刚性,特别是还或仅在机器人在激活边界监控时已经处于禁止区域中时,才设定、特别是实现虚拟弹簧的刚性,该虚拟弹簧通过控制技术将机器人束缚在锚固位置上,特别是束缚在边界上。在一种实施方式中,刚性将在激活边界监控之后随着时间的过去而增大,特别是连续地、尤其是线性的增大,或者不连续地或者说以一个或多个离散的跳跃而增大。在一种实施方式中,刚性随着时间的过去从零开始增大和/或增大至最大值。
相应地,在一种实施方式中,用于设定虚拟弹簧的刚性的装置包括一装置,用于根据相对于激活边界监控的时间间隔来设定刚性,特别是还或者仅在机器人在激活边界监控时已经处于禁止区域中时才设定刚性。
在一种实施方式中,附加地或替代地,根据机器人相对于边界的运动来设定、特别是实现虚拟弹簧的刚性,特别是在离开边界的运动中的刚性特别是始终或至少暂时地、尤其是至少在激活边界监控之后,大于在不离开边界的运动、特别是朝向边界或平行于边界的运动中的刚性,特别是还或者仅在机器人在激活边界监控时已经处于禁止区域中时才设定、特别是实现该刚性。在一种实施方式中,在不远离边界的运动中、特别是在朝向边界或平行于边界的运动中的刚性,特别是始终或至少暂时、尤其是至少在激活边界监控之后,最高为在远离边界的运动中的刚性的75%,特别是最高为50%,尤其是最高为25%。
在一种实施方式中,用于设定虚拟弹簧的刚性的装置相应地包括根据机器人相对于边界的运动来设定刚性的装置,特别是在离开边界的运动中的刚性特别是始终或至少暂时地、特别是至少在激活边界监控之后,大于在不离开边界的运动、特别是朝向边界或平行于边界的运动中的刚性,特别是还或仅在机器人在激活边界监控时已经处于禁止区域中时才设定该刚性。
通过基于控制技术实现的虚拟弹簧的这种与方向、时间和/或机器人在激活边界监控时的当前位置相关的刚性,可以有利地设定或者说指定、特别是施加第一回位力或第二回位力。
根据本发明的一个方面,该方面可以被独立地转换或者以与前述的方面相结合的形式进行转换,用于控制柔性调节机器人的方法包括以下步骤:对机器人执行边界监控,在此,通过控制技术设定或者说指定、特别是施加一个回位力或者说第一回位力,一旦机器人朝向禁止区域的边界或平行于该边界运动一段路程,该回位力将使得或试图使机器人从该区域的当前位置运行回到该区域的边界,而与该位置相对于边界的距离无关、特别是等于零;并且,一旦机器人沿离开该边界的方向运动了相同的路程,特别是还或者只是当机器人在激活边界监控时已经、特别是始终或至少暂时地、尤其是在激活边界监控之后处于禁止区域(的该位置)中,则通过控制技术设定或指定、特别是施加另一个回位力,特别是第一回位力,该另一回位力大于第一回位力,特别是第一回位力的至少125%,特别是至少150%,特别是至少200%。
相应地,在一种实施方式中,控制器包括:用于对机器人执行边界监控的装置;用于通过控制技术设定或者说指定、特别是施加一个回位力或者说第一回位力的装置,一旦机器人朝向禁止区域的边界或平行于该边界运动一段路程,则该回位力将使得或试图使机器人从该区域的当前位置运行回到该区域的边界,而与该位置相对于边界的距离无关、特别是等于零;以及用于在机器人沿离开该边界的方向运动了相同的路程,特别是还或者只是当机器人在激活边界监控时已经、特别是始终或至少暂时地、尤其是在激活边界监控之后处于禁止区域(的该位置)中时,通过控制技术设定或者说指定、特别是施加另一回位力,特别是第一回位力的装置,该另一回位力大于第一回位力,特别是第一回位力的至少125%,特别是至少150%,特别是至少200%。
换句话说,根据该方面,在柔性调节机器人的特别是手动引导的朝向边界或平行于边界的运动中需要克服的阻力将小于(远)离开边界进入禁止区域的运动中需要克服的阻力,特别是没有阻力要克服。由此,特别是可以有利地在激活边界监控时沿朝向边界的方向施加相对较小的、特别是微不足道的回位力,并由此防止或至少降低了在激活边界监控时或者说由于激活边界监控而使得机器人发生意外的和/或不期望的、由控制技术引起的、剧烈的、从禁止区域回到其边界的回位运动,并同时能够有效地防止或至少弱化了所不期望的、朝向禁止区域的进一步运动。
在一种实施方式中,通过对机器人的外部力加载、特别是手动引导,虚拟弹簧的锚固位置(机器人通过控制技术被束缚在该位置上)至少能够基本上不离开边界地移动。附加地或替代地,在一种实施方式中,将机器人的当前位置或位于当前位置和边界之间的特别是最短连接中的一个位置(该位置朝向边界地以特别是固定设定或可变设定的距离与当前位置间隔开)设定为虚拟弹簧的锚固位置,机器人通过控制技术被束缚在该锚固位置上。
相应地,在一种实施方式中,控制器包括一装置,用于将机器人的当前位置或者位于当前位置和边界之间的特别是最短连接中的一个位置(该位置朝向边界地以特别是固定设定或可变设定的距离与当前位置间隔开)设定为虚拟弹簧的锚固位置,机器人通过控制技术被束缚在该锚固位置上。
换句话说,在这种实施方式中,如果当前位置不运动离开边界,特别是如果当前位置朝向边界或平行于边界地运动,则将锚固位置设定在当前位置上或者设定在朝向边界的并相对于该当前位置间隔开一距离的位置上,或者使锚固位置跟随当前位置行进,并且,一旦机器人运动离开边界,则保持目前的锚固位置。
在一种实施方式中,所述距离要小于当前位置相对于边界的(最短)间隔。
在一种实施方式中,通过控制技术如下地设定或指定、特别是施加一缓冲力,该缓冲力反作用于机器人的运动并取决于机器人的当前速度:即,该缓冲力在所设定的最小速度之上的第二速度范围中随着机器人的当前速度所实现的增大要强于在最小速度之下的第一速度范围。
根据本发明的装置可以通过硬件技术和/或软件技术构成,特别是具有优选与存储系统和/或总线系统数据连接或者说信号连接的特别是数字处理单元,尤其是微处理单元(CPU),和/或一个或多个程序或程序模块。CPU可以被设计用于:对被设计为保存在存储系统中的程序的指令进行处理,检测来自数据总线的输入信号,和/或将输出信号输出到数据总线。存储系统可以具有一个或多个特别是不同的存储介质,尤其是光学介质、磁性介质、固体介质和/或其他的非易失性介质。程序可以被实现为,其能够体现或执行在此所述的方法,从而使CPU能够执行这种方法的步骤,并由此特别是能够控制机器人。
在一种实施方式中,柔性调节机器人是被阻抗或导纳调节的,特别是被重力补偿和/或摩擦补偿地调节,正如例如在开始部分所提到的专利文献US2004/0128026A1中所描述的那样,该专利文献的内容已经全部补入到本发明中。特别是应当将柔性调节机器人理解为如下的机器人:这种机器人或其控制器能够检测施加特别是通过手动引导或者说手动施加在机器人上的外部力,并根据该力,特别是根据该力的大小和/或方向来命令或执行(机器人的)运动,或者为此通过硬件技术和/或软件技术来设置。
这种外部力特别是可以基于机器人的关节和/或驱动器中的力或者借助于机器人的手柄上的力传感器来检测。
禁止区域或其边界特别是可以在机器人的关节坐标空间中被定义或设定,特别是以基于控制技术的轴阻挡件或轴限制件的形式来实现。同样地,禁止区域或其边界特别是可以在机器人的笛卡尔空间或工作空间中被设定,特别是以对机器人的TCP或另一固定于机器人的参考点的限制或阻挡的形式来实现。相应地,机器人的(当前)位置或速度特别是可以在机器人的工作空间或关节坐标空间中被定义,并由此特别是表明TCP或者另一固定于机器人的参考点或者机器人的一个或多个轴的位置或速度,或者说是TCP或者另一固定于机器人的参考点或者机器人的一个或多个轴的位置或速度。
为了能够更紧凑地进行说明,在此将反平行的力对或转矩也概括地称为力。
在此,边界监控特别是指监控机器人的当前位置是否处于禁止区域中。
在一种实施方式中,根据本发明方法的一个或多个、特别是所有的步骤特别是通过控制器被部分或全部自动化地执行。
附图说明
本发明的其他优点和特征由实施例给出。在此部分示意性地示出了:
图1:根据本发明一种实施方式的用于控制柔性调节机器人的方法;
图2:根据本发明一种实施方式的在禁止区域中施加回位力;
图3:根据本发明另一种实施方式的在禁止区域中施加回位力;和
图4:根据本发明一种实施方式的具有机器人和控制器的机器人组。
其中,附图标记列表如下:
1 机器人
2 控制器
x(0) (当前)位置
xS 锚固位置
c1;2 (虚拟的)弹簧刚性
d 缓冲(因数)
s 边界
S 禁止区域x>s
T(1,2,3) (回位)力
F 缓冲力
t 时间
δ 距离
具体实施方式
图4示出了根据本发明的一种实施方式的机器人组,该机器人组具有控制器2和通过该控制器被柔性调节的多轴机器人1。控制器2执行下面参照图1至图3所说明的用于控制机器人1的方法,或者说为此被通过硬件技术和软件技术来设计。
在第一步骤S10中,控制器2将确认对机器人的边界监控是否被激活。如果没有(S10:“N”),则重复步骤S10。
如果控制器2确认对机器人的边界监控已经被激活(S10:“Y”),则在步骤S20中对计时器t进行初始化,并在步骤S30中检查,机器人1的当前位置x0在边界监控被激活时是否已经处于禁止区域S中。
位置x可以是一维或多维的位置,并且例如描述了机器人1的一个或多个轴的姿态或者机器人的TCP在工作空间中的地点和/或位置,或者说是机器人1的一个或多个轴的姿态或者该机器人的TCP在工作空间中的地点和/或位置。在图2和图3中,为了清楚起见,该位置被一维地示出,在此,s代表边界,x>s代表禁止区域S。
如果控制器2在步骤S30中确认:机器人1的当前位置x0在激活边界监控时已经处于禁止区域S中(S30:“Y”),则该控制器将继续执行步骤S40,否则该控制器将跳过该步骤并继续执行步骤S50。
在步骤S40中,控制器2通过控制技术设定第一回位力T1,该第一回位力使机器人1从其在禁止区域S中的当前位置x0运行回到该区域的边界s。
此外,计时器t在步骤S40中将递增,随后控制器或者说该方法将返回到步骤S30。由此,控制器2通过控制技术设定了第一回位力T1,直至当前位置x0不再处于禁止区域S中(S30:“N”),并随后继续执行步骤S50。
在步骤S50中,计时器t递增,并在随后的步骤S60中检查机器人1的当前位置x0(现在)是否处于禁止区域S中。由此在步骤S60中将确认(在本实施例中通过增加S50表示):机器人1是否是在激活边界监控之后才占据禁止区域S中的当前位置x0
如果控制器2在步骤S60中确认:机器人1是在激活边界监控之后(参看S50)才占据禁止区域S中的当前位置x0(S60:“Y”),则该控制器继续执行步骤S70,否则的话,也就是说,如果当前位置x0不处于禁止区域S中(S60:“N”),则该控制器将继续执行步骤S80。
在步骤S70中,控制器2通过控制技术设定第二回位力T2,该第二回位力同样使机器人从禁止区域S中的当前位置x0运行回到该区域的边界s。
相反,在步骤S80中,例如通过根据手动施加的、用于手动引导机器人的外部力和相对于边界s的(正)间隔来指定(多维的)驱动力T3,使得机器人1如同在专利文献US2004/0128026A1中所描述地那样被柔性地调节。
在步骤S70和步骤S80之后分别在步骤S90中检查边界监控是否被继续激活,如果是(S90:“Y”),则继续执行步骤S50,如果不是,也就是说,在边界监控被解除的情况下(S90:“N”),继续执行步骤S10。
图2示出了柔性调节机器人1在禁止区域x>s中的阻抗调节或导纳调节。在此,机器人1或其当前位置x0利用虚拟弹簧通过控制技术被束缚在边界s上的锚固位置xs上,并利用虚拟缓冲器通过控制技术被惯性地束缚,或者说被束缚在周围环境中。
如果机器人在激活边界监控时已经处于禁止区域x>s中的当前位置x0(S30:“Y”),则设定弹簧的第一刚性c1
相反,如果机器人在激活边界监控之后(参看S50:t+Δt)才占据禁止区域x>s中的同一位置x0(S60:“Y”),则设定弹簧的第二刚性c2
在该实施例中,第一刚性c1首先等于零,并随后根据相对于对边界监控的激活t=0(参看S20)的时间间隔t而增大,直至达到第二刚性c2的值。
通过这种方式,第一刚性c1在激活边界监控时和在激活边界监控之后首先小于第二刚性c2。在一种变形中,第一刚性c1也可以持续地小于第二刚性c2
相应地,在禁止区域的同一当前位置x0处,利用虚拟弹簧通过控制技术施加的第一回位力T1=c1·(x0-s)至少暂时性地小于第二回位力T2=c2·(x0-s),特别是至少首先等于零。
由此可以有利地防止由于激活边界监控而导致机器人1在禁止区域中的当前位置处发生意外的剧烈回位运动。
虚拟弹簧通过控制技术将机器人束缚在边界s上的锚固位置处xs,该虚拟弹簧的刚性c1在运动离开边界s时要大于在朝向边界或平行于边界运动时:即,c1(d(x0-s)/dt>0)>c1(d(x0-s)/dt<0)。换句话说,手动引导机器人进一步运动至禁止区域中(d(x0-s)/dt>0)将要克服更强的阻力。特别是在朝向边界或平行于边界运动时的刚性c1至少在开始时等于零,因此不会(开始)就发生自动的回位,而在运动离开边界时的刚性c1可以在开始时就已经大于零,因此机器人从一开始就已经通过控制技术来克服阻力。
图3示出了根据本发明另一种实施方式的柔性调节机器人1在禁止区域x>s中的阻抗调节或导纳调节。在此,机器人1或其当前位置x0利用虚拟弹簧通过控制技术被束缚在锚固位置xs上,该锚固位置可与当前位置x0一起朝向边界s移动。附加地,机器人可以如同参照图2所说明的那样利用虚拟缓冲器通过控制技术被惯性地束缚,或者说被束缚在周围环境中,为清楚起见,这在图3中未示出。
将当前位置x0与边界s之间的最短连接内的任一位置设定为锚固位置xs,该锚固位置朝向边界s地以设定的距离δ相对于当前位置x0间隔开。由此可以持续地朝向边界s施加基本上恒定的回位力。同样地,也可以设定机器人的当前位置本身,从而不施加朝向边界的回位力,特别是至少在激活边界监控之后刚开始时。
正如在图3中通过单向锁定爪象征性表示的那样,通过对机器人1的外部力加载、特别是手动引导,可以使锚固位置xs不移动离开边界s(在图3中向右)。机器人的相应运动反作用于虚拟弹簧,该虚拟弹簧在固定保持的锚固位置xs和从该锚固位置离开的当前位置x0之间被张紧:T=c·(x0-xs)。
但是,锚固位置xs可以通过机器人1或其当前位置x0朝向边界(在图3中向左)的运动而移动,某种程度上可以说是与当前位置x0一起移动。
换句话说,如果当前位置朝向边界s移动,则锚固位置xs与或者说对应于当前位置x0地一起被更新,并且如果当前位置运动离开边界s,则不更新。
由此,如果机器人朝向边界或平行于边界运动了一段路程,则根据位置x0相对于可与其通行的锚固位置xs的距离并由此与位置x0相对于边界s本身的距离无关地,设定通过控制技术实现的由虚拟弹簧施加的回位力T,该回位力使机器人从其在禁止区域S中的当前位置x0运行回到该区域的边界s,特别是如果将当前位置设定为锚固位置,则该回位力等于零。
另一方面,如果机器人运动离开边界相同的路程,则通过固定锚固位置xs,可以控制技术地利用虚拟弹簧施加另一更大的回位力T。
这种实施方式特别是可以替代如图2所述的实施方式与如图1所示的实施方式相结合,即:如果机器人在激活边界监控时已经处于禁止区域中(S30:“Y”),则回位力可以始终是第一(根据需要可以是另一第一)回位力T1(参看S40),其通过控制技术被指定或施加。相反,如果机器人在激活边界监控之后才出现在禁止区域S中,则特别是如在开始部分所提到的专利文献US2004/0128026A1中所描述的那样设定第二回位力T2。同样,如图3所示的对回位力的设定或施加也可以始终独立地在边界监控中进行,也就是说,即使是机器人在激活边界监控之后才出现在禁止区域中(参看S70)也可以进行。
由此,同样可以有利地防止由于在禁止区域中的当前位置处激活边界监控而使机器人发生意外的、猛烈的回位运动。
如前所述,在一种实施方式中,可以通过控制技术附加地施加一缓冲力F,该缓冲力反作用于机器人的运动并取决于机器人的当前速度,例如这在图2中通过被惯性束缚的缓冲器符号示出,在如图3所示的实施方式中同样也可以是这种情况。
在一种简单的实施例中,该缓冲力可以与机器人的当前速度dx0/dt是成比例的:F=d·dx0/dt。
在一种实施方式中,比例因数或者说缓冲因数d低于最小速度时等于零,而在超过最小速度时大于零,例如是恒定的或者可以随着相对于边界s的距离而变化。因此,相比于低于最小速度的第一速度范围,在该第一速度范围中,缓冲力F由于比例因数或者说缓冲因数d=0而不会随着当前速度一起增大,缓冲力F在所设定的高于最小速度的第二速度范围中将由于比例因数或者说缓冲因数d>0而随着机器人的当前速度dx0/dt一起更剧烈地增大。
由此,可以在低于最小速度时通过控制技术更轻盈地、特别是基本上无衰减地手动引导机器人,而在高于最小速度时能够使机器人被大比例地强烈缓冲。通过这种方式,不仅可以降低对禁止区域的进入,而且附加地还可以防止或至少降低在激活边界监控时所发生的猛烈的回位运动。
尽管在前面的说明中对示例性的实施方式进行了说明,但是应当指出的是,还可能存在多种的变形。此外还应指出的是:这些示例性的实施方式仅仅是举例,其对保护范围、应用领域和结构不构成任何限制。相反,前面的说明将给予本领域技术人员对至少一个示例性实施方式进行转换的启示,在此,在不背离例如由权利要求书和与其等效的特征组合所给出的保护范围的情况下,特别是关于所述组件的功能和设置可以实现各种各样的变化。

Claims (11)

1.一种用于控制柔性调节机器人(1)的方法,具有以下步骤:
对所述机器人执行边界监控;
其中,如果所述机器人在激活所述边界监控时已经处于位于禁止区域(S)中的当前位置(x0)上,则通过控制技术设定第一回位力(T1),所述第一回位力使所述机器人从所述禁止区域中的当前位置运行回到所述禁止区域的边界(s),并且
如果所述机器人在激活所述边界监控之后才占据所述禁止区域中的位置(x0),则通过控制技术设定第二回位力(T2),所述第二回位力使所述机器人从该位置运行回到所述边界(s),
其中,所述第一回位力至少暂时小于所述第二回位力。
2.根据权利要求1所述的方法,其特征在于,设定通过控制技术将所述机器人束缚在锚固位置(xs)上的虚拟弹簧的刚性,其中,如果所述机器人在激活所述边界监控时已经处于所述禁止区域中的一位置(x0)上,则设定第一刚性(c1),并且,如果所述机器人在激活所述边界监控之后才占据所述禁止区域中的同一位置(x0),则设定第二刚性(c2),其中,所述第一刚性至少在激活所述边界监控时小于所述第二刚性。
3.根据权利要求1所述的方法,其特征在于,根据相对于激活所述边界监控的时间间隔(t),设定通过控制技术将所述机器人束缚在锚固位置(xs)上的虚拟弹簧的刚性(c1)。
4.根据权利要求1所述的方法,其特征在于,根据所述机器人相对于所述边界的运动,设定通过控制技术将所述机器人束缚在锚固位置(xs)上的虚拟弹簧的刚性(c1)。
5.一种用于控制柔性调节机器人的方法,具有以下步骤:
对所述机器人执行边界监控;
其中,如果所述机器人朝向禁止区域(S)的边界或平行于所述边界地运动一段路程,则与所述机器人在所述禁止区域中的当前位置(x0)相对于所述边界的距离无关地通过控制技术设定第一回位力(T),所述第一回位力使所述机器人从位于所述禁止区域中的当前位置运行回到该区域的边界(s),并且,如果所述机器人运动离开所述边界相同的路程,通过控制技术设定另一回位力(T),所述另一回位力大于所述第一回位力,
其特征在于,所述方法是根据权利要求1至4中任一项所述的方法。
6.根据权利要求5所述的方法,其特征在于,虚拟弹簧的锚固位置(xs)不能通过所述机器人的外部的力加载而移动离开所述边界,通过控制技术将所述机器人束缚在所述锚固位置(xs)上。
7.根据权利要求5所述的方法,其特征在于,将所述机器人的当前位置(x0)或位于所述当前位置(x0)和所述边界(s)之间的连接之内的一位置设定为虚拟弹簧的锚固位置(xs),该位置朝向所述边界(s)地相对于所述当前位置(x0)间隔开一距离(δ),通过控制技术将所述机器人束缚在所述锚固位置(xs)上。
8.根据权利要求5至7中任一项所述的方法,其特征在于,通过控制技术施加的缓冲力(F)反作用于所述机器人的运动并取决于所述机器人的当前速度(dx0/dt),该缓冲力在高于所设定的最小速度的第二速度范围中伴随所述机器人的当前速度的增大要比在低于所述最小速度的第一速度范围中伴随所述机器人的当前速度的增大更强烈。
9.一种用于控制柔性调节机器人(1)的控制器(2),其被设计用于执行根据前述权利要求中任一项所述的方法。
10.一种机器人组,具有多轴机器人(1)和根据权利要求9的控制器(2),所述控制器用于控制柔性调节机器人。
11.一种计算机程序产品,具有程序代码,所述程序代码被存储在计算机可读的介质上,用于执行根据权利要求1至8中任一项所述的方法。
CN201610548401.XA 2015-07-13 2016-07-13 对柔性调节机器人的控制 Active CN106346482B (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
DE102015009048.8 2015-07-13
DE102015009048.8A DE102015009048B3 (de) 2015-07-13 2015-07-13 Steuern eines nachgiebig geregelten Roboters

Publications (2)

Publication Number Publication Date
CN106346482A CN106346482A (zh) 2017-01-25
CN106346482B true CN106346482B (zh) 2020-01-10

Family

ID=56112802

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610548401.XA Active CN106346482B (zh) 2015-07-13 2016-07-13 对柔性调节机器人的控制

Country Status (5)

Country Link
US (1) US10576629B2 (zh)
EP (1) EP3117968B1 (zh)
KR (1) KR101939438B1 (zh)
CN (1) CN106346482B (zh)
DE (1) DE102015009048B3 (zh)

Families Citing this family (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102017102621B3 (de) * 2017-02-09 2018-05-09 Franka Emika Gmbh Roboter
DE102017118983B4 (de) * 2017-04-23 2019-10-02 Franka Emika Gmbh Roboter und Verfahren zur Steuerung eines Roboters
EP3427904B1 (de) * 2017-07-13 2020-06-10 Siemens Aktiengesellschaft Anordnung mit einem manipulator und einer begrenzungseinrichtung zur begrenzung des arbeitsbereichs
EP3530419A1 (en) * 2018-02-21 2019-08-28 BAE SYSTEMS plc Actively damped robot
GB2572848B (en) 2018-02-21 2020-11-11 Bae Systems Plc Actively damped robot
DE102018207826A1 (de) * 2018-05-18 2019-11-21 Kuka Deutschland Gmbh Handhabung, insbesondere, Transport von Gütern, insbesondere Wafern, durch einen Roboter
US11839979B2 (en) 2018-06-15 2023-12-12 Universal Robots A/S Dual mode free-drive of robot arm
CN109171965B (zh) * 2018-09-27 2021-06-04 上海电气集团股份有限公司 基于虚拟夹具的机器人的控制方法及系统
CN109700627A (zh) * 2018-12-29 2019-05-03 湖南健行智能机器人有限公司 一种膝关节康复机器人系统及其人机柔顺交互控制方法
DE102019118260B3 (de) * 2019-07-05 2020-08-20 Franka Emika Gmbh Taktile Rückmeldung eines Endeffektors eines Robotermanipulators über verschiedene Orientierungsbereiche
CN111168677B (zh) * 2020-01-08 2022-09-16 山东理工大学 一种仿人柔性手臂系统稳定性控制方法
DE102021108416B3 (de) 2021-04-01 2022-03-24 Franka Emika Gmbh Kraftregelung mit Dämpfung an einem Robotermanipulator
DE102021204495A1 (de) 2021-05-04 2022-11-10 Kuka Deutschland Gmbh Verfahren und System zum Steuern eines Teleroboters
DE102021204494A1 (de) 2021-05-04 2022-11-10 Kuka Deutschland Gmbh Verfahren und System zum Steuern eines Teleroboters
KR102624551B1 (ko) * 2023-02-09 2024-01-12 한국과학기술원 회전 변위의 제약이 없는 다관절 로봇의 작업공간 유연제어방법
CN116079748B (zh) * 2023-04-07 2023-07-14 中国科学技术大学 一种基于误差状态概率的离心机柔顺操作系统与方法
CN117301044A (zh) * 2023-08-31 2023-12-29 北京纳通医用机器人科技有限公司 末端工具的运动控制方法、装置、设备及存储介质

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101160104A (zh) * 2005-02-22 2008-04-09 马科外科公司 触觉引导系统及方法
CN104227715A (zh) * 2013-06-19 2014-12-24 库卡实验仪器有限公司 对运动学冗余的机器人的监视
CN104736092A (zh) * 2012-08-03 2015-06-24 史赛克公司 用于机器人外科手术的系统和方法

Family Cites Families (34)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE3531295A1 (de) 1985-09-02 1987-03-19 Knebel & Roettger Fa Sanitaere mischarmatur
US6131097A (en) * 1992-12-02 2000-10-10 Immersion Corporation Haptic authoring
US5855583A (en) * 1996-02-20 1999-01-05 Computer Motion, Inc. Method and apparatus for performing minimally invasive cardiac procedures
WO2002060653A2 (en) * 2001-01-29 2002-08-08 The Acrobot Company Limited Active-constraint robots
US8010180B2 (en) * 2002-03-06 2011-08-30 Mako Surgical Corp. Haptic guidance system and method
DE102005054575B3 (de) * 2005-11-16 2007-04-26 Deutsches Zentrum für Luft- und Raumfahrt e.V. Verfahren zur Regelung eines Roboterarms sowie Roboter zur Durchführung des Verfahrens
EP2018606B1 (en) * 2006-05-19 2019-02-20 Mako Surgical Corp. A method and apparatus for controlling a haptic device
US20090076330A1 (en) * 2007-09-19 2009-03-19 Fujifilm Corporation Endoscope
JP5028219B2 (ja) * 2007-10-30 2012-09-19 オリンパスメディカルシステムズ株式会社 マニピュレータ装置および医療機器システム
DE102007062108A1 (de) * 2007-12-21 2009-07-02 Kuka Roboter Gmbh Industrieroboter und Verfahren zum Programmieren eines Industrieroboters
DE102008041602B4 (de) * 2008-08-27 2015-07-30 Deutsches Zentrum für Luft- und Raumfahrt e.V. Roboter und Verfahren zum Steuern eines Roboters
JP5685842B2 (ja) * 2010-07-12 2015-03-18 セイコーエプソン株式会社 ロボット装置およびロボット装置の制御方法
WO2012018229A2 (ko) * 2010-08-03 2012-02-09 한국기술교육대학교 산학협력단 시간영역 수동성 기법을 이용하여 시간 지연에서의 안정적인 원격제어를 보장하는 양방향 제어기, 햅틱 인터페이스 장치 및 방법, 그리고 원격조종로봇 시스템
DE102010037227A1 (de) 2010-08-30 2012-03-01 Helmut Bälz GmbH Wärmeversorgungsanlage mit mehreren Verbraucherkreisen
JP5854695B2 (ja) * 2010-09-22 2016-02-09 キヤノン株式会社 ロボット装置の制御方法及びロボット装置
US20120158011A1 (en) * 2010-12-16 2012-06-21 Sandhu Kulbir S Proximity sensor interface in a robotic catheter system
CN103328161B (zh) * 2011-01-31 2015-08-19 丰田自动车株式会社 多关节型臂机器人及其控制方法
JP6305673B2 (ja) * 2011-11-07 2018-04-04 セイコーエプソン株式会社 ロボット制御システム、ロボットシステム及びロボット
JP5962020B2 (ja) * 2012-01-17 2016-08-03 セイコーエプソン株式会社 ロボット制御装置、ロボットシステム、ロボット及びロボット制御方法
JP5930754B2 (ja) * 2012-02-13 2016-06-08 キヤノン株式会社 ロボット装置の制御方法及びロボット装置
JP5930753B2 (ja) * 2012-02-13 2016-06-08 キヤノン株式会社 ロボット装置の制御方法及びロボット装置
DE102012002941B4 (de) 2012-02-16 2015-02-05 Huu-Thoi Le Verfahren zum Betrieb einer Heizungs- oder Kühlanlage sowie Heizungs- und Kühlanlage
KR101800189B1 (ko) * 2012-04-30 2017-11-23 삼성전자주식회사 수술 로봇의 힘 제어 장치 및 방법
US9476188B2 (en) 2012-06-22 2016-10-25 Kohler Mira Limited System and method for remotely disinfecting plumbing fixtures
JP5950716B2 (ja) * 2012-06-25 2016-07-13 キヤノン株式会社 ロボット及びロボット制御方法
CN104781050B (zh) * 2012-09-17 2017-05-24 睿信科机器人有限公司 约束冗余机械手的方法和具有冗余机械手的机器人
KR101781709B1 (ko) * 2013-02-06 2017-10-23 미쓰비시덴키 가부시키가이샤 간섭 체크 장치
US9804576B2 (en) * 2013-02-27 2017-10-31 Rockwell Automation Technologies, Inc. Recognition-based industrial automation control with position and derivative decision reference
JP5668770B2 (ja) * 2013-03-15 2015-02-12 株式会社安川電機 ロボットシステム、及び、ロボットシステムの制御方法
JP6080643B2 (ja) * 2013-03-25 2017-02-15 キヤノン株式会社 ロボット装置、ロボット制御方法、プログラム及び記録媒体
DE102013218823A1 (de) * 2013-09-19 2015-04-02 Kuka Laboratories Gmbh Verfahren zum manuell geführten Verstellen der Pose eines Manipulatorarms eines Industrieroboters und zugehöriger Industrieroboter
US9452532B2 (en) * 2014-01-27 2016-09-27 Panasonic Intellectual Property Management Co., Ltd. Robot, device and method for controlling robot, and computer-readable non-transitory recording medium
US9452531B2 (en) * 2014-02-04 2016-09-27 Microsoft Technology Licensing, Llc Controlling a robot in the presence of a moving object
US9283678B2 (en) * 2014-07-16 2016-03-15 Google Inc. Virtual safety cages for robotic devices

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101160104A (zh) * 2005-02-22 2008-04-09 马科外科公司 触觉引导系统及方法
CN104736092A (zh) * 2012-08-03 2015-06-24 史赛克公司 用于机器人外科手术的系统和方法
CN104227715A (zh) * 2013-06-19 2014-12-24 库卡实验仪器有限公司 对运动学冗余的机器人的监视

Also Published As

Publication number Publication date
CN106346482A (zh) 2017-01-25
US20170014997A1 (en) 2017-01-19
KR101939438B1 (ko) 2019-04-10
EP3117968B1 (de) 2020-11-11
EP3117968A1 (de) 2017-01-18
KR20170008167A (ko) 2017-01-23
DE102015009048B3 (de) 2016-08-18
US10576629B2 (en) 2020-03-03

Similar Documents

Publication Publication Date Title
CN106346482B (zh) 对柔性调节机器人的控制
US9050721B2 (en) Robot controller, robot system, robot control method
Flacco et al. Control of redundant robots under hard joint constraints: Saturation in the null space
US10464210B2 (en) Method and device for open-loop/closed-loop control of a robot manipulator
US20170113349A1 (en) Safety monitoring device for robot
RU2016120306A (ru) Стыковочная система космического летательного аппарата
CN106826839B (zh) 对机器人的控制
EP3171235A1 (en) Control device, control method, information processing program, and recording medium
KR101876615B1 (ko) 로봇을 제어하기 위한 방법 및 장치
KR102542089B1 (ko) 로봇의 제어
US11325251B2 (en) Robot
CN112691002A (zh) 基于手势交互康复机器人的控制方法、装置和康复机器人
Li et al. A nonlinear momentum observer for sensorless robot collision detection under model uncertainties
CN109153117A (zh) 对机器人复合体的控制
US10632620B2 (en) Motion control method and robot using same
Flacco et al. Unilateral constraints in the reverse priority redundancy resolution method
KR102289968B1 (ko) 로봇 매니퓰레이터를 제어하기 위한 장치 및 이를 위한 방법
CN113081666A (zh) 康复机器人的虚拟限位的方法、装置和康复机器人
Singh et al. Proxy-based approach for position synchronization of delayed robot coupling without sacrificing performance
Motoi et al. Human-machine cooperative grasping/manipulating system using force-based compliance controller with force threshold
JP2007511443A5 (zh)
CN113226674A (zh) 控制装置
WO2022229785A1 (en) Method and related system for safely controlling a robot
US11579569B2 (en) Apparatus and method for controlling system
US20220111520A1 (en) Method and system for performing a predetermined task using a robot

Legal Events

Date Code Title Description
C06 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