CN106826839B - 对机器人的控制 - Google Patents

对机器人的控制 Download PDF

Info

Publication number
CN106826839B
CN106826839B CN201611043636.XA CN201611043636A CN106826839B CN 106826839 B CN106826839 B CN 106826839B CN 201611043636 A CN201611043636 A CN 201611043636A CN 106826839 B CN106826839 B CN 106826839B
Authority
CN
China
Prior art keywords
speed
robot
drive
numerically
preset
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
CN201611043636.XA
Other languages
English (en)
Other versions
CN106826839A (zh
Inventor
M·罗梅尔
M·米勒-萨默
马克-瓦尔特·厄贝尔勒
G·施赖伯
乌韦·博宁
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 CN106826839A publication Critical patent/CN106826839A/zh
Application granted granted Critical
Publication of CN106826839B publication Critical patent/CN106826839B/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/1651Programme controls characterised by the control loop acceleration, rate 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/1602Programme controls characterised by the control system, structure, architecture
    • 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/088Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
    • 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/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1661Programme controls characterised by programming, planning systems for manipulators characterised by task planning, object-oriented languages
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • 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
    • 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/39Robotics, robotics to robotics hand
    • G05B2219/39339Admittance control, admittance is tip speed-force
    • 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/43Speed, acceleration, deceleration control ADC
    • G05B2219/43203Limitation of speed, permissible, allowable, maximum speed

Abstract

一种用于控制机器人(1)的方法,具有下述的步骤:确定机器人的实际速度
Figure DDA0001157475050000011
(S30);确定额定速度
Figure DDA0001157475050000012
(S20);基于所述额定速度和所述实际速度之间的差值来确定缓冲驱动参量(τd)(S30);并基于所述缓冲驱动参量来操控所述机器人的具有至少一个驱动器(A1,...,A6)的驱动机构(S40),其中,基于所述机器人的预设最大速度
Figure DDA0001157475050000013
预设最小速度
Figure DDA0001157475050000014
和/或到至少一个预设边界(qmax,qmin)的距离(dist)来确定所述额定速度。

Description

对机器人的控制
技术领域
本发明涉及用于控制机器人的一种方法和一种系统以及一种用于执行该方法的计算机程序产品。
背景技术
由专利文献US2004/0128026A1已知一种利用导纳调节的机器人控制器,当机器人靠近预设的边界时,提高它的调节参数。
发明内容
本发明的目的在于改善对机器人的控制。
本发明的目的通过一种用于控制机器人的方法来实现。本发明还涉及一种用于根据这里所描述的方法来控制机器人的系统或一种用于执行在这里所描述的方法的计算机程序产品。优选的扩展方案在下面给出。
根据本发明的一种实施方式,用于控制机器人的方法具有特别是自动化的或通过计算机辅助的下述步骤:
-确定机器人的实际速度;
-确定额定速度;
-基于或者说根据额定速度和实际速度之间的差值来确定缓冲驱动参量
Figure GDA0002164814190000011
以及
-基于或者说根据该缓冲驱动参量来操控机器人的具有一个或多个驱动器的驱动机构,
其中,额定速度基于或者说根据
-预设最大速度,
-预设最小速度和/或
-机器人相对一个或多个预设边界的距离
来确定。
在一种实施方式中,速度、特别是实际速度和/或额定速度可以包括机器人的固定于机器人的参照物的、特别是TCP的一维或多维的平移和/或旋转速度,特别可以是机器人的固定于机器人的参照物的、特别是TCP的一维或多维的平移和/或旋转速度,尤其是在一个或多个空间方向或者说自由度上的速度(分量)。同样地,在一种实施方式中,一维或多维的速度、特别是实际速度和/或额定速度可以包括机器人的一个或多个驱动器和/或关节或者说关节自由度的平移和/或旋转速度,特别可以是机器人的一个或多个驱动器和 /或关节或者说关节自由度的平移和/或旋转速度。速度在此概括地以
Figure GDA0002164814190000022
来表示。
在一种实施方式中,实际速度可以借助于相应的传感器来检测,在此,在一种扩展方案中,固定于机器人的参照物的速度可以基于所测得的机器人关节的速度并借助于正向变换来确定。
在一种实施方式中,机器人具有一个或多个、特别是至少六个或更多个轴或者说关节、特别是转动轴和/或线性轴或者说推力轴,或者说转动关节和 /或线性关节,并且在一种扩展方案中,机器人具有用于使轴或者说关节运动的驱动器、特别是电动马达。在一种实施方式中,机器人是工业机器人。
在一种实施方式中,一维或多维驱动参量可以包括机器人的一个或多个驱动力和/或驱动力矩(驱动转矩),特别可以是机器人的一个或多个驱动力和/或驱动力矩(驱动转矩)。该驱动参量在此概括地以τ来表示。
在一种实施方式中,驱动机构是基于驱动参量、特别是缓冲驱动参量,并在一种扩展方案中基于一个或多个另外的驱动参量、特别是将在后面阐释的柔性驱动参量(Nachgiebigkeits-
Figure GDA0002164814190000021
)被以如下的方式操控,即,该驱动机构(也)(尝试)试图影响或者说施加上述的一个(多个)驱动参量,特别是(也)至少基本上影响或者说施加上述这样的驱动参量。相应地,这种驱动参量特别可以包括机器人的一个或多个额定的或实际的驱动力和/ 或驱动力矩(驱动转矩)或者说其中的一部分,特别是可以是机器人的一个或多个额定的或实际的驱动力和/或驱动力矩(驱动转矩)或者说其中的一部分。
在一种实施方式中,通过缓冲驱动参量能够以有利的方式减缓机器人的运动、特别是通过对机器人的柔性调节和/或手动引导所发生的运动。换句话说,在一种实施方式中提供一种缓冲,在一种扩展方案中,该缓冲以有利的方式相对于柔性调节框架内的缓冲附加地或平行地起作用。
在一种实施方式中,通过基于特别是固定地或可变地设定的一维或多维最大速度来确定额定速度,可以有利地限定特别是在通过对机器人的柔性调节和/或手动引导所发生的运动中机器人的速度:在一种扩展方案中,如果实际速度超过预设的最大速度,那么缓冲驱动参量特别是以分量的方式制动这种运动。
在一种实施方式中,通过基于特别是固定地或可变地设定的一维或多维最小速度来确定额定速度,将有利地在低于最小速度并且最大在所限定的环境中的情况下,使机器人的运动、特别是通过对机器人的柔性调节和/或手动引导所发生的运动,特别是至少基本上不会受到缓冲驱动参量的影响,特别是以分量的方式。
在一种实施方式中,通过基于机器人到预设边界的一维或多维的距离来确定额定速度,将有利地在接近相应边界或者说在相应边界附近的情况下通过缓冲驱动参量来剧烈地缓冲机器人的运动、特别是通过对机器人的柔性调节和/或手动引导所发生的运动,或者在到对应边界的距离较大的情况下通过缓冲驱动参量来轻缓地缓冲机器人的运动、特别是通过对机器人的柔性调节和/或手动引导所发生的运动,从而能够特别是由一个(多个)边界所限定的容许区域中有利地实现自由的(更自由的)运动,特别是以分量的方式。
在一种实施方式中,机器人到预设边界的距离可以是机器人的一个或多个固定于机器人的参照物、特别是TCP到预设在机器人工作空间中的边界的距离。同样地,在一种实施方式中,机器人到预设边界的距离可以包括关节位置和/或驱动器位置到预设在机器人的关节坐标空间或驱动器坐标空间中的边界的距离,特别可以是关节位置和/或驱动器位置到预设在机器人的关节坐标空间或驱动器坐标空间中的边界的距离。
概括地,以qmax来表示一维或多维的上边界,以qmin来表示一维或多维的下边界,并以qist来表示机器人在机器人的工作坐标空间或关节坐标空间或者说驱动器坐标空间中的一维或多维的(实际)姿态或者说位置。在一种实施方式中,机器人相对预设边界i的一维或多维距离disti可以特别是以分量方式或者说针对第j个分量或者说坐标,并根据
disti=(qmax,i-qist)bzw.distj,i=(qj,max,i-qj,ist) (1),
disti=(qist-qmin,i)bzw.distj,i=(qj,ist-qj,min,i) (1′),
来定义或确定。可以看出:在一种实施方式中,该距离通常具有正负号,当机器人位于预设的上边界之下或预设的下边界之上或者说在允许范围中时,特别是以分量方式刚好是正的;反过来,当机器人位于预设的上边界之上或预设的下边界之下或者说不在允许范围中时,特别是以分量方式刚好是负的。
相应地在一种实施方式中,额定速度一般地特别是以分量方式被如下地确定:即,在机器人到同一预设边界的距离数值相等的情况下,只要机器人处于该边界的允许侧上,则额定速度是(绝对地或者说考虑正负号地)较大的;只要机器人处在该边界的不允许侧上,则额定速度是(绝对地或者说考虑正负号地)较小的。
在一种实施方式中,如果设置n≥1个边界,特别是针对机器人尤其是在工作坐标空间或关节坐标空间或者说驱动器坐标空间中的姿态或者说位置的一个或多个分量或者说坐标设置一个或多个上边界和下边界,那么在一种扩展方案中,(被绝对地视为)最小的距离、特别是多维距离的(被绝对地视为)最小的分量被确定为机器人到所有预设边界的(一维)距离dist,即,可能的数值最大的负距离:
Figure GDA0002164814190000041
由此将有利地考虑到可能被打破的最强边界。同样地,特别是可以针对工作空间的各个空间方向或者机器人的不同的关节或者说驱动器或以分量方式来确定作为确定额定速度的基础的距离,该距离也可以相应地是多维的:
Figure GDA0002164814190000042
在一种实施方式中,基于柔性调节、特别是阻抗调节或导纳调节来确定前面所提到的柔性驱动参量,并附加地基于该柔性驱动参量、特别是基于缓冲驱动参量和柔性驱动参量的和来操控驱动机构。
在一种实施方式中,阻抗或导纳调节以常见的方式通告了机器人的弹簧特性,特别是弹簧-缓冲器特性和/或质量-弹簧特性,尤其是质量-弹簧-缓冲器特性,从而使得机器人获得虚拟的弹簧或者说弹簧-缓冲器组的结果,或者说作为具有能通过调节参数预设的刚性和/或缓冲的(质量)-弹簧(-缓冲器) 系统(作出反应)起作用。关于这一点请补充地参考开头提到的专利文献 US2004/0128026 A1,它的内容被明确地收入本申请中。为了实现紧凑的说明,在本文中也概括地将调节视为本发明意义下的控制,因此例如对机器人的控制或对驱动机构的操控特别是也包括对机器人的调节或对驱动机构的调节。
通过基本已知的柔性调节可以实现机器人的有利表现,特别是手动引导和/或有利的碰撞行为。在一种实施方式中,当除了柔性调节的柔性驱动参量之外还附加地、特别是添加性地调节缓冲驱动参量,或者基于缓冲驱动参量和柔性驱动参量的和来操控驱动机构时,则可以有利地使柔性调节的缓冲与其刚性相协调,特别是用于减少、尤其是避免超调
Figure GDA0002164814190000051
并同时通过与此无关的缓冲驱动参量提供关于最大速度的限定和/或在预设边界附近的强烈缓冲。
相应地在一种扩展方案中,对柔性调节的缓冲、特别是缓冲参数或者说缓冲系数依赖于柔性调节的刚性、特别是刚性参数或者说刚性系数,特别是线性地和/或基于莱尔缓冲(Lehrschen
Figure GDA0002164814190000052
)。
在一种实施方式中,额定速度(其在后面在不限于一般性的情况下以
Figure GDA0002164814190000053
表示)特别是以分量方式在数值上向上受到预设的最大速度的限制,该最大速度在不限于一般性的情况下在下文中以
Figure GDA0002164814190000054
表示。附加地或替换地,额定速度
Figure GDA0002164814190000055
特别是以分量方式在数值上向下受到预设的最小速度的限制,该最小速度在不限于一般性的情况下在下文中以
Figure GDA0002164814190000056
表示:
Figure GDA0002164814190000057
多维的速度可以按照分量方式相应地被限定为:
Figure GDA0002164814190000058
在一种实施方式中,额定速度可以特别是以分量方式根据下述公式并利用预设的一维或多维的、正的常量KPq=diag(K1,Pq,K2,Pq,...)和矢量
Figure GDA0002164814190000059
来限定或确定:
Figure GDA00021648141900000510
Figure GDA00021648141900000511
其中,一维或多维距离特别可以根据公式(1)-(1″)来限定或确定,特别是在附加的边缘条件(2)下:
Figure GDA0002164814190000061
Figure GDA0002164814190000062
换句话说,在一种实施方式中,当机器人位于一个(多个)预设边界的不允许范围中时(dist(j)>0),特别是以分量方式将所预设的最小速度确定为额定速度。
附加地或替代地,在一种实施方案中,当机器人位于一个(多个)预设边界的允许范围中并相对于该允许范围具有如下的预设距离时:
Figure GDA0002164814190000063
或者
Figure GDA0002164814190000064
特别是以分量方式在附加边缘条件(2)的情况下将所预设的最小速度确定为额定速度。
附加地或替代地,在一种实施方式中,当机器人位于该边界的容许一侧时,额定速度特别是以分量方式在数值上随着机器人到一预设边界的距离、特别是线性地或根据公式(3)或(3′)一起增加,尤其是增加至预设的最大速度。
就像前面阐释的那样,这点特别可以适合于分量方式,即,例如针对额定速度
Figure GDA0002164814190000065
的第j个分量
Figure GDA0002164814190000066
Figure GDA0002164814190000067
Figure GDA0002164814190000068
其中,dist(j)可以是一维距离或者根据等式(1)-(1″)的多维距离的相应第 j个分量,并且
Figure GDA0002164814190000069
可以是一维最小速度或多维最小速度的相应分量。
在一种实施方式中,缓冲驱动参量(在这里被概括地表示为τd)特别以分量方式与实际速度(在这里概括地表示以
Figure GDA00021648141900000610
)相反或者说反作用于实际速度,或者说试图降低该实际速度。在注意到符号的情况下,在一种实施方式中特别适用的是:
Figure GDA00021648141900000611
或者
Figure GDA0002164814190000071
附加地或替代地,在一种实施方式中,缓冲驱动参量τd特别是以分量方式被如下地确定:即,只要额定速度(额定速度的分量)在数值上超过实际速度(实际速度的分量),则缓冲驱动参量在数值上不超过预设的、特别是正的最小值τd0、特别是至少基本上等于零:
Figure GDA0002164814190000072
Figure GDA0002164814190000073
换句话说,在一种实施方式中,只要实际速度在数值上低于额定速度,则至少基本上没有缓冲驱动参量在相应的自由度上受到影响或发出。就像已提到的那样,公式(7),(7′)特别可以按照分量方式适用:
Figure GDA0002164814190000074
Figure GDA0002164814190000075
附加地或替代地,在一种实施方式中,缓冲驱动参量τd特别以分量方式在数值上向上受到预设最大参量的限制,该预设的最大参量在下文中在不限于一般性的情况下以τmax表示:
d|≤τmax (8)
j,d|≤τj,max (8)。
附加地或替代地,在一种实施方式中,缓冲驱动参量特别以分量方式被如下地确定:即,如果实际速度(实际速度的相应分量)在数值上超过额定速度(额定速度的相应分量),则缓冲驱动参量在数值上随着额定速度(额定速度的相应分量)与实际速度(实际速度的相应分量)之间的差值一起增加,特别是在数值上与额定速度(额定速度的相应分量)与实际速度(实际速度的相应分量)之间的差值成比例:
Figure GDA0002164814190000076
Figure GDA0002164814190000077
其中,KPv=diag(K1,Pv,K2,Pv,...)为预设的一维或多维常量,特别是在附加边缘条件(6),(7)或(7′)和/或(8)下。边缘条件(6)特别可以根据下述公式利用符号函数或者说正负号函数sgn来考虑,
Figure GDA0002164814190000081
其中,τd
Figure GDA0002164814190000082
被定义为符号相同,也就是说缓冲驱动参量τd与实际速度
Figure GDA0002164814190000083
是反向的或反向地起作用。
就像已提到的那样,等式(9)-(9″)还适用于分量方式:
Figure GDA0002164814190000084
Figure GDA0002164814190000085
Figure GDA0002164814190000086
根据本发明的一种实施方式,用于特别是硬件技术和/或软件技术或者说程序技术地控制机器人的系统被设置用于执行在这里所描述的方法,和/或具有:
-用于确定机器人的一个或多个实际速度的器件;
-用于基于一个或多个预设的最大速度、一个或多个预设的最小速度和/或机器人到至少一个或者一个/多个预设边界的距离来确定一个或多个额定速度的器件;
-用于基于额定速度和实际速度之间的一个或多个差值来确定一个或多个缓冲驱动参量的器件;以及
-用于基于缓冲驱动参量来操控机器人的一个或多个驱动机构的器件,这些驱动机构具有至少一个驱动器。
在一种实施方式中,所述系统具有用于基于一个或多个柔性调节、特别是阻抗调节或导纳调节来确定一个或多个柔性驱动参量的器件,其中,用于操控驱动机构的器件被设计,附加地基于柔性驱动参量,特别是基于缓冲驱动参量和柔性驱动参量的和来操控驱动机构。
在一种实施方式中,所述系统具有用于在数值上通过预设的最大速度向上限定和/或通过预设的最小速度向下限定额定速度的器件。
在一种实施方式中,所述系统具有如下的用于确定额定速度的器件:在机器人到同一预设边界的距离数值相等的情况下,只要机器人位于该边界的容许一侧,则额定速度较大;只要机器人位于该边界的不容许一侧,则额定速度较小。
在一种实施方式中,所述系统具有如下的用于确定缓冲驱动参量的器件:只要额定速度在数值上超过实际速度,则缓冲驱动参量特别是以分量方式不超过预设的最小值,特别是至少基本等于零。
在一种实施方式中,所述系统具有用于通过预设的最大参量特别是以分量方式在数值上向上限定缓冲驱动参量的器件。
在一种实施方式中,所述系统具有如下的用于确定缓冲驱动参量的器件:当实际速度在数值上超过额定速度时,缓冲驱动参量特别是以分量方式在数值上随着额定速度与实际速度之间的差值一起增加,特别是在数值上与额定速度和实际速度之间的差值成比例。
本发明意义下的器件可以通过硬件技术和/或软件技术来实现,特别是具有:优选与存储系统和/或总线系统数据或信号连接的处理单元,特别是数字处理单元,尤其是微处理器(CPU);和/或一个或多个程序或程序模块。CPU 可以被设计为:使执行储存在存储系统中的程序的命令运行;检测数据总线的输入信号和/或将输出信号发送到数据总线上。存储系统可以具有一个或多个特别是不同的存储介质,尤其是光学介质、磁性介质、固体介质和/或其他的非易失性介质。所述程序可以被如下地提供:即,该程序能够使在此所述的方法具体化或者说能够实施在此所述的方法,从而使得CPU可以执行该方法的步骤,并由此特别是可以控制机器人。
附图说明
其他的优点和特征由从实施例给出。为此部分示意性地示出:
图1:根据本发明的一种实施方式的机器人和用于控制该机器人的系统;
图2:机器人到预设边界的距离;
图3:取决于距离的额定速度;
图4:取决于额定速度和实际速度的缓冲驱动参量;以及
图5:根据本发明的一种实施方式的、用于控制机器人的方法。
其中,附图标记列表如下:
1 机器人
2 控制器
A1,...,A6 驱动器
q1,...,q6 关节角度
qist 实际位置
qmax,qmin 上边界/下边界
Figure GDA0002164814190000101
额定速度
Figure GDA0002164814190000102
实际速度
Figure GDA0002164814190000103
最大/最小速度
dist 距离
τd 缓冲驱动参量
τmax 最大参量
具体实施方式
图1和图5分别示出了根据本发明的一种实施方式的、具有驱动器 A1,...,A6的机器人1和一种具有用于控制机器人1的控制器2的系统或者说一种由控制器2执行的用于控制机器人1的方法。
在第一步骤S10中,控制器2根据前面阐释的等式(1)至(1″)来确定机器人2与预设边界qmax、qmin的距离dist。这在图2中示出。在此,qist表示被检测到的机器人1的实际位置,例如它的一个或多个如图1所示的关节角度q1,...,q6或者它的TCP在工作空间中的与这些关节角度相应的位态和 /或定向的一个或多个分量。相应地,qmax,qmin同样特别是可以在关节角度空间或工作空间中被预设。
在所示出的机器人1的姿势中,根据等式(1′)的到下边界qmin的正的距离小于根据等式(1)的到上边界qmax的同样为正的距离,并因此根据等式(1″) 将其确定为机器人1到预设边界qmax、qmin的距离dist。为了实现图解说明,也以虚线简示出机器人位于预设上边界qmax上方的不容许区域(图2中的阴影)中的另一实际位置,该实际位置对应于负的距离<0。
因此,如果在多个空间方向或者说关节上预先设定边界,则特别是可以将(绝对可看到的或带正负号的)最小距离确定为距离dist,如图2所示。
这样的距离确定同样可以如同在后面所描述一种实施方式中的步骤那样以分量方式进行,由此,qmin,qmax和qist可以分别表示该位置沿着如图2所示坐标轴的一个分量。
然后,控制器2在步骤S20中根据等式(3′)并在基于等式(2)的附加边缘条件下确定额定速度
Figure GDA0002164814190000111
这一点在图3中示出。在该图示中,一方面可以看到额定速度
Figure GDA0002164814190000112
与机器人1到预设边界的(取决于实际位置的)距离(见等式(3′))的线性相关性,另一方面还可以看到通过预设最大速度
Figure GDA0002164814190000113
在数值上对额定速度的向上限定和通过预设的最小速度
Figure GDA0002164814190000114
在数值上对额定速度的向下限定(见等式(2))。这可以就像已提到的那样特别是以分量方式进行,从而使得
Figure GDA0002164814190000115
Figure GDA0002164814190000116
可以分别表示速度的一个分量。
然后,控制器2在步骤S30中根据等式(9″)在附加边缘条件(7′)和 (8)下确定了缓冲驱动参量τd。这一点在图4中示出。在该图示中,一方面可以看到根据等式(8)通过预设最大参量τmax在数值上对缓冲驱动参量τd的限定。另一方面可以清楚地看到缓冲驱动参量τd以如下方式被确定:即,只要额定速度
Figure GDA0002164814190000117
数值上超过实际速度
Figure GDA0002164814190000118
(参见等式(7′)),那么该缓冲驱动参量等于零。反过来,如果实际速度
Figure GDA0002164814190000119
数值上超过了额定速度
Figure GDA00021648141900001110
那么根据等式(9″)以如下方式来确定缓冲驱动参量τd:即,该缓冲驱动参量在数值上与额定速度
Figure GDA00021648141900001111
和实际速度
Figure GDA00021648141900001112
之间的差值成比例地增加,直至其通过最大参量τmax被限定。在此,缓冲驱动参量τd根据等式(6)与实际速度
Figure GDA00021648141900001113
反向。这也可以如同所描述的那样特别是以分量方式进行,从而使得
Figure GDA00021648141900001114
和τd或τmax可以分别表示速度的一个分量或者驱动器A1,...A6的一个驱动力或者驱动力矩(转矩)。
控制器2在步骤S40中还附加于柔性驱动参量τd地发出缓冲驱动参量到机器人1的驱动器A1,...,A6上,该柔性驱动参量基于柔性调节、特别是阻抗调节或导纳调节以基本已知并因此在这里未详细示出的方式来确定。
虽然在前面的描述中阐释了示例性的实施方案,但是要指出的是还可能有很多的变型方案。
因此就像多次提到的那样,可以特别是分别针对机器人1的一个或多个位置分量、速度分量和驱动参量分量或者说自由度来执行这些步骤,这些参量或自由度相应于前面被标记为矢量的参量特别也是纯量(skalar)的,并表示了在一空间方向上或者一驱动器坐标自由度或关节坐标自由度上的位置、速度或驱动参量。
这些单个的计算或公式特别可以分别在机器人的驱动器坐标空间或者说关节坐标空间或工作空间中实施,其中,这些参量可以在需要时通过正向转换或逆向转换在这些空间之间转换。因此,例如可以将在工作空间中设定的边界转化到驱动器坐标空间或者说关节坐标空间中,然后在那里直接确定驱动力或者驱动力矩(驱动转矩)。同样地,也可以将在工作空间中确定的驱动参量转化到驱动器坐标空间或者说关节坐标空间中。
此外要指出的是,这些示例性实施方案仅仅是示例,它们不应以任何方式限制保护范围、应用方案和结构。相反,通过前面的描述给本领域技术人员提供了用于对至少一个示例性实施方案进行转换的教导,其中,特别是关于所描述的组成部分的功能和设置的不同变化可以在不离开例如从权利要求书和与权利要求书等效的特征组合所获得的保护范围的情况下进行。

Claims (15)

1.一种用于控制机器人(1)的方法,具有如下步骤:
确定所述机器人的实际速度
Figure FDA0002310261450000011
确定额定速度
Figure FDA0002310261450000012
基于所述额定速度和所述实际速度之间的差值来确定缓冲驱动参量(τd);以及
基于所述缓冲驱动参量来操控所述机器人的具有至少一个驱动器(A1,...,A6)的驱动机构;
其特征在于,基于柔性调节来确定柔性驱动参量,并附加地基于所述柔性驱动参量来操控所述驱动机构;和/或
基于预设最大速度
Figure FDA0002310261450000013
和/或预设最小速度
Figure FDA0002310261450000014
来确定所述额定速度,
其中,当所述额定速度的数值超过所述实际速度的数值时,将所述缓冲驱动参量确定为零。
2.根据权利要求1所述的方法,其特征在于,基于阻抗调节或导纳调节来确定柔性驱动参量,和/或基于所述缓冲驱动参量和所述柔性驱动参量的和来操控所述驱动机构。
3.根据权利要求1所述的方法,其特征在于,基于所述机器人的到至少一个预设边界(qmax,qmin)的距离来确定所述额定速度。
4.根据权利要求1所述的方法,其特征在于,在所述柔性调节中,缓冲取决于刚性。
5.根据权利要求1所述的方法,其特征在于,通过所述预设最大速度在数值上向上限定所述额定速度,和/或通过所述预设最小速度在数值上向下限定所述额定速度。
6.根据权利要求3所述的方法,其特征在于,所述额定速度以如下方式确定:即,在所述机器人到同一预设边界的距离在数值上相等的情况下,只要所述机器人位于该预设边界的容许一侧,则所述额定速度较大,并且只要所述机器人位于该预设边界的不容许一侧,则所述额定速度较小。
7.根据权利要求3所述的方法,其特征在于,当所述机器人位于预设边界的容许一侧时,所述额定速度在数值上随着所述机器人到该预设边界的距离一起增加。
8.根据权利要求1所述的方法,其特征在于,所述缓冲驱动参量相对于所述实际速度是方向相反的。
9.根据权利要求1至8中任一项所述的方法,其特征在于,所述缓冲驱动参量以如下方式确定:即,只要所述额定速度在数值上超过了所述实际速度,则所述缓冲驱动参量不超过预设的最小值。
10.根据权利要求9所述的方法,其特征在于,只要所述额定速度在数值上超过了所述实际速度,则所述缓冲驱动参量等于零。
11.根据权利要求1至8中任一项所述的方法,其特征在于,所述缓冲驱动参量在数值上向上通过预设最大参量(τmax)来限定。
12.根据权利要求1至8中任一项所述的方法,其特征在于,所述缓冲驱动参量以如下方式确定:即,当所述实际速度在数值上超过所述额定速度时,所述缓冲驱动参量在数值上随着所述额定速度与所述实际速度之间的差值一起增加。
13.根据权利要求12所述的方法,其特征在于,当所述实际速度在数值上超过所述额定速度时,所述缓冲驱动参量在数值上与所述额定速度与所述实际速度之间的差值成比例。
14.一种用于控制机器人(1)的系统(2),具有:
用于确定所述机器人的实际速度
Figure FDA0002310261450000021
的器件;
用于确定额定速度
Figure FDA0002310261450000022
的器件;
用于基于所述额定速度和实际速度之间的差值来确定缓冲驱动参量(τd)的器件;以及
用于基于所述缓冲驱动参量来操控所述机器人的具有至少一个驱动器(A1,...,A6)的驱动机构的器件;
其特征在于,所述系统被设置用于执行根据前述权利要求中任一项所述的方法。
15.一种计算机程序产品,具有程序编码,该程序编码存储在能由计算机读取的介质上,所述计算机程序产品用于执行根据权利要求1至13中任一项所述的方法。
CN201611043636.XA 2015-11-19 2016-11-21 对机器人的控制 Active CN106826839B (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
DE102015014994.6 2015-11-19
DE102015014994.6A DE102015014994B3 (de) 2015-11-19 2015-11-19 Steuerung eines Roboters

Publications (2)

Publication Number Publication Date
CN106826839A CN106826839A (zh) 2017-06-13
CN106826839B true CN106826839B (zh) 2020-04-17

Family

ID=57286187

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201611043636.XA Active CN106826839B (zh) 2015-11-19 2016-11-21 对机器人的控制

Country Status (5)

Country Link
US (1) US10239207B2 (zh)
EP (1) EP3170628A1 (zh)
KR (1) KR20170058865A (zh)
CN (1) CN106826839B (zh)
DE (1) DE102015014994B3 (zh)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10820949B2 (en) * 1999-04-07 2020-11-03 Intuitive Surgical Operations, Inc. Medical robotic system with dynamically adjustable slave manipulator characteristics
DE102017004711B4 (de) * 2017-05-16 2019-02-21 Kuka Deutschland Gmbh Robotersteuerung
JP6680752B2 (ja) 2017-11-28 2020-04-15 ファナック株式会社 ロボットの速度を制限する制御装置
CN112135718A (zh) * 2018-05-18 2020-12-25 库卡德国有限公司 机器人的控制
CN109171965B (zh) * 2018-09-27 2021-06-04 上海电气集团股份有限公司 基于虚拟夹具的机器人的控制方法及系统
CN111037571B (zh) * 2019-12-31 2022-12-16 广东工业大学 一种机器人自适应变阻尼阻抗控制方法
CN111185923B (zh) * 2020-01-14 2022-02-15 深圳众为兴技术股份有限公司 一种机器人控制装置及控制方法
CN113752262B (zh) * 2021-09-17 2022-10-21 上海傅利叶智能科技有限公司 用于机器人变阻尼柔顺控制的方法、装置和康复机器人

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0780786A (ja) 1993-09-16 1995-03-28 Yaskawa Electric Corp ロボットのインピーダンス制御装置
WO2002060653A2 (en) 2001-01-29 2002-08-08 The Acrobot Company Limited Active-constraint robots
US8996169B2 (en) * 2011-12-29 2015-03-31 Mako Surgical Corp. Neural monitor-based dynamic haptics
JP5982774B2 (ja) 2011-10-11 2016-08-31 セイコーエプソン株式会社 モーター制御装置、ロボットハンド
JP5896789B2 (ja) 2012-03-07 2016-03-30 キヤノン株式会社 ロボット制御装置、ロボット装置、ロボット制御方法、プログラム及び記録媒体
US9308645B2 (en) * 2012-03-21 2016-04-12 GM Global Technology Operations LLC Method of inferring intentions of an operator to move a robotic system

Also Published As

Publication number Publication date
US20170144302A1 (en) 2017-05-25
DE102015014994B3 (de) 2017-01-05
KR20170058865A (ko) 2017-05-29
US10239207B2 (en) 2019-03-26
EP3170628A1 (de) 2017-05-24
CN106826839A (zh) 2017-06-13

Similar Documents

Publication Publication Date Title
CN106826839B (zh) 对机器人的控制
CN108139747B (zh) 确定用于机器人的、由手动施加于机器人的力来输入的输入指令
CN108568814B (zh) 机器人以及机器人的控制方法
KR102003216B1 (ko) 로봇을 위한 모터 제어 및/또는 조정
JP4508164B2 (ja) 多関節ロボット及びその制御プログラム
US8060250B2 (en) Joint-space impedance control for tendon-driven manipulators
CN107683190B (zh) 用于进行机器人机械手的开环和闭环控制的装置和方法
JP2010149274A5 (zh)
JP2006215807A (ja) ロボット制御装置および制御方法
CN112601640A (zh) 机器人调节
JP6925794B2 (ja) コントローラ、作業制御装置、多軸動作制御装置、及び駆動制御装置
CN114290326A (zh) 用于控制一个或多个机器人的设备和方法
US9298194B2 (en) Method to control medical equipment
KR102078733B1 (ko) 위치 및/또는 자세를 불연속으로 수동 입력하기 위한 제어 시스템이 구비된 로봇
Motoi et al. Human-machine cooperative grasping/manipulating system using force-based compliance controller with force threshold
JP7068133B2 (ja) 制御システム、制御方法、及び制御プログラム
Jlassi et al. An online trajectory generator-based impedance control for co-manipulation tasks
US11633858B2 (en) Method and system for simulating a braking operation of a robot
JP4587052B2 (ja) 位置制御装置、位置制御方法及び位置制御プログラム
CN113474130A (zh) 利用机器人执行预先设定的任务的方法和系统
Rahman et al. Cognitive feedforward learning control for object manipulation with a power assist robotic system
KR20210010870A (ko) 로봇의 제어
CN117597217A (zh) 用于控制遥操作机器人的方法和系统
CN111405966A (zh) 用于控制机器人组的方法和控制装置
CN111356558B (zh) 用于仿真机器人的制动过程的方法和系统

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