本发明涉及一种用于进行由m个致动器actm驱动并具有末端执行器的机器人机械手的开环和闭环控制的装置和方法,其中m=1、2、……m。进一步地,本发明涉及一种具有数据处理装置的计算机系统,一种数字存储介质,一种计算机程序产品和一种计算机程序。
背景技术:
已知的是,机器人机械手在处理可重复速度和精度的任务上的表现可超越人类。但是,就力和顺从性(compliancy)的灵敏度运用而言,对于实际应用中首先变得显而易见的、需要灵敏地进行物体的操纵或组装的任务,人类仍然优于机器人机械手。后者需要接触力和移动顺序的复杂配合。
本文中已知机器人机械手的“阻抗控制”。机器人机械手阻抗控制的概念旨在通过机器人机械手的主动控制,例如基于外部动画(animated)质量弹簧阻尼器模型模仿人类行为。
通常,机器人机械手的预期顺从性可通过主动控制,通过向机器人机械手插入顺从部件或两者的组合而产生。此外,已知不能仅仅借助解耦弹性关节(
此外,已知“主动交互控制”。主动交互控制可分为“直接”和“间接”力控制(villani&deschutter,2008)。近来,这种力调节器具有引入了虚拟位置的变体(lutscher&cheng,2014以及lee&huang,2010)。此外,已知在不同空间中,预定的强制性条件下的功率、位置、和/或阻抗控制。
尽管在机器人机械手控制领域已经取得了显著的进步,以下缺点仍然存在。
例如,纯阻抗控制的机器人机械手基于纯前馈控制或者基于机器人机械手的执行器的实质期望位置的相应位移来产生期望的力。因此,这种调节器没有明确考虑外力,然而如果用足够的精度向环境/物体/工件等施加机器人机械手的执行器的预定力/力矩,则需要考虑外力。此外,需要在其几何形状和的顺从性特性方面用足够的精度对环境进行建模,以使该调节器能够工作。然而,这与阻抗控制在未建模环境中工作的基本理念是相悖的。
如果借助机器人机械手的执行器经由前馈控制向物体(环境)施加预定较大的力,则对纯阻抗控制的机器人机械手额外不利的是,在执行器和物体之间脱离接触的情况下,机器人机械手会执行具有潜在危险的瞬时且较大的移动(关于行进的执行器路径、速度和加速度)。该情况出现于脱离接触时,执行器的实质期望位置远离执行器的实际位置。
此外,已知机器人机械手的“纯力控制”。机器人机械手的力控制提供了足以与环境交换外力的基础,从而能精确地操纵物体或其表面。这种能力在机器人机械手的工业应用中是基本必须的。因此,相当不精确的阻抗控制不能替代力控制。这些问题导致了多样化的所谓的混合位置力控制方法(raibert&craig,1981)。这些混合位置力控制基于将所谓的“任务空间”划分为互补力和位置空间的想法,使得能够在其单独的空间中施加和控制力或扭矩和移动。
已知的混合力控制的缺点在于,相对于机器人机械手和环境的脱离接触,其鲁棒性低。此外,在这种情况下,同样需要对环境精确建模,以确保良好的控制性能,然而,足够品质的控制性能很少存在。
为了显示这种调节器的稳定性,环境通常被建模为简单的弹簧阻尼器系统。不同力调节器的综述,包括关于其稳定性分析的评论,参见(zeng&hemami,1997)。对这种调节器的非常普遍的批判详见(duffy,1990),因为经常对度量或坐标系进行错误的选择。
技术实现要素:
本发明的目的是提供一种用于进行由m个致动器actm驱动并具有末端执行器的机器人机械手的开环和闭环控制的装置和方法,其中m=1、2、……m,在很大程度上避免了上述缺点。具体地,避免了末端执行器和物体之间脱离接触之后机器人机械手的较大移动。
本发明在独立权利要求的特征中变得明显。有利的进一步发展和实施例是从属权利要求的主题。从下文描述以及示出于本发明附图的示例性实施例的说明,本发明的进一步特征、应用可能性和优点将变得明显。
根据第一方面,该目的借助一种用于进行由m个致动器actm驱动并具有末端执行器的机器人机械手的开环和闭环控制的装置来解决,其中m=1、2、……m。术语“致动器”应被广义地理解,包括例如电动机、线性电动机、多相电动机、压电致动器等。
装置进一步包括:记录和/或提供作用于末端执行器上的外力卷绕(winder)
此外,提出的装置包括与第一单元和致动器actm连接的调节器。调节器继而包括具体为力调节器的第一调节器r1、以及与其连接并且具体为阻抗调节器、导纳调节器、位置调节器、巡航控制器(cruisecontrol)或其组合的第二调节器r2,其中调节器确定操纵变量um(t),致动器actm借助操纵变量um(t)而可被致动的方式为:使得当与物体的表面接触时,末端执行器用预定的力卷绕公式
um(t)=um,r1(t)+um,r2(t)(1)
其中,
这样,第一调节器r1被具体化和配置的方式为:使得操纵变量um,r1(t)被确定为操纵变量um,r1(t)*和函数s(v(t))的乘积或为函数s*(v*(t),um,r1(t)*),其中:
um,r1(t)=s(v(t))um,r1(t)*(2a)
um,r1(t)=s*(v*(t),um,r1(t)*)(2b)
v*(t)=[v1*(t),v2*(t),…,vq*(t)](3b)
v∈[va,ve](4a)
v1*(t)∈[v1a,v1e],v2*(t)∈[v2a,v2e],…,vq*(t)∈[vqa,vqe](4b)
其中,um,r1*(t):=由第一调节器r1确定的操纵变量,用于生成预定的力卷绕
因而,在一个替代方案中,本发明特征,常规确定的力调节器r1的操纵变量的比值um,r1(t)乘以单调递减函数
函数s(v(t))优选具有值域[1,0],其中如果末端执行器与环境(正常操作)接触时,s(v(t))=1。如果末端执行器与环境脱离接触时,调节器发生较大的负偏差
提出的装置的进一步改进的特征在于,如果物体(末端执行器与其接触并向其施加力卷绕
提出的装置的进一步改进的特征在于,提供第二单元,用作调节器钝化(passivation)的能量存储器,并根据预定的能量存储动力学系统(dynamics)存储来自调节器的能量t1,并将能量t2传递给调节器,其中第二单元和调节器形成闭环,具有能量t0的单元的初始化取决于用于执行机器人机械手的当前任务的确定的或预定的能量消耗eexpenditure。这样,第二单元所存储的能量e为虚拟或物理能量。在第一种情况下,虚拟能量仅是一个操作数。在第二种情况下,能量为物理能量(例如,电能),其中第二单元包括对应的物理能量存储器(例如,电池)。进一步改进的第二种情况不但有助于机器人机械手的改进的(即钝化的)开环和闭环控制,而且同时降低了在机器人机械手操作期间的能量消耗。
有利地,为上述进一步的改进定义了能量上限g1,其中第二单元被具体化和配置成使得对于存储在第二单元中的能量e,e≤g1总是成立的。此外,有利地定义了能量下限g2,其中0<g2<g1,第二单元被具体化为,如果:对于存储在第二能量单元中的能量e,g2<e≤g1是成立的,第二单元耦合到调节器,以及如果e≤g2是成立的,第二单元从调节器上解耦。
本发明的另一方面涉及一种具有由m个致动器actm驱动并具有末端执行器的机器人机械手并具有本文所说明的装置的机器人,其中m=1、2、……m。
本发明的另一方面涉及一种用于由m个致动器actm驱动并具有末端执行器的机器人机械手的开环和闭环控制的方法,其中m=1、2、……m,具有以下步骤:记录和/或提供作用于末端执行器上的外力卷绕
um(t)=um,r1(t)+um,r2(t)(1)
其中
um,r1(t)=s(v(t))·um,r1(t)*(2a)
um,r1(t)=s*(v*(t),um,r1(t)*)(2b)
v*(t)=[v1*(t),v2*(t),…,vq*(t)](3b)
v∈[va,ve](4a)
v1*(t)∈[v1a,v1e],v2*(t)∈[v2a,v2e],…,vq*(t)∈[vqa,vqe](4b)
其中:um,r1*(t):=由第一调节器r1确定的操纵变量,用于生成预定的力卷绕
优选地,如果物体是弹性的并且其表面是柔性的,在操纵变量um(t)的确定期间,在调节器的方法中,考虑物体的预定弹性性质。
进一步优选地,提供第二单元,用作调节器钝化的能量存储器,并根据预定的能量存储动力学系统存储来自调节器的能量t1,并将能量t2传递给调节器,其中第二单元和调节器形成闭环,具有能量t0的单元的初始化取决于用于执行机器人机械手的当前任务的确定的或预定的能量消耗eexpenditure。
提出的方法的优点和优选的进一步改进产生于有关所提出的装置的上述说明的类似和必要的修正。
本发明的另一方面涉及一种具有数据处理装置的计算机系统,其中数据处理装置被设计成使得上文说明的方法能够在该数据处理装置上运行。
本发明的另一方面涉及一种具有电子可读控制信号的数字存储介质,其中控制信号可与可编程计算机系统交互,使得上文说明的方法能够运行。
本发明的另一方面涉及一种具有程序代码的计算机程序产品,如果程序代码在数据处理装置上运行,该程序代码存储在机器可读载体上以实施上文说明的方法。
本发明的另一方面涉及一种具有程序代码的计算机程序,如果程序代码在数据处理装置上运行,以实施上文说明的方法。为此,数据处理装置可被设计为本领域已知的任何计算机系统。
提出的用于进行由m个致动器actm驱动并具有末端执行器的机器人机械手的开环和闭环控制的装置和方法因此基于鲁棒、被动的方法,将力控制与阻抗控制(参照图1)和能量罐(energytank)相结合,其中m=1、2、……m。本发明有助于接受任意的被动环境,因而没有必要改变具有相当非鲁棒性能的实质期望位置。本发明允许机器人机械手对环境的鲁棒、顺从和稳定的操纵,而不必在力或阻抗控制中选择。此外,避免了力和阻抗控制的所述固有缺点,并尽可能最好地结合力控制和阻抗控制的优点。具体地,避免了末端执行器和环境脱离接触时导致的机器人机械手的危险移动。
以下说明针对下列主题详细说明了本发明:a)机器人建模,b)调节器设计,c)脱离接触的稳定,以及d)柔性和强顺从的物体的处理。
a机器人建模
a1刚体动力学系统
具有n个关节(自由度,dof)的机器人机械手的已知动力学系统给出为:
其中
a2柔性关节的动力学系统
对于轻量化设计的或在关节中具有弹簧的机器人机械手,假定(5)不够精确,以能够描述传动装置等柔性结构的存在而产生的固有动力学系统。因此,假定这种结构为具有弹性关节的机器人机械手的(降阶)模型。(spong,1987)
其中
b调节器设计
b1笛卡尔阻抗调节器
可借助系统的巧妙钝化实现具有弹性关节的机器人机械手的稳定阻抗控制。例如,通过将位置反馈作为函数
b2笛卡尔力调节器
调节器设计基于笛卡尔力调节器:
其中
b3统一的力和阻抗调节器
上述力和阻抗调节器的简单组合可产生以下数学控制法则:
然而,这种法则不能保证稳定性。因此,调节器需要增加能量罐(参照图2),从而保障了钝化,继而保障系统的稳定性。因而,产生了新的数学控制法则:
其中,xt为能量罐的状况,
能量罐的动力学系统可被描述为:
能量罐的输入在此被描述为ut。二元标量
b4基于任务的初始化
为了计算任务能量,使用力的统计平衡
此处,仅考虑平移能量。当然,需要用于转动情况的扩展,其对于本领域技术人员来说是显而易见的。
对于特定的控制情况fd=konst,任务能量计算如下:
任务能量被对应地初始化。
c脱离接触的稳定
对于任何可想到的情况,保证进行机器人机械手的开环和闭环控制的稳定性,但是这并不自动地意味着机器人机械手排他地进行安全移动。末端执行器与物体表面意料之外的脱离接触仍会导致具有机器人机械手的机器人试图调节力,直到能量罐是空的。取决于能量罐中的剩余能量,这也会导致机器人机械手较大、较快和特别不期望的移动。
为了避免这一点,可以建议一旦不再检测到末端执行器和环境/物体之间的接触,调节器就被简单地去激活。然而,这会导致基于,例如传感器噪声的不期望的切换行为。
为了避免这一点,本文提出了基于鲁棒位置的方法,其使用被集成到调节器的调节器成形函数
由平移比和转动比组成,各自定义如下:
以及
falls=如果
sonst=否则
本示例中函数ρ(ψ)对应上述函数s(v)。ψ对应调节器偏差
机器人姿态
为了保证平滑过渡,选择插值到用户定义区dmax的插值函数
接着,转动错误被定义为
d)柔性和强顺从的物体的处理
正如前面章节中引入的,如果基于位置的方法用于控制,必须考虑到柔软且可变形的材料需要特定的处理。为了考虑实质期望位置的计划,而不需要环境的顺应或变形,在某些情况下,会引起力调节器非本意地去激活或缩放的问题。这是由当前基于顺从性的事实来调节的,与不存在顺从性的情况相比,存在另一个当前位置。因此,引入校正的实质期望位置
或,更简要地说,
参考文献:
borghesan,g.,&deschutter,j.(2014).“对混合位置-阻抗-功率任务的基于约束的说明”(constraint-basedspecificationofhybridposition-impedance-powertasks).ieeeinternationalconferenceonroboticsandautomation2014(icra2014).
cervera,j.,vanderschaft,a.,&banos,a.(2007).“端口-哈密顿体系的互连和狄喇克结构的组成”(interconnectionofport-hamiltoniansystemsandcompositionofdiracstructures).automatica(p.212--225).elsevier.
duffy,j.(1990).“基于扭动和扭曲空间的正交补的现代混合控制理论的谬误”(thefallacyofmodernhybridcontroltheorythatisbasedonorthogonalcomplementsoftwistandwrenchspaces).(p.139--144).wileyonlinelibrary.
duindam,v.,&stramigioli,s.(2004).“用于机械系统的基于端口的渐近曲线跟踪”(port-basedasymptoticcurvetrackingformechanicalsystems.(p.411-420).elsevier).
haddadin,s.(2013).“关于安全机器人:阿西莫夫第一定律探讨”(towardssaferobots:approachingasimov's1stlaw).springerpublishingcompany,incorporated.
haddadin,s.,
hogan,n.(1985).“阻抗控制:操纵的探讨:部分i-理论,部分ii-实现,部分iii-应用”(impedancecontrol:anapproachtomanipulation:parti-theory,partii-implementation,partiii–applications).asmejournalofdynamicsystems,measurement,andcontrol,(p.1-24).
lee,d.,&huang,k.(2010).“用于交互式机器人系统的无源设置-位置-调制框架”(passive-set-position-modulationframeworkforinteractiveroboticsystems).ieeetransactionsonrobotics(p.354--369).ieee.
lutscher,e.,&cheng,g.(2014).“非结构环境下间接力控制机器人的分级工作任务描述的约束操纵”(constrainedmanipulationinunstructuredenvironmentutilizinghierarchicaltaskspecificationforindirectforcecontrolledrobots).ieeeinternationalconferenceonroboticsandautomation2014(icra2014).
raibert,m.h.,&craig,j.j.(1981).“机械手的混合位置/功率控制”(hybridposition/powercontrolofmanipulators).asmejournalofdynamicalsystems,measurementandcontrol,(p.126-133).
spong,m.(1987).“弹性关节机器人的建模和控制”(modelingandcontrolofelasticjointrobots).asmej.ondynamicsystems,measurement,andcontrol,(p.310-319).
villani,l.,&deschutter,j.(2008).“o·哈提卜力控制”(forcecontrol.ino.khatib),springerhandbookofrobotics(p.161--185).springer.
zeng,g.,&hemami,a.(1997).“机器人力控制综述”(anoverviewofrobotforcecontrol).robotica(p.473-482).cambridgeunivpress.
附图说明
进一步的优点、特征和细节从下面的描述中体现,其中,必要时,参照附图详细描述了至少一个示例性实施例。相同、相似和/或起相同作用的部件用相同的附图标记表示。
附图中:
图1a至图1c为用来说明具有阻抗调节器和力调节器的所提出的混合调节器的概念简化示图,
图2为用于进行与环境交互的机器人机械手的开环和闭环控制的模型系统的示图,
图3a示意性地示出了具有末端执行器eff和预定平移鲁棒性区dmax的阻抗控制的机器人机械手,
图3b示出了平移情况下的调节器成形函数ρ(ψ)=s(v(t)),
图4为平移情况下弹性材料借助末端执行器所施加的压力的变形曲线图,
图5为所提出的装置的示意流程图,以及
图6为所提出的方法的示意流程图。
具体实施方式
图1为用来说明具有阻抗调节器和力调节器的所提出的混合调节器的概念简化图。为了清楚起见,没有示出阻尼器。图1a示出了具有末端执行器eff的纯阻抗控制的机器人机械手。阻抗控制用图示的弹簧表示。图1b示出了具有用预定的力fd抵靠物体表面(阴影线)按压的末端执行器eff的纯力调节的机器人机械手。图1c示出了根据本发明图1a和图1b的力调节器和阻抗调节器的组合。
图2为用于进行与环境/物体/工件交互的具有末端执行器的本发明的机器人机械手的开环和闭环控制的模型系统的示图。以功能块表示的环境(=:“环境”),与机器人机械手(=:“刚体动力学系统”)和致动器(=:“电动机动力学系统”)交互。借助可耦合能量罐(=:“能量罐”)的调节器(=:“力/阻抗调节器”)来实现致动器的控制和调节。用对应的输入/输出和交换量示出彼此互连的块的连接和反馈连接。在违反调节器的钝化的情况下,通过从能量罐上解耦调节器,取消外力的反馈。
图3a示意性地示出了具有末端执行器eff和预定平移鲁棒性区dmax的阻抗控制的机器人机械手。δp=ps–p表示矢量,从末端执行器位置p指向设定点ps,其中fd表示预定的力卷绕。
图3b示出了平移情况下的调节器成形函数ρ(ψ)=s(v(t))。关于函数ρ(ψ)的更详细的说明可以在上述说明(参照:部分“c脱离接触的稳定”)中找到。
图4为平移情况下弹性材料借助末端执行器eff所施加的压力的变形曲线图,更详细地示出了上述说明(参照:部分“d柔性和强顺从的物体的处理”)。
图5为用于进行由m个致动器actm驱动并具有末端执行器的机器人机械手的开环和闭环控制的所提出的装置的示意流程图,其中m=1、2、3。该装置包括第一单元记录和/或提供作用于末端执行器上的外力卷绕
图6为用于进行由m个致动器actm驱动并具有末端执行器的机器人机械手的开环和闭环控制的所提出的方法的示意流程图,其中m=1、2、……m。该方法包括下列步骤。在第一步骤201中,记录和/或提供作用于末端执行器上的外力卷绕
尽管通过优选的示例性实施例更详细地说明和解释了本发明,但本发明不受所公开的示例的限制,本领域技术人员可以在不脱离本发明的保护范围的前提下,从中得到其他变化。因此,应理解的是,存在多种变化可能性。还应理解的是,示例性说明的实施例确实仅表示示例,不应以任何方式解释为限制,例如,本发明的保护范围、应用可能性或配置。相反,前面的描述和附图说明使得本领域技术人员能够明确地实现示例性实施例,本领域技术人员已知本发明公开的思想的情况下,可以在不脱离由权利要求书及其法律等同物,例如在说明书中的进一步解释限定的保护范围的前提下实现例如,关于在示例性实施例中提到的各个元件的功能或布置的各种变化。