CN108290287B - 具有对位置和/或姿势的离散化手动输入的控制的机器人 - Google Patents

具有对位置和/或姿势的离散化手动输入的控制的机器人 Download PDF

Info

Publication number
CN108290287B
CN108290287B CN201680062483.5A CN201680062483A CN108290287B CN 108290287 B CN108290287 B CN 108290287B CN 201680062483 A CN201680062483 A CN 201680062483A CN 108290287 B CN108290287 B CN 108290287B
Authority
CN
China
Prior art keywords
point
grid
robot
structural element
orientation
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
CN201680062483.5A
Other languages
English (en)
Other versions
CN108290287A (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.)
Franka Emika GmbH
Original Assignee
Franka Emika 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
Family has litigation
First worldwide family litigation filed litigation Critical https://patents.darts-ip.com/?family=57208278&utm_source=google_patent&utm_medium=platform_link&utm_campaign=public_patent_search&patent=CN108290287(B) "Global patent litigation dataset” by Darts-ip is licensed under a Creative Commons Attribution 4.0 International License.
Application filed by Franka Emika GmbH filed Critical Franka Emika GmbH
Publication of CN108290287A publication Critical patent/CN108290287A/zh
Application granted granted Critical
Publication of CN108290287B publication Critical patent/CN108290287B/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/163Programme controls characterised by the control loop learning, adaptive, model based, rule based expert 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/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
    • 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
    • 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/36Nc in input of data, input key till input tape
    • G05B2219/36427Jog feed to a command position, if close enough robot takes over positioning
    • 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/36Nc in input of data, input key till input tape
    • G05B2219/36433Position assisted teaching
    • 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/40471Using gradient method
    • 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/40472Using exact cell decomposition
    • 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/40474Using potential fields
    • 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)

Abstract

本发明涉及一种机器人、一种机器人控制和一种用于控制机器人的方法。该机器人具有可运动的、多区段的、能够借助致动器(101)驱动的机器人结构(102),在可运动的机器人结构(102)上定义至少一个标出的结构元件S,其具有至少一个在该结构元件S上标出的点PS。机器人设置为,使得机器人在输入模式中学习在机器人的工作空间中的点PS的位置POSPS和/或的结构元件S姿势,其中,用户为了使结构元件S运动而在可运动的机器人结构上施加输入力FEING,其作为FEING,PS传递到点PS和/或作为力矩MEING,S传递到结构元件S。机器人的控制装置(103)设置为,在输入模式中,基于预设的、至少部分填满工作空间的、空间固定的虚拟的3D网格控制致动器(101),从而通过取决于点PS在3D网格中的位置POSPS的、预设的力FGRID(POSPS)使结构元件S移动到3D网格的最接近的网格点上或者移动到围绕3D网格的最接近的网格点定义的网格点体积中,结构元件S的点PS在||,FEING,PS<|)(|FGRID(POSPS)适用的情况下保持在该最接近的网格点上或保持在该网格点体积中;和/或,在输入模式中,基于预设的、虚拟的离散3D取向空间O控制致动器(101),其中,3D取向空间O=:(αi,βj,γk)通过预设的角度αi,βj,γk定义,其中,i=1,2,...,I,j=1,2,...J,k=1,2,...,K,从而通过取决于结构元件S的当前取向ORS的、预设的力矩SO ROM使结构元件S移动到3D取向空间O=:(αi,βj,γk)的最接近的离散取向,结构元件S在||,MEING,S<|)(|MO(ORS)适用的情况下保持在3D取向空间O的最接近的离散取向中。

Description

具有对位置和/或姿势的离散化手动输入的控制的机器人
技术领域
本发明涉及一种具有可运动的、多区段的、能够借助致动器驱动的机器人结构、特别是具有机器人臂的机器人,其中,该机器人这样设计和设置,即,该机器人通过用户使该机器人结构运动而在输入模式中学习在机器人的工作空间中运动的机器人结构的位置、姿势和/或运动流程。该学习过程被称为所谓“示教(Teach-in)”过程。
背景技术
特别是在与人相互作用的现代机器人中,通常通过“示教”过程将可运动的多区段机器人结构的位置、姿势和/或运动流程传授给机器人。在该“示教”过程中,通常控制能够驱动的机器人结构的致动器,使得对机器人结构进行重力补偿并且另外通过人可使机器人结构在相关的工作空间中尽可能自由地运动。这通常借助转矩调节、力调节或机器人固有的可再操作性(Rücktreibbarkeit)来完成。
所谓的“示教”过程的缺点在于,在学习能够驱动的、可运动的机器人结构的位置、姿势和运动流程的过程中受限的速度和精确度。
发明内容
本发明的目的在于,说明一种机器人,该机器人实现了改进的“示教”过程。
本发明可由独立权利要求的特征得出。有利的扩展方案和设计为从属权利要求的主题。本发明的其他特征、应用可能性和优点可由以下的描述以及对附图中示出的本发明实施例的说明中得出。
本发明的第一方面涉及一种具有可运动的、多区段的、能够借助致动器驱动的机器人结构的机器人,其中,在可运动的机器人结构上定义至少一个标出的结构元件S,其具有至少一个在该结构元件S上标出的点PS
该机器人这样设计和设置,即,机器人在输入模式中学习在机器人的工作空间中的点PS的位置POSPS和/或结构元件S的姿势,其中,用户为了使结构元件S运动而在可运动的机器人结构上施加输入力
Figure BDA0001640347740000021
该输入力
Figure BDA0001640347740000022
作为
Figure BDA0001640347740000023
传递到点PS和/或作为力矩
Figure BDA0001640347740000024
传递到结构元件S。
在此,“姿势(Pose)”的概念对应DIN EN ISO 8373来理解。由此,结构元件S的姿势是结构元件S在三维空间中的位置和取向的组合。
此外,该机器人还具有控制装置,该控制装置这样实施和设置,即,在输入模式中,基于预设的、至少部分填满工作空间的、虚拟的3D网格控制致动器,从而通过取决于点PS在3D网格中的当前位置POSPS的、预设的力
Figure BDA0001640347740000025
使结构元件S移动到3D网格的最接近的网格点上或者移动到围绕该3D网格的最接近的网格点定义的网格点体积中,其中,结构元件S的点PS
Figure BDA0001640347740000026
适用的情况下保持在该最接近的网格点上或保持在该网格点体积中。虚拟的3D网格例如可以是空间固定的或随时间变化的。例如,该虚拟的3D网格的定义可能由于切换条件或由于用户的输入而自主地改变。
所述点PS相对于3D网格的当前位置POSPS可以例如借助用于检测可运动的机器人结构的当前姿势的传感器或者通过分析用于控制致动器的控制参数而确定。相应的装置和方法可由现有技术获得。有利的是,所述点PS相对于3D网格的当前位置POSPS借助于用于检测可运动的机器人结构的当前姿势的传感器和机器人结构的CAD数据集和/或机器人结构的表面模型来确定。
由于用户手动地使结构元件S运动,所述点PS在3D网格的当前位置POSPS可以是位于3D网格的网格点之间的位置,从而针对该3D网格预设的力
Figure BDA0001640347740000027
有利地促使在工作空间中的所述点PS的当前位置POSPS,Eing类似“扫描式的(gerasterten)”平移输入,因为,当所述点PS的当前位置POSPS未对应于3D网格的一个网格点或没有位于3D网格的一个网格点体积内时,机器人结构的致动器受到控制,以使得所述点PS移动到最接近的网格点或最接近的网格点体积处。
替代性地,当所述点PS的当前位置POSPS位于对称势的中间,其中,力
Figure BDA0001640347740000028
得到均衡,所述点PS保持在该位置中。随后,通过用户的手动输入可以使所述点PS朝最接近的网格点的方向位移。
在“示教”过程中,有利的是,只有当所述点PS的当前位置POSPS对应于3D网格的一个网格点或者所述点PS的当前位置POSPS位于以上定义的网格点体积内时,才进行所述点PS的当前位置POSPS,Eing的存储。即,所述点PS进入(einrasten)3D网格的网格点或者3D网格的网格点体积。因此,有利的是,所述点PS的位置POSPS,Eing的输入或存储只有以对应于预设的3D网格的空间分辨率才是可能的。
有利的是,在“示教”过程中,即使所述点PS位于3D网格的一个网格点上或者一个网格点体积内,也只有当用户操纵能够与机器人连接的或与机器人连接的输入件时,才进行所述点PS的位置POSPS,Eing的存储或输入。
如果在用户使机器人结构运动的过程中传递到所述点PS的力
Figure BDA0001640347740000031
的量大于预设的力
Figure BDA0001640347740000032
的量,则结构元件或机器人结构能够平移。如果在用户使机器人结构运动的过程中传递到所述点PS的力
Figure BDA0001640347740000033
的量小于预设的力
Figure BDA0001640347740000034
的量,则结构元件S或机器人结构不能移动或仅在预先限定的周围范围内移动,而所述点PS保持在3D网格的最接近的网格点上或相应的网格体积中。
在此,术语“3D网格”代表任意的3D网格。该3D网格可以是特殊结构化的或未结构化的、规则的或不规则的、正交或不正交的。特别是3D网格的网格点的密度可以在空间上变化。3D网格的网格点可随着时间t而变化,即,3D网格是时变的。
替代地或额外地,控制装置这样实施和设置,即,在输入模式中,基于预设的、虚拟的离散3D取向空间O控制致动器,其中,3D取向空间O=:(αi,βi,γk)通过预设的角度αi,βi,γk定义或能够定义,其中,i=1,2,...,I,j=1,2,...J,k=1,2,...,K,从而通过取决于结构元件S的当前取向
Figure BDA0001640347740000035
的、预设的力矩
Figure BDA0001640347740000036
使结构元件S移动到3D取向空间O=:(αi,βj,γk)的最接近的离散取向,其中,结构元件S在
Figure BDA0001640347740000037
适用的情况下保持在该3D取向空间O的最接近的离散取向中。
预设的取向空间O=:(αi,βj,γk)的特征在于,其预设多个离散取向,这些离散取向例如通过预设的离散角度αi,βj,γk或者角度组合而定义或能够定义。在这种情况下,结构元件S的当前取向
Figure BDA0001640347740000038
β,γ通常为在3D取向空间O=:(αi,βj,γk)预设的离散取向之间的一个取向。
力矩
Figure BDA0001640347740000041
不产生结构元件S的平移,而是产生结构元件S的新的取向。换言之,该力矩
Figure BDA0001640347740000042
导致从结构元件S的任意取向
Figure BDA0001640347740000043
β,γ到取向空间O的最接近的离散取向
Figure BDA0001640347740000044
的重新取向。在这种情况下定义“接近度
Figure BDA0001640347740000045
”所基于的度量可以自由选择,并且可以例如根据取向表示而变化。
结构元件S相对于离散的3D取向空间O的当前取向
Figure BDA0001640347740000046
可以例如借助用于检测结构元件S的当前取向的传感器或者通过分析用于控制机器人元件的致动器的控制参数而确定。相应的装置和方法可由现有技术获得。
由于用户手动地使结构元件S运动,结构元件S相对于离散的3D取向空间O的当前取向
Figure BDA0001640347740000047
可以是在3D取向空间O的离散取向之间的一个取向,从而力矩
Figure BDA0001640347740000048
有利地促使在工作空间中类似的“扫描式的”取向输入,因为,只有当结构元件S的当前取向
Figure BDA0001640347740000049
没有对应于3D取向空间O的一个离散取向时,才控制机器人结构的致动器,以使得结构元件S移动或取向到3D取向空间O=:(αi,βj,γk)的最接近的离散取向
Figure BDA00016403477400000410
在一个有利的扩展方案中定义了可运动的机器人结构的多个结构部件Si和/或对应关联的点PS,i,由控制装置对应于上述实施方式顾及这些结构部件和点。这样特别是实现了离散化地输入整个可运动的机器人结构的姿势和运动流程。
总体而言,所提出的机器人实现了在“示教”过程中离散化地并因此精确地输入结构元件的位置、平移和/或旋转或者结构元件在相关的参考系统中的姿势和/或运动。在此,为“进行输入的”人员(用户)产生触觉的反馈,通过结构元件S或点PS与最接近的3D网格点或3D取向空间最接近的离散取向
Figure BDA00016403477400000411
之间的、能够按照需求调整的线性或非线性的阻尼作用使该触觉的反馈有利地模拟线性的或非线性的弹簧作用。在存在由外部作用到机器人元件或结构元件S的力或力矩的情况下,点PS或结构元件S“卡扣(schnappt)”到最接近的3D网格点或3D取向空间O的最接近的离散取向
Figure BDA00016403477400000412
中。
有利地,用于平移和/或旋转/取向的离散化输入的增量(步距)能够以可变的方式预设。换言之,3D网格中的网格间距或3D取向空间O的离散角度αi,βj,γk有利地能够以可变的方式预设。
这样实施的机器人特别是实现了可运动的机器人结构的位置、姿势或运动流程的快速、准确以及可重复的输入。
有利的是,机器人结构是机器人臂,特别是多区段的机器人臂。该结构元件S本质上可以是机器人臂的任意部分。有利的是,结构元件S是机器人臂的末端执行器。该机器人结构可以包括分支的可运动的元件,例如设计为机器人手。该机器人结构可以具有非致动器驱动的结构区段。
在所提出的机器人的一个扩展方案中,结构元件S是机器人臂的末端执行器,并且点PS是末端执行器的所谓的“工具中心”点TCP。“工具中心”点TCP可以在末端执行器上定义或与相对于末端执行器定义。因此,在该扩展方案中实现了离散化地并因此精确地输入“工具中心”点TCP的位置和平移。
有利的是,3D网格中的预设的力
Figure BDA0001640347740000051
周期性地变化。该力
Figure BDA0001640347740000052
虚拟地作用在结构元件S的位置PS上并且特别是取决于点PS在3D网格中的当前位置POSPS。当然,可以根据要求和应用情况在机器人的工作空间中以非周期的形式或以混合形式(周期性和非周期性)来预设3D网格中的预设的力
Figure BDA0001640347740000053
有利的是,针对整个3D网格或从其中选出的区域预设该力
Figure BDA0001640347740000054
的最大量
Figure BDA0001640347740000055
和/或最小量
Figure BDA0001640347740000056
从而适用于:
Figure BDA0001640347740000057
Figure BDA0001640347740000058
优选能够由各个用户经机器人的输入件以可变的方式预设最大量
Figure BDA0001640347740000059
和/或最小量
Figure BDA00016403477400000510
有利的是,测量
Figure BDA00016403477400000511
和/或
Figure BDA00016403477400000512
以避免意外或无意地输入或使点PS移动,并且同时使为了移动所述点PS所要求的输入力
Figure BDA00016403477400000513
的量
Figure BDA00016403477400000514
由用户感知为舒适的,其中,所述点PS的移动始终要求:
Figure BDA00016403477400000515
有利地,借助于机器人的输入装置,例如单独地或者针对机器人的工作空间的一些区域,能够以可变的形式预设3D网格的网格点和/或3D网格的网格点的间距。特别地,为了在单个的空间区域中实现更高的分辨率,机器人的工作空间的一些空间区域可以具有比其他区域更密集的3D网格(即,单位体积中更多的网格点)。有利的是,机器人具有输入装置,该输入装置可访问存储有各种3D网格的存储单元,这些3D网格能够通过输入装置进行选择。
有利的是,力
Figure BDA0001640347740000061
能够借助于输入装置而以可变的形式预设。例如,可以预设3D网格的单元格内的位置POSPS的力
Figure BDA0001640347740000062
并将其传递到3D网格或工作空间的一些部分区域。
有利的是,控制装置这样实施和设置,即,在3D网格的至少两个最接近的网格点或网格点体积与该3D网格中的所述点PS的当前位置POSPS等距的情况下,根据预设的方法选择这些网格点/网格点体积中的一个作为所述最接近的网格点/网格点体积。这类决定可以基于随机算法(即,以统计学的方式)进行。当然,根据应用情况和任务的不同,可以使用不同的选择算法。
有利的是,控制装置这样实施和设置,即,在工作空间中定义虚拟的3D势场(3D-Potentialfeld),其局部最小值与3D网格的网格点相同,其中,力
Figure BDA0001640347740000063
由该势场的负梯度确定。可以根据任务和应用情况而相应地预设该势场。
有利的是,3D势场的局部最小值在围绕3D网格的每个网格点预设的空间区域中具有恒定的势,其中,该预设的空间区域具有小于两个相邻的网格点之间的网格间距的最大延伸范围。
有利的是,针对3D取向空间O或从其中选出的区域对预设的力矩
Figure BDA0001640347740000064
的最大量
Figure BDA0001640347740000065
和/或最小量
Figure BDA0001640347740000066
进行预设,从而适用于:
Figure BDA0001640347740000067
Figure BDA0001640347740000068
优选能够由各个用户经机器人的输入件以可变的方式预设最大量
Figure BDA0001640347740000069
和/或最小量
Figure BDA00016403477400000610
有利的是,测量
Figure BDA00016403477400000611
和/或
Figure BDA00016403477400000612
以避免意外或无意的结构元件S的重新取向,并且同时使为了使结构元件S的重新取向所要求的力矩
Figure BDA00016403477400000613
的量
Figure BDA00016403477400000614
被用户感知为舒适的,其中,结构元件S的重新取向始终要求:
Figure BDA00016403477400000615
在机器人的一个扩展方案中取决于所述点PS的当前位置POSpS的取向空间O=:(αi,βj,γk)被定义为:
O=O(POSpS)=(αi(POSpS),βj(POSpS),γk(POSpS))。
这实现了,根据所述点PS的当前位置POSPS而在工作空间中预设不同的离散取向空间。
有利的是,机器人包括输入装置,借助该输入装置能够以可变的方式预设3D网格的网格点的间距。
有利的是,机器人包括输入装置,借助该输入装置能够以可变的方式预设取向空间O的离散角度αi,βj,γk
有利的是,控制装置这样实施和设置,即,在至少两个最接近的取向O=:(αi,βj,γk)具有相对于结构元件S的当前取向
Figure BDA0001640347740000071
相同的差异的情况下,根据预设的方法选择这些取向O=:(αi,βj,γk)中的一个。
本发明的另一个方面涉及一种用于控制机器人的方法,该机器人具有可运动的、多区段的、能够借助致动器驱动的机器人结构,其中,在可运动的机器人结构上定义至少一个标出的结构元件S,其具有至少一个在该结构元件S上标出的点PS,并且机器人在输入模式中学习在机器人的工作空间中点PS的位置POSPS和/或结构元件S的姿势,其中,用户为了使结构元件S运动而在可运动的机器人结构上施加输入力
Figure BDA0001640347740000072
该输入力
Figure BDA0001640347740000073
作为
Figure BDA0001640347740000074
传递到所述点PS和/或作为力矩
Figure BDA0001640347740000075
传递到结构元件S。
在所提出的方法中,在输入模式中,基于预设的、至少部分填满工作空间的、虚拟的3D网格控制致动器,从而通过取决于点PS在3D网格中的当前位置POSPS的、预设的力
Figure BDA0001640347740000076
使结构元件S移动到3D网格的最接近的网格点上或者移动到围绕该3D网格的最接近的网格点定义的网格点体积中,其中,结构元件S的点PS
Figure BDA0001640347740000077
适用的情况下保持在该最接近的网格点上或保持在该网格点体积中。
替代地或额外地,在输入模式中,基于预设的、虚拟的离散3D取向空间O控制致动器,其中,3D取向空间O=:(αi,βj,γk)通过预设的角度αi,βj,γk定义,其中,i=1,2,...,I,j=1,2,...J,k=1,2,...,K,从而通过取决于结构元件S的当前取向
Figure BDA0001640347740000078
的、预设的力矩
Figure BDA0001640347740000079
使结构元件S移动到3D取向空间O=:(αi,βj,γk)的最接近的离散取向,其中,结构元件S在
Figure BDA00016403477400000710
适用的情况下保持在该3D取向空间O的最接近的离散取向中。
在所提出的方法中,有利的是,在工作空间中定义虚拟的3D势场,其局部最小值与3D网格的网格点相同,其中,力
Figure BDA00016403477400000711
由该势场的负梯度确定。
在该方法的一个扩展方案中,3D势场的局部最小值在围绕3D网格的每个网格点的预设的空间区域中具有恒定的势,其中,该空间区域具有小于两个相邻的网格点之间的网格间距的最大延伸范围。
在该方法的一个扩展方案中,在至少两个最接近的取向O=:(αi,βj,γk)具有相对于结构元件S的当前取向ORS相同的差异的情况下,根据预设的方法选择这些取向O=:(αi,βi,γk)中的一个。
所提出的方法的扩展方法和由此得出的优点可以从所提出的机器人的以上实施方式类似地得出。
本发明的另一方面涉及一种机器人控制,其中,该机器人控制被设计为,在数据处理装置上执行如上所述的方法。
本发明的另一方面涉及一种具有数据处理装置的计算机系统,其中,该数据处理装置被设计为,在数据处理装置上执行如上所述的方法。
本发明的另一方面涉及一种用于控制机器人的调节装置,该机器人具有可运动的、多区段的、能够借助致动器驱动的机器人结构,其中,在可运动的机器人结构上定义至少一个标出的结构元件S,其具有至少一个在该结构元件S上标出的点PS,并且该机器人在输入模式中学习在机器人的工作空间中的点PS的位置POSPS和/或结构元件S的姿势,其中,用户为了使结构元件S运动而在可运动的机器人结构上施加输入力
Figure BDA0001640347740000081
该输入力
Figure BDA0001640347740000082
作为
Figure BDA0001640347740000083
传递到所述点PS和/或作为力矩
Figure BDA0001640347740000084
传递到结构元件S。
该调节装置包括控制装置,该控制装置这样实施和设置,即,在输入模式中,基于预设的、至少部分填满工作空间的、虚拟的3D网格控制致动器,从而通过取决于点PS在3D网格中的当前位置POSPS的、预设的力
Figure BDA0001640347740000085
使结构元件S移动到3D网格的最接近的网格点上或者移动到围绕该3D网格的最接近的网格点定义的网格点体积中,其中,结构元件S的点PS
Figure BDA0001640347740000086
适用的情况下保持在该最接近的网格点上或保持在该网格点体积中;和/或,在输入模式中,基于预设的、虚拟的离散3D取向空间O控制致动器,其中,3D取向空间O=:(αi,βj,γk)通过预设的角度αi,βj,γk定义或能够定义,其中,i=1,2,...,I,j=1,2,...J,k=1,2,...,K,从而通过取决于结构元件S的当前取向
Figure BDA0001640347740000087
的、预设的力矩
Figure BDA0001640347740000088
使结构元件S移动到3D取向空间O=:(αi,βj,γk)的最接近的离散取向,其中,结构元件S在
Figure BDA0001640347740000089
适用的情况下保持在该3D取向空间O的最接近的离散取向中。
所提出的调节装置的扩展方法和由此得出的优点可以从以上实施方式类似地得出。
另外,本发明还涉及一种具有电子可读控制信号的数字存储介质,其中,控制信号可以与可编程的计算机系统协作,从而执行如上所述的方法。
本发明还涉及一种计算机程序产品,其具有存储在机器可读载体上的程序代码,用于当在数据处理装置上执行该程序代码时执行如上所述的方法。
最后,本发明涉及一种具有程序代码的计算机程序,用于当在数据处理装置上执行程序代码时执行如上所述的方法。为此,数据处理装置可以被设计为现有技术的已知的任何计算机系统。
附图说明
其他的优点、特征和细节可从以下描述中得出,其中,在必要时参照附图详细地描述了至少一个实施例。相同的、类似的和/或功能相同的部件具有相同的附图标记。其中:
图1为所提出的机器人的示意图。
具体实施方式
图1示出了所提出的机器人的示意图,该机器人具有可运动的、多区段的、能够借助于致动器101驱动的机器人结构102,其中,在可运动的机器人结构102上定义至少一个标出的结构元件S,其具有在该结构元件S上标出的点PS。该机器人结构102安装在机器人主体(虚线框)上。
在此,机器人结构102是五个区段的机器人臂102,在其远端上设置有执行器S。在这种情况下,该执行器S是结构元件S。在该执行器S上定义所谓的“工具中心点”=TCP,该工具中心点与标出的点PS是相同的,即,PS=PTCP
该机器人这样设计和设置,以使得该机器人能够在输入模式中学习在机器人的工作空间内的TCP的位置POSTCP和/或执行器S的姿势,其中,用户为了使执行器S运动而在机器人臂上施加输入力
Figure BDA0001640347740000091
该输入力作为
Figure BDA0001640347740000092
传递到点PTCP和/或作为力矩
Figure BDA0001640347740000093
传递到执行器。
该机器人另外还包括控制装置,该控制装置实施和设置为,在输入模式中,基于预设的、至少部分填满工作空间的、空间稳定的虚拟的3D网格控制致动器101,以使得通过取决于工具中心点TCP在3D网格中的当前位置POSTCP的、预设的力
Figure BDA0001640347740000101
使执行器S移动到3D网格中最接近的网格点,其中,结构元件S的点PTCP
Figure BDA0001640347740000102
适用的情况下保持在该最接近的网格点上。
另外,该控制装置实施和设置为,在输入模式中,基于预设的、虚拟的离散3D取向空间O控制致动器101,其中,3D取向空间O=:(αi,βj,γk)通过预设的角度αi,βj,γk定义,其中,i=1,2,...,I,j=1,2,...J,k=1,2,...,K,从而通过取决于执行器S的当前取向
Figure BDA0001640347740000103
的、预设的力矩
Figure BDA0001640347740000104
使执行器S移动到3D取向空间O=:(αi,βj,γk)的最接近的离散取向,其中,结构元件S在
Figure BDA0001640347740000105
适用的情况下保持在该3D取向空间O的最接近的离散取向中。
尽管通过优选的实施例详细地进一步示出和说明了本发明,但本发明并不限于所公开的实施例,而且本领域技术人员在不脱离本发明的范围的情况下可以由此衍生出其他变型。因此,显而易见的是,存在多种变化可能性。还应该理解的是,举例说明的实施例实际上仅是示例,其不应以任何方式理解为对本发明的范围、应用可能性或配置的限制。相反,以上的描述和附图描述使本领域技术人员能够具体地实现示例性实施方式,其中,在不超出由权利要求书及其法律等同部分(例如说明书中的进一步说明)定义的保护范围情况下,本领域技术人员基于对公开的本发明构思的认知可以采用例如关于在示例性的实施方式中所提及元件的功能或布设的各种变型。
附图标记列表
101 致动器
102 可运动的、多区段的机器人结构
103 控制装置

Claims (10)

1.一种具有可运动的、多区段的、能够借助致动器(101)驱动的机器人结构(102)的机器人,其中,
-在所述可运动的机器人结构(102)上定义至少一个标出的结构元件S,所述结构元件S具有至少一个在所述结构元件S上标出的点PS
-所述机器人这样设计和设置,即,所述机器人在输入模式中学习在所述机器人的工作空间中的所述点PS的位置POSPS和/或所述结构元件S的姿势,其中,用户为了使所述结构元件S运动而在所述可运动的机器人结构上施加输入力
Figure FDA0002878267640000011
所述输入力
Figure FDA0002878267640000012
作为
Figure FDA0002878267640000013
传递到所述点PS和/或作为力矩
Figure FDA0002878267640000014
传递到所述结构元件S,并且
-所述机器人的控制装置(103)这样实施和设置,即,
·在所述输入模式中,基于预设的、至少部分填满所述工作空间的、虚拟的3D网格控制所述致动器(101),从而通过取决于所述点PS在所述3D网格中的当前位置POSPS的、预设的力
Figure FDA0002878267640000015
使所述结构元件S移动到所述3D网格的最接近的网格点上或者移动到围绕所述3D网格的最接近的网格点定义的网格点体积中,其中,所述结构元件S的所述点PS
Figure FDA0002878267640000016
适用的情况下保持在所述最接近的网格点上或保持在所述网格点体积中,和/或
·在所述输入模式中,基于预设的、虚拟的离散3D取向空间O控制所述致动器(101),其中,所述3D取向空间O=:(αijk)通过预设的角度αijk定义,其中,i=1,2,…,I,j=1,2,…J,k=1,2,…,K,从而通过取决于所述结构元件S的当前取向
Figure FDA0002878267640000017
的、预设的力矩
Figure FDA0002878267640000018
使所述结构元件S移动到所述3D取向空间O=:(αijk)的最接近的离散取向,其中,所述结构元件S在
Figure FDA0002878267640000019
适用的情况下保持在所述3D取向空间O的最接近的离散取向中。
2.根据权利要求1所述的机器人,其中,在所述3D网格中的所述预设的力
Figure FDA00028782676400000110
周期性地变化。
3.根据权利要求1所述的机器人,其中,所述控制装置(103)这样实施和设置,即,在至少两个最接近的网格点或网格点体积与所述点PS的当前位置POSPS等距的情况下,根据预设的方法选择这些网格点/网格点体积中的一个作为所述最接近的网格点/网格点体积。
4.根据权利要求1所述的机器人,其中,所述控制装置(103)这样实施和设置,即,在所述工作空间中定义虚拟的3D势场,其局部最小值与所述3D网格的网格点相同,其中,所述力
Figure FDA0002878267640000021
由所述3D势场的负梯度确定。
5.根据权利要求1所述的机器人,其中,所述控制装置(103)这样实施和设置,即,在至少两个最接近的取向O=:(αijk)具有相对于所述结构元件S的当前取向
Figure FDA0002878267640000022
相同的差异的情况下,根据预设的方法选择这些取向O=:(αijk)中的一个。
6.根据权利要求1至5中任一项所述的机器人,其中,取决于所述点PS的当前位置POSPS的所述取向空间O=:(αijk)被定义为:O=O(POSPS)=(αi(POSPS),βj(POSPS),γk(POSPS))。
7.一种用于控制机器人的方法,所述机器人具有可运动的、多区段的、能够借助致动器(101)驱动的机器人结构(102),其中,
-在所述可运动的机器人结构(102)上定义至少一个标出的结构元件S,所述结构元件S具有至少一个在所述结构元件S上标出的点PS
-所述机器人在输入模式中学习在所述机器人的工作空间中的所述点PS的位置POSPS和/或所述结构元件S的姿势,其中,用户为了使所述结构元件S运动而在所述可运动的机器人结构(102)施加输入力
Figure FDA0002878267640000023
所述输入力
Figure FDA0002878267640000024
作为
Figure FDA0002878267640000025
传递到所述点PS和/或作为力矩
Figure FDA0002878267640000026
传递到所述结构元件S,并且
-控制装置(103)
·在所述输入模式中,基于预设的、至少部分填满所述工作空间的、虚拟的3D网格控制所述致动器(101),从而通过取决于所述点PS在所述3D网格中的当前位置POSPS的、预设的力
Figure FDA0002878267640000027
使所述结构元件S移动到所述3D网格的最接近的网格点上或者移动到围绕所述3D网格的最接近的网格点定义的网格点体积中,其中,所述结构元件S的所述点PS
Figure FDA0002878267640000028
适用的情况下保持在所述最接近的网格点上或保持在所述网格点体积中,和/或
·在所述输入模式中,基于预设的、虚拟的离散3D取向空间O控制所述致动器(101),其中,所述3D取向空间O=:(αijk)通过预设的角度αijk定义,其中,i=1,2,…,I,j=1,2,…J,k=1,2,…,K,从而通过取决于所述结构元件S的当前取向
Figure FDA0002878267640000031
的、预设的力矩
Figure FDA0002878267640000032
使所述结构元件S移动到所述3D取向空间O=:(αijk)的最接近的离散取向,其中,所述结构元件S在
Figure FDA0002878267640000033
适用的情况下保持在所述3D取向空间O的最接近的离散取向中。
8.根据权利要求7所述的方法,其中,在所述工作空间中定义虚拟的3D势场,其局部最小值与所述3D网格的网格点相同,其中,所述力
Figure FDA0002878267640000034
由所述3D势场的负梯度确定。
9.根据权利要求8所述的方法,其中,所述3D势场的所述局部最小值在围绕所述3D网格的每个网格点预设的空间区域中具有恒定的势,其中,所述空间区域具有小于两个相邻的网格点之间的网格间距的最大延伸范围。
10.根据权利要求7至9中任一项所述的方法,其中,在至少两个最接近的取向O=:(αijk)具有相对于所述结构元件S的当前取向ORS相同的差异的情况下,根据预设的方法选择这些取向O=:(αijk)中的一个。
CN201680062483.5A 2015-11-04 2016-10-25 具有对位置和/或姿势的离散化手动输入的控制的机器人 Active CN108290287B (zh)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
DE102015118918.6 2015-11-04
DE102015118918.6A DE102015118918B3 (de) 2015-11-04 2015-11-04 Roboter mit Ansteuerung zur diskretisierten manuellen Eingabe von Positionen und/oder Posen
PCT/EP2016/075674 WO2017076697A1 (de) 2015-11-04 2016-10-25 Roboter mit ansteuerung zur diskretisierten manuellen eingabe von positionen und/oder posen

Publications (2)

Publication Number Publication Date
CN108290287A CN108290287A (zh) 2018-07-17
CN108290287B true CN108290287B (zh) 2021-06-15

Family

ID=57208278

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201680062483.5A Active CN108290287B (zh) 2015-11-04 2016-10-25 具有对位置和/或姿势的离散化手动输入的控制的机器人

Country Status (9)

Country Link
US (1) US10994415B2 (zh)
EP (1) EP3370925B1 (zh)
JP (1) JP2018532608A (zh)
KR (1) KR102078733B1 (zh)
CN (1) CN108290287B (zh)
DE (1) DE102015118918B3 (zh)
DK (1) DK3370925T3 (zh)
SG (1) SG11201803457QA (zh)
WO (1) WO2017076697A1 (zh)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110154022B (zh) * 2019-05-20 2020-10-30 南京航浦机械科技有限公司 一种基于定向刚度模型的机器人制孔径向定位修正方法
DE102019220619B3 (de) * 2019-12-30 2021-01-28 Kuka Deutschland Gmbh Bewegen einer roboterfesten Referenz
DE102021125628B3 (de) 2021-10-04 2022-10-13 Physik Instrumente (PI) GmbH & Co KG Geschwindigkeitsvorgaben zur Trajektorienbestimmung von Kinematiken

Family Cites Families (21)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE3606685A1 (de) 1986-02-28 1987-09-03 Forsch Steuerungstechnik Der W Vorrichtung zur handfuehrung eines industrieroboters
JPH01175608A (ja) 1987-12-29 1989-07-12 Honda Motor Co Ltd ロボットのティーチングデータ作成方法
IT1239878B (it) 1990-02-02 1993-11-15 Fiat Auto Spa Sistema per la rilevazione dei parametri di movimento di robot industriali e simili.
DE4408982C1 (de) 1994-03-16 1995-05-18 Deutsche Forsch Luft Raumfahrt Autonomes Navigationssystem für einen mobilen Roboter oder Manipulator
DE69601567T2 (de) 1995-07-05 1999-06-24 Fanuc Ltd Vorrichtung und verfahren zum steuern der bewegung eines roboters
CN1055157C (zh) 1997-07-18 2000-08-02 中国科学院沈阳自动化研究所 机器人重复位姿精度检测系统
JPH11254361A (ja) 1998-03-13 1999-09-21 Sumitomo Heavy Ind Ltd ロボットにおけるダイレクトティーチングのモード切替え方式
JP2002073130A (ja) 2000-06-13 2002-03-12 Yaskawa Electric Corp ロボットの大域動作経路計画方法とその制御装置
CN100338433C (zh) 2005-03-10 2007-09-19 新奥博为技术有限公司 激光扫描器与机器人的相对位置的标定方法
WO2009092164A1 (en) * 2008-01-25 2009-07-30 Mcmaster University Surgical guidance utilizing tissue feedback
JP4962424B2 (ja) 2008-06-16 2012-06-27 株式会社デンソーウェーブ ロボットのダイレクトティーチ制御装置
EP2350750B1 (en) 2008-11-25 2012-10-31 ABB Technology Ltd A method and an apparatus for calibration of an industrial robot system
CN102601684B (zh) * 2012-04-06 2013-11-20 南京航空航天大学 基于间接测量法的高精度制孔机器人的工具参数标定方法
DE102012012988A1 (de) * 2012-06-29 2014-04-17 Liebherr-Verzahntechnik Gmbh Vorrichtung zur automatisierten Handhabung von Werkstücken
CN102785246B (zh) * 2012-08-24 2015-01-21 电子科技大学 一种可实现自动轨迹修正的机器人标定方法
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
DE102014001168B4 (de) * 2014-01-31 2019-03-14 Abb Schweiz Ag Robotersteuerung
US20150331415A1 (en) * 2014-05-16 2015-11-19 Microsoft Corporation Robotic task demonstration interface
US9272417B2 (en) * 2014-07-16 2016-03-01 Google Inc. Real-time determination of object metrics for trajectory planning
CN104457566A (zh) 2014-11-10 2015-03-25 西北工业大学 一种无须示教机器人系统的空间定位方法
US9815198B2 (en) * 2015-07-23 2017-11-14 X Development Llc System and method for determining a work offset

Also Published As

Publication number Publication date
DE102015118918B3 (de) 2017-05-04
EP3370925B1 (de) 2020-08-12
US10994415B2 (en) 2021-05-04
JP2018532608A (ja) 2018-11-08
EP3370925A1 (de) 2018-09-12
WO2017076697A1 (de) 2017-05-11
US20190061148A1 (en) 2019-02-28
KR20180097532A (ko) 2018-08-31
CN108290287A (zh) 2018-07-17
DK3370925T3 (da) 2020-11-02
KR102078733B1 (ko) 2020-02-19
SG11201803457QA (en) 2018-05-30

Similar Documents

Publication Publication Date Title
Nemec et al. Human robot cooperation with compliance adaptation along the motion trajectory
CN108189036B (zh) 力矩控制方法、装置、机器人及存储介质
Akyuz et al. PID and state feedback control of a single-link flexible joint robot manipulator
Flacco et al. Discrete-time redundancy resolution at the velocity level with acceleration/torque optimization properties
KR102421676B1 (ko) 다관절 로봇의 액추에이터들을 제어하기 위한 시스템 및 방법
CN108290287B (zh) 具有对位置和/或姿势的离散化手动输入的控制的机器人
EP2412496B1 (en) Movement-simulator
CN108883533A (zh) 机器人控制
Singh et al. Inverse dynamics and control of a 3-DOF planar parallel (U-shaped 3-PPR) manipulator
Campeau-Lecours et al. A time-domain vibration observer and controller for physical human-robot interaction
KR102334764B1 (ko) 햅틱 장치를 통한 가상 피드백을 위한 시스템 및 방법
CN110809505A (zh) 用于执行机器人手臂的移动控制的方法和装置
JP6960242B2 (ja) ロボットシステム及びロボットシステムの制御方法
Ba et al. Indirect sliding mode control based on gray-box identification method for pneumatic artificial muscle
Thomas et al. Compliance shaping for control of strength amplification exoskeletons with elastic cuffs
Lendermann et al. Comparison of passivity based impedance controllers without torque-feedback for variable stiffness actuators
Redjimi et al. Extrapolated state estimation in fixed point transformation-based adaptive control using fractional order feedback
Widhiada et al. Dexterity robot manipulator gripper using auto tuning of PID control
Damsteeg et al. Model-based real-time control of a magnetic manipulator system
Navarro-Alarcon et al. A method to regulate the torque of flexible-joint manipulators with velocity control inputs
Ozawa et al. Dynamic manipulation based on thumb opposability: Passivity-based blind grasping and manipulation
Chang et al. A novel master switching method for electronic cam control with special reference to multi-axis coordinated trajectory following
Vega-Hernández et al. Kinesthetic guidance based on PID control for haptic interaction
Dang et al. Robust control system design for robot motion regeneration under disturbance input
Rauh et al. Sensitivity-based approaches for an efficient design of learning-type controllers of a flexible high-speed rack feeder system

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