CN105856225A - 用于运行多轴机器、特别是机器人的方法和系统 - Google Patents

用于运行多轴机器、特别是机器人的方法和系统 Download PDF

Info

Publication number
CN105856225A
CN105856225A CN201610081318.6A CN201610081318A CN105856225A CN 105856225 A CN105856225 A CN 105856225A CN 201610081318 A CN201610081318 A CN 201610081318A CN 105856225 A CN105856225 A CN 105856225A
Authority
CN
China
Prior art keywords
value
entrance
machine
actual value
actual
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.)
Granted
Application number
CN201610081318.6A
Other languages
English (en)
Other versions
CN105856225B (zh
Inventor
海因里希·蒙茨
J·莱宾格
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
Family has litigation
First worldwide family litigation filed litigation Critical https://patents.darts-ip.com/?family=54707502&utm_source=google_patent&utm_medium=platform_link&utm_campaign=public_patent_search&patent=CN105856225(A) "Global patent litigation dataset” by Darts-ip is licensed under a Creative Commons Attribution 4.0 International License.
Application filed by KUKA Roboter GmbH filed Critical KUKA Roboter GmbH
Publication of CN105856225A publication Critical patent/CN105856225A/zh
Application granted granted Critical
Publication of CN105856225B publication Critical patent/CN105856225B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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
    • 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/402—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 control arrangements for positioning, e.g. centring a tool relative to a hole in the workpiece, additional detection means to correct position
    • 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/1628—Programme controls characterised by the control loop
    • B25J9/163—Programme controls characterised by the control loop learning, adaptive, model based, rule based expert control
    • 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/1628—Programme controls characterised by the control loop
    • B25J9/1653—Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
    • 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/34—Director, elements to supervisory
    • G05B2219/34235—Control order of multiplexed axis
    • 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/34—Director, elements to supervisory
    • G05B2219/34484—Use dual channels
    • 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/42—Servomotor, servo controller kind till VSS
    • G05B2219/42306—Excess in error, compare reference with feedback

Abstract

一种用于运行多轴机器、特别是机器人的方法，其中机器控制器控制机器驱动器；安全性控制器监视机器，安全性控制器具有第一通道和对其冗余的、特别是多样性冗余的第二通道；第一通道和第二通道分别从机器控制器获取第一入口额定值和第一入口实际值；将取决于第一入口额定值的第一比较额定值与取决于第一入口实际值的第一比较实际值彼此进行比较；如果第一比较额定值和第一比较实际值之间的偏差超过预设的允差，触发错误反应；第一入口额定和实际值具有机器的与机器固定的参照物的参照物位置值和/或其一阶和/或更高阶的时间导数，并且机器控制器基于与机器固定的参照物的参照物位置值和机器轴位置值之间的变换来确定额定和/或实际参照物位置值。

Description

用于运行多轴机器、特别是机器人的方法和系统
技术领域
本发明涉及用于运行多轴机器、特别是机器人的一种方法和一种系统，并涉及一种具有机器人和所述系统的设施以及一种用于实施该方法的计算机程序产品。
背景技术
由企业内部的实践可知，在安全性控制器中会将如TCP那样的与机器固定的参照物的实际参照物位置值与预设的边界值进行比较，以便例如监视机器人的工作空间。在此，所述安全性控制器基于来自于检测到的实际轴位置值的所谓的前馈变换来确定这些实际参照物位置值。
缺点在于，这增加了安全性控制器中的运算耗费。此外，必须存在前馈变换所基于的模型，并且当机器的运动学变化时必须对该模型进行适配。
另一方面，控制所述多轴机器驱动器的机器控制器经常总归会实施运算时间紧张的反馈变换以用于由预设的额定参照物位置值确定所属的额定轴位置值，其中，该反馈变换可以基于同一模型。
发明内容
本发明的目的在于改进多轴机器的运行。
该目的通过按照本发明的方法来解决。一种用于运行一多轴机器的系统被设计为实施在此所描述的方法，本发明还提供了一种具有机器人和用于运行该机器人、特别是用于监视该机器人和用于控制其驱动器的这种系统的设施，一种用于实施在此所描述的方法的计算机程序产品。
根据本发明的一个方面，用于运行一多轴机器、特别是一多轴机器人的系统，特别是一种用于运行设施机器人的设施系统具有一用于控制所述机器的驱动器的机器控制器和具有一用于监视所述机器的安全性控制器，该安全性控制器具有第一通道和对其冗余的、特别是多样性冗余的第二通道。“多轴机器”的概念在此是指，该机器具有至少两个轴，这两个轴可以分别配设有一驱动器。然而应当理解，该机器也可以具有三个、四个、五个、六个或更多的轴或驱动器。特别地，多轴机器可以是机器人、特别是工业机器人，其具有正好五个、六个或七个轴或驱动器。在此，多样性冗余的概念特别是描述了这样的情形：多样性冗余的第二通道使用与第一通道不同的实现技术，确切地说是在硬件技术上和/或在软件技术上。由此可以例如在每个通道中设置不同的电子构件、不同类型的组件和/或不同的电路设计。替代地或附加地可以使用不同的程序和/或编程语言编译器(英文：Compiler)，这两者特别是来自不同的制造商。
在此，控制特别是被理解为在机器驱动器的驱动器调节器上的额定值预设。同样地，额定值基于与检测到的或确定的实际值的比较所进行的调节、即预设也可以归纳为本发明意义下的控制。因此，本发明意义下的控制特别可以是所谓的前馈控制(英文：“feedforward control”)或调节(英文：“feedback control”)。相应地，在一种实施方式中，所述系统具有驱动器控制器、特别是驱动器调节器，以用于控制、特别是调节所述机器的驱动器。这些驱动器控制器、特别是驱动器调节器可以是机器控制器的部件或者从该机器控制器获取调节参量并基于这些调节参量来控制所述驱动器、特别是使所述驱动器通电。
在一种实施方式中，安全性控制器具有正好或至少两个通道。在一种实施方式中，这些通道可以在硬件和/或软件技术上以冗余方式、特别是以多样性冗余方式构造，特别是可以在多核处理器的各样的、特别是不同的处理器或核芯上实行，可以具有各样的、特别是不同的数据连接、特别是总线，和/或可以具有或实施各样的、特别不同的程序。
根据本发明的一个方面，第一通道从机器控制器获取第一入口额定值和第一入口实际值，将取决于第一入口额定值的、特别是可以就是第一入口额定值的第一比较额定值与取决于第一入口实际值的、特别是可以就是第一入口实际值的第一比较实际值彼此进行比较，并且如果第一比较额定值和第一比较实际值之间的偏差超过预设的允差，则触发错误反应。
对其冗余地、特别是并行地和/或多样性冗余地，第二通道从机器控制器获取特别是相同的第一入口额定值和特别是相同的第一入口实际值，将取决于第一入口额定值的、特别是以与在第一通道中相同的方式确定的、特别是可以就是第一入口额定值的第一比较额定值与取决于第一入口实际值的、特别是以与在第一通道中相同的方式确定的、特别是可以就是第一入口实际值的第一比较实际值彼此进行比较，并且如果所述第一比较额定值和第一比较实际值之间的偏差超过预设的、特别是相同的允差，则触发一错误反应、特别是同一错误反应。
在此，在一种实施方式中，第一入口额定值具有机器的与机器固定的参照物的(额定)参照物位置值和/或其一阶和/或更高阶的时间导数，并且第一入口实际值具有机器的与机器固定的参照物的(实际)参照物位置值和/或其一阶和/或更高阶的时间导数，并且机器控制器基于与机器固定的参照物的参照物位置值和机器的轴位置值之间的变换来确定所述额定参照物位置值和/或所述实际参照物位置值。
在一种实施方式中，参照物位置值包括特别是笛卡尔式的位态坐标和/或定向坐标或者说角度坐标，或者说参照物位置值在一种实施方式中表示所述与机器固定的参照物相对于一特别是与机器、工件和/或周围环境固定的基准点或者说基准坐标系的特别是一维、二维或三维的距离和/或特别是一维、二维或三维的定向。在一种实施方式中，与机器固定的参照物是机器人的TCP(英文：“Tool Center Point”，工具中心点)。
由此，在一种实施方式中可以一方面将参照物位置值的运算时间紧张的确定基于变换从安全性控制器转移至机器控制器中。这特别是能够实现较紧凑的安全性控制器。附加地因此可以针对所述变换使用机器的存储在机器控制器中的模型、特别是如轴距和类似数据那样的运动学数据，由此有利地，模型不必再存储并实时地保留在安全性控制器中。
另一方面，对额定和实际参照物位置值的双通道式的、以冗余方式的检验可以有利地确保机器的安全运行。
在一种实施方式中，机器控制器基于与机器固定的参照物的参照物位置值和所述机器的检测到的实际轴位置值之间的前馈变换来确定实际参照物位置值，这些实际参照物位置值具有、特别是就是第一入口实际值。附加地或替代地，在一种实施方式中，例如当预设了轴的移动时，机器控制器基于在与机器固定的参照物的参照物位置值和所述机器的预设的额定轴位置值之间的、特别是相同的或不同的前馈变换来确定额定参照物位置值，这些额定参照物位置值具有、特别是就是第一入口额定值。在另一种实施方式中，机器控制器基于所述机器的预设的控制程序、特别是借助轨迹规划和/或内插法来确定额定参照物位置值，这些额定参照物位置值具有、特别是就是第一入口额定值。
在一种实施方式中，第一通道附加地还获取第二入口额定值和第二入口实际值，将取决于第二入口额定值的、特别是可以就是第二入口额定值的第二比较额定值与取决于第二入口实际值的、特别是可以就是第二入口实际值的第二比较实际值彼此进行比较，并且如果所述第二比较额定值和第二比较实际值之间的偏差超过预设的允差，则触发错误反应。
对其冗余地、特别是并行地和/或多样性冗余地，第二通道获取特别是相同的第二入口额定值并获取特别是相同的或不同的、特别是冗余的第二入口实际值，将取决于所述第二入口额定值的、特别是以与在第一通道中相同的方式确定的、特别是可以就是第二入口额定值的第二比较额定值与取决于所述第二入口实际值的、特别是以与在第一通道中相同的方式确定的、特别是可以就是第二入口实际值的第二比较实际值彼此进行比较，并且如果所述第二比较额定值和第二比较实际值之间的偏差超过预设的、特别是相同的允差，则触发错误反应，特别是与在第一通道中相同的错误反应。
在此在一种实施方式中，第二入口额定值具有机器的(额定)轴位置值和/或其一阶和/或更高阶的时间导数，并且第二入口实际值具有机器的(实际)轴位置值和/或其一阶和/或更高阶的时间导数。
在一种实施方式中，轴位置值包括多轴机器的一个或多个、特别是所有运动轴的关节坐标或者说关节姿势、特别是关节角度，或者说在一种实施方式中表示轴相对于基准姿势或者说零位态的姿势。在一种实施方式中，这些轴位置值是特别是机器人的驱动器、特别是马达和/或与它们耦合的传动器的角度位态。
在一种扩展方案中，机器控制器基于与机器固定的参照物的额定参照物位置值和机器的轴位置值之间的反馈变换来确定所述额定轴位置值，第一和第二通道从机器控制器获取这些额定轴位置值并且这些额定轴位置值具有、特别是就是第二入口额定值。
由此，在一种实施方式中可以将参照物位置值的运算时间紧张的确定基于变换还要进一步地从安全性控制器转移至机器控制器中。这特别是能够实现还要更紧凑的安全性控制器。附加地，因此也可以对于该变换而言使用机器的存储在机器控制器中的模型、特别是如轴距和类似数据那样的运动学数据，然后该模型有利地同样不必再存储并实时地保留在安全性控制器中。在另一方面，对额定和实际轴位置值的双通道式的、以冗余方式的检验可以有利地确保所述机器的安全运行。在一种实施方式中，所述机器控制器实施的前馈变换和反馈变换不同，它们特别是可以基于不同的模型，以便因此来提升安全性。
在一种实施方式中，驱动器控制器确定在预设的额定轴位置值和检测到的实际轴位置值之间的所谓的被动错误(Schleppfehler)和/或其时间导数，并基于该被动错误、例如基于级联调节和/或P(I)D调节或类似调节来确定用于驱动器的调节参量。在一种实施方式中，被动错误表示额定值和相应的实际值之间的差：额定值＝实际值+被动错误。
根据本发明的一个方面，安全性控制器在比较额定值和实际值时考虑了这样的由驱动器控制器所确定的被动错误，因为在这样的被动错误的范畴中的偏差是系统固有的并由此不表明错误情况。由此有利地可以改进所述监视。
相应地在一种实施方式中，机器控制器基于在驱动器控制器中所确定的被动错误来确定第一和/或第二入口额定值，特别是通过如下方式，即，将所述被动错误从入口额定值减去，在安全性控制器获取所述入口额定值之前(安全性控制器获取的所述第一/第二入口额定值＝基于变换或控制程序所确定的入口额定值-被动错误)。类似地，在另一实施方式中，机器控制器基于在驱动器控制器中所确定的被动错误来确定第一和/或第二入口实际值，特别是通过如下方式，即，将所述被动错误加给所述入口实际值，在安全性控制器获取所述入口实际值之前(安全性控制器获取的所述第一/第二入口实际值＝基于变换所确定的或由检测器件所获取的入口实际值+被动错误)。
在另一种实施方式中，安全性控制器的第一和第二通道基于在驱动器控制器中所确定的被动错误，冗余地、特别是并行地和/或多样性冗余地确定第一和/或第二比较额定值，特别是通过如下方式，即，所述被动错误从获取的入口额定值减去(第一/第二比较额定值＝由机器控制器获取的入口额定值-被动错误)。类似地，在另一种实施方式中，安全性控制器的第一和第二通道基于在驱动器控制器中所确定的被动错误，冗余地、特别是并行地和/或多样性冗余地确定第一和/或第二比较实际值，特别是通过如下方式，即，所述被动错误加给被获取的入口实际值(第一/第二比较实际值＝由机器控制器或检测器件获取的入口实际值+被动错误)。
当第一和/或第二比较额定值或比较实际值具有参照物位置值或者说轴位置值的一阶或更高阶的时间导数时，在一种实施方式中所述机器控制器通过特别是数值的时间微分来确定相应的时间导数，其中，安全性控制器的第一和第二通道然后在一种扩展方案中附加或替代于参照物位置值或者说轴位置值本身从机器控制器中获取这些时间导数。由此有利地可以将其它的运算时间紧张的处理从安全性控制器转移至机器控制器中。
在另一种实施方式中，安全性控制器的第一和第二通道通过由机器控制器获取的参照物位置值或者说轴位置值的特别是数值的时间微分，冗余地、特别是并行地和/或多样性冗余地确定相应的时间导数。由此有利地可以进一步提升安全性。
在一种实施方式中，第一和第二通道从机器控制器获取相同的第一和/或第二入口额定值和/或相同的第一入口实际值。由此在一种实施方式中，在两个通道中冗余地、特别是多样性冗余地实施这些相同数据的一致性检验。由此有利地可以进一步提升安全性。
在一种实施方式中，第一和第二通道获取由一检测器件冗余地确定的第二入口实际值。在一种实施方式中，检测器件冗余地、特别是多样性冗余地确定、特别是检测第二入口实际值、特别是实际轴位置值。在一种扩展方案中，所述检测器件分别具有至少两个各样的、特别是不同的传感器，它们用于相同实际值的不同检测。附加地或替代地，检测器件也可以冗余地、特别是多样性冗余地处理相同或不同的实际值。由此有利地可以进一步提升安全性。
在一种实施方式中，检测器件和/或安全性控制器将那些冗余确定的第二入口实际值进行比较，并且如果这些不同地确定的第二入口实际值之间的偏差超过预设的允差，则触发错误反应。
在一种实施方式中，第一和第二通道冗余地、特别是并行地和/或多样性冗余地将比较额定值和/或比较实际值与特别是可变的、预设的边界值进行比较，并且如果比较值和边界值之间的偏差超过预设的允差，则分别触发一错误反应、特别是同一错误反应。
通过这种方式可以附加于额定和实际参照物位置值和/或轴位置值的一致性检验之外还实行一空间和/或轴监视。
在一种实施方式中，安全性控制器特别是循环地实施自测试并且如果自测试产生错误功能，则触发错误反应。由此可以进一步提升安全性。
在一种实施方式中，安全性控制器具有安全入口，这些安全入口用于获取外部的错误信号，例如紧急停止、确认键、运行方式选择开关或类似错误信号，并且如果所述安全性控制器获取到一外部的错误信号，则触发错误反应。在此，外部的错误信号也可以包括、特别是就是外部的无错误信号的消除。在一种扩展方案中，安全性控制器的多个入口特别是在逻辑上彼此结合，从而使得如果所述安全性控制器获取到以确定的组合存在的多个外部的错误信号，则所述安全性控制器触发错误反应。
错误反应特别可以包括输出特别是光学和/或声学的警告信号、机器移动至预设的姿势上、将驱动器与能量供应分开、和/或关闭制动器和类似错误反应。
根据本发明的一个方面，系统在硬件和/或软件技术上被设计用于实施在此描述的方法。
相应地，在一种实施方式中，第一通道具有用于将取决于由机器控制器获取的第一入口额定值的、特别是可以就是第一入口额定值的第一比较额定值与取决于由机器控制器获取的第一入口实际值的、特别是可以就是第一入口实际值的第一比较实际值彼此进行比较的器件，以及具有用于如果第一比较额定值和第一比较实际值之间的偏差超过预设的允差，则触发错误反应的器件，第二通道具有用于将取决于由机器控制器获取的特别是相同的第一入口额定值的、特别是以与在第一通道中相同的方式确定的、特别是可以就是第一入口额定值的第一比较额定值与取决于由机器控制器获取的特别是相同的第一入口实际值的、特别是以与在第一通道中相同的方式确定的、特别是可以就是第一入口实际值的第一比较实际值彼此进行比较的器件，以及具有用于如果在所述第一比较额定值和第一比较实际值之间的偏差超过预设的、特别是相同的允差，则触发错误反应、特别是同一错误反应的器件。
相应地在一种实施方式中，机器控制器具有用于基于与机器固定的参照物的参照物位置值和机器的轴位置值之间的变换来确定所述机器的与机器固定的参照物的额定和/或实际参照物位置值的器件，其中，第一入口额定和实际值具有这些参照物位置值和/或其一阶和/或更高阶的时间导数。
在一种实施方式中，第一通道具有用于将取决于特别是由机器控制器获取的第二入口额定值的、特别是可以就是第二入口额定值的第二比较额定值与取决于特别是由检测器件获取的第二入口实际值的、特别是可以就是第二入口实际值的第二比较实际值彼此进行比较的器件，以及具有用于如果第二比较额定值和第二比较实际值之间的偏差超过预设的允差，则触发错误反应的器件，第二通道具有用于将取决于特别是由机器控制器获取的特别是相同的第二入口额定值的、特别是以与在第一通道中相同的方式确定的、特别是可以就是第二入口额定值的第二比较额定值与取决于特别是由检测器件获取并由该检测器件以冗余方式确定的第二入口实际值的、特别是以与在第一通道中相同的方式确定的、特别是可以就是第二入口额定值的第二比较实际值彼此进行比较的器件，以及具有用于如果在所述第二比较额定值和第二比较实际值之间的偏差超过特别是相同的预设允差，则触发错误反应、特别是同一错误反应的器件。
相应地在一种实施方式中，机器控制器具有用于基于与机器固定的参照物的参照物位置值和机器的轴位置值之间的变换来确定第一和第二通道从机器控制器获取的机器额定轴位置值的器件，其中，第二入口额定和实际值具有这些轴位置值和/或其一阶和/或更高阶的时间导数。
在一种实施方式中，机器控制器具有用于基于在驱动器控制器中确定的被动错误来确定第一和/或第二入口额定和/或实际值的器件，在另一种实施方式中，第一和第二通道分别具有用于基于在驱动器控制器中确定的被动错误来确定第一和/或第二比较额定和/或实际值的器件。相应地，在一种实施方式中，驱动器控制器具有用于确定被动错误的器件。
附加地或替代地，在一种实施方式中，机器控制器具有用于通过时间微分来确定第一和/或第二入口额定和/或实际值的器件。附加地或替代地，在一种实施方式中，第一和第二通道分别具有用于通过时间微分来确定第一和/或第二比较额定和/或实际值的器件。
在一种实施方式中，系统具有检测器件，所述检测器件用于冗余地、特别是多样性冗余地确定第一和第二通道获取的第二入口实际值。
在一种实施方式中，第一和第二通道分别具有用于将第一和/或第二比较额定值和/或第一和/或第二比较实际值与特别是可变的、预设的边界值进行比较的器件，以及具有用于如果偏差超过预设的允差，则触发错误反应的器件。
在一种实施方式中，安全性控制器具有用于特别是循环地实施自测试并且如果该自测试产生错误功能则触发错误反应的器件。
在一种实施方式中，安全性控制器具有用于获取外部的错误信号的安全入口，以及具有用于如果该安全性控制器获取了外部的错误信号，则触发错误反应的器件。
本发明意义下的器件可以在硬件和/或软件技术上进行构造，特别是可以具有优选与存储和/或总线系统在数据或信号上连接的特别是数字式的处理单元、特别是微处理器单元(CPU)和/或具有一个或多个程序或程序模块。CPU可以被构造用于：完成作为存储在存储系统中的程序所实行的指令；由数据总线检测入口信号；和/或将输出信号输出到数据总线上。存储系统可以具有一个或多个特别是各样的存储介质，特别是光学的、磁性的、固体的和/或其他非易失性的介质。程序可以以如下方式提供，即，其能够体现或实施在此描述的方法，从而使得CPU能够实施这样的方法的步骤进而尤其能够运行所述机器。
附图说明
其他的优点和特征由实施例给出。为此，部分示意性地示出：
图1是根据本发明的一种实施方式的设施的系统；以及
图2是根据本发明的一种实施方式的方法。
附图标记列表如下：
10 机器控制器
11、12 机器控制器的器件
13A、
13B 驱动器调节器
21、22 解析器
23 驱动器
31、32 解析器
33 驱动器
100 第一通道
111、
112 第一通道的器件
200 第二通道
211、
212 第二通道的器件
具体实施方式
图1示出了一设施，其具有机器人和根据本发明的一种实施方式、用于运行该机器人的系统，所述机器人在图1中代表性仅简示出两个驱动器23、33，图2示出了根据本发明的一种实施方式的用于运行该机器人的方法，该方法通过为此在软件和硬件技术上设计的系统来实施。
所述系统具有机器控制器10，其具有驱动器调节器13A、13B，所述驱动器调节器控制所述驱动器23、33。
所述系统还具有安全性控制器，其具有第一通道100和对其冗余的、特别是多样性冗余的第二通道200，这些通道监视机器人。
在第一步骤S10(参见图2)中，机器控制器10的器件11基于一预设的控制程序，特别是借助轨迹规划和/或内插法确定用于机器人的TCP的额定参照物位置值x。
由这些用于TCP的额定参照物位置值x，机器控制器10的器件12基于TCP的参照物位置值和轴位置值之间的反馈变换确定额定轴位置值q，所述反馈变换如在图1中通过数据流11-x→12简示出的那样。
替代地，在步骤S10中，器件11也可以基于TCP的参照物位置值和预设的额定轴位置值q之间的前馈变换来确定用于TCP的额定参照物位置值x，所述额定轴位置值例如通过手动地移动所述机器人的轴来预设，所述前馈变换如在图1中通过数据流12-q→11简示出的那样。
第一和第二通道100、200获取用于TCP的额定参照物位置值x作为第一入口额定值xs，以及获取额定轴位置值q作为第二入口额定值qs。在一种实施方式中，附加地或替代地，第一入口额定值xs也可以包括额定参照物位置值x的一阶和/或更高阶的时间导数。附加地或替代地，第二入口额定值qs附加地或替代地也可以包括额定轴位置值q的一阶和/或更高阶的时间导数。
附加地，驱动器调节器13A、13B从器件12获取额定轴位置值q的相应的分量。
在该实施例中，检测器件示例性地对于每个驱动器22、23具有各两个解析器21、22或31、32。
第一解析器21确定用于驱动器23的实际轴位置的实际轴位置值q21。第二解析器22以冗余方式确定用于驱动器23的实际轴位置的实际轴位置值q22。第三解析器31确定用于驱动器33的实际轴位置的实际轴位置值q31。第四解析器32确定用于驱动器33的实际轴位置的实际轴位置值q32。
第一通道100获取实际轴位置值q21、q31，第二通道200获取以冗余方式确定的实际轴位置值q22、q32作为第二入口实际值。在一种实施方式中，附加地或替代地，所述第二入口实际值还可以包括实际轴位置值的一阶和/或更高阶的时间导数。
同样地，驱动器调节器13A、13B分别获取这些实际轴位置值q21或q22或者说q31或q32中的一个实际轴位置值，并从中确定这些额定和实际轴位置值之间的被动错误Δ。所述驱动器调节器基于这些被动错误来调节所述驱动器23、33。
第一和第二通道100、200获取这些由驱动器调节器13A、13B所确定的被动错误Δ。
器件11分别获取这些实际轴位置值q21、q31中的一个实际轴位置值和所述被动错误Δ。
基于在与机器固定的参照物的参照物位置值和轴位置值之间的前馈变换，器件11确定第一入口实际值xi。在此，该器件基于被动错误△来确定所述入口实际值xi，其方式是，该器件不是使所确定的实际轴位置值q21、q31自身进行前馈变换，而是给这些实际轴位置值事先分别加上所述被动错误Δ的相应分量并将该和进行前馈变换(xi＝T·{[q21,q31,...]+△}，T是前馈变换矩阵)。
第一和第二通道100、200分别获取这些第一入口实际值xi。在一种实施方式中，第一入口实际值xi附加地或替代地也可以包括实际参照物位置值x的一阶和/或更高阶的时间导数。
因此，在步骤S10中，第一和第二通道100、200分别获取：
-第一入口额定值xs，
-第二入口额定值qs，
-第一入口实际值xi，和
-第二入口实际值q21、q31或q22、q32，以及
-被动错误△。
在步骤S20中，第一通道100的器件111将取决于第一入口额定值的第一比较额定值与取决于第一入口实际值的第一比较实际值彼此进行比较。在该实施例中，第一比较额定值与第一入口额定值xs相应并且第一比较实际值与第一入口实际值xi相应。在一种变形中，器件111附加地或替代地可以通过时间微分来确定第一比较额定值和第一比较实际值，特别是当由机器控制器10的器件11所获取的第一入口额定值或第一入口实际值不包含相应的时间导数时。
如果第一比较额定值和第一比较实际值之间的偏差超过预设的允差(S20：“Y”)，则安全性控制器的第一通道100的器件111触发错误反应，这在图1中通过中断所述驱动器23、33的粗线条示出的能量供应来简示。
对其冗余地，第二通道200的器件211将以与第一通道中相同的方式取决于相同的第一入口额定值的第一比较额定值与以与第一通道中相同的方式取决于相同的第一入口实际值的第一比较实际值彼此进行比较。因此在该实施例中，第二通道的所述第一比较额定值也与第一入口额定值xs相应并且第二通道的所述第一比较实际值与第一入口实际值xi相应。在一种变形中同样相应地，器件211可以附加地或替代地通过时间微分来确定第一比较额定值和第一比较实际值，特别是当由机器控制器10的器件11所获取的第一入口额定值或第一入口实际值不包含相应的时间导数时。
如果第二通道200的所述第一比较额定值和第一比较实际值之间的偏差超过相同的预设允差(S20：“Y”)，则安全性控制器的第二通道200的器件211触发同一错误反应，这在图1中类似地通过中断所述驱动器23、33的能量供应来简示。
在步骤S30中，第一通道100的器件112将取决于第二入口额定值qs的第二比较额定值与取决于第二入口实际值q21、q31的第二比较实际值彼此进行比较。在该实施例中，第二比较额定值与第二入口额定值qs相应，而第二比较实际值基于第二入口实际值q21、q31和被动错误△通过将它们相加来确定。在一种变形中，器件112可以附加地或替代地通过时间微分来确定第二比较额定值和第二比较实际值，特别是当由机器控制器10的器件12所获取的第二入口额定值或第二入口实际值不包含相应的时间导数时。
如果第二比较额定值和第二比较实际值之间的偏差超过预设的允差(S30：“Y”)，则安全性控制器的第一通道100的器件112触发同一错误反应，这在图1中类似地通过中断所述能量供应来简示。
对其冗余地，第二通道200的器件212将以与第一通道中相同的方式取决于相同的第二入口额定值qs的第二比较额定值与以与第一通道中相同的方式取决于冗余确定的第二入口实际值q22、q32的第二比较实际值彼此进行比较。因此在该实施例中，第二通道的所述第二比较额定值也与第二入口额定值qs相应，而第二通道的所述第二比较实际值基于第二入口实际值q22、q32和被动错误Δ通过将它们相加来确定。在一种变形中，器件212可以附加地或替代地通过时间微分来确定第二比较额定值和第二比较实际值，特别是当由机器控制器10的器件12获取的第二入口额定值或第二入口实际值不包含相应的时间导数时。
如果所述第二比较额定值和第二比较实际值之间的偏差超过预设的允差(S30：“Y”)，则安全性控制器的第二通道200的器件212触发同一错误反应，这在图1中类似地通过中断所述能量供应来简示。
在步骤S40中，第一和第二通道100、200分别将比较额定值和/或比较实际值与特别是可变的、预设的边界值X0进行比较，并且如果这些比较值和边界值之间的偏差超过预设的允差(S40：“Y”)，则触发同一或另一错误反应。
为此示例性地在图1中简示出，第一和第二通道100、200的器件111、211例如预设地获得允许的笛卡尔工作空间X0，并且将与所述由器件11所获取的实际参照物位置值xi相应的比较实际值与该工作空间进行比较，并由此在TCP从该预设的工作空间离开时触发错误反应，例如使机器人驶入安全的姿态(图2：“SAFE”)或类似的错误反应。
尽管在前面的描述中说明了示例性的实施方式，但应指出，可以进行多种变形。此外还应指出，示例性的实施方式仅仅是示例，其不应以任何方式限制保护范围、应用和结构。更确切地说，本领域技术人员通过前面的描述就至少一个示例性实施方式的变换得到启示，其中，可以特别是关于所描述的组件的功能和布置进行各种改变，而不背离就像其在权利要求书和所述那些等效的特征组合中给出那样的保护范围。

Claims (12)

1.一种用于运行多轴机器、特别是机器人的方法，其中，
机器控制器(10)控制所述机器的驱动器(23、33)；并且
安全性控制器监视所述机器，所述安全性控制器具有第一通道和对其冗余的、特别是多样性冗余的第二通道(100、200)；其中，
所述第一通道
从所述机器控制器获取(S10)第一入口额定值(xs)和第一入口实际值(xi)；
将取决于所述第一入口额定值的第一比较额定值与取决于所述第一入口实际值的第一比较实际值彼此进行比较(S20)；并且如果所述第一比较额定值和第一比较实际值之间的偏差超过预设的允差，则触发错误反应(STOP)；以及
所述第二通道
从所述机器控制器获取(S10)第一入口额定值(xs)和第一入口实际值(xi)；
将取决于所述第一入口额定值的第一比较额定值与取决于所述第一入口实际值的第一比较实际值彼此进行比较(S20)；并且如果所述第一比较额定值和第一比较实际值之间的偏差超过预设的允差，则触发错误反应(STOP)；
其中，
所述第一入口额定值和第一入口实际值具有所述机器的与机器固定的参照物的参照物位置值(x)和/或具有所述参照物位置值的一阶和/或更高阶的时间导数，并且所述机器控制器基于所述与所述机器固定的参照物的参照物位置值和所述机器的轴位置值之间的变换来确定所述额定参照物位置值和/或实际参照物位置值。
2.根据权利要求1所述的方法，其特征在于，
所述第一通道
获取(S10)第二入口额定值(qs)和第二入口实际值(q21、q31)；
将取决于所述第二入口额定值的第二比较额定值与取决于所述第二入口实际值的第二比较实际值彼此进行比较(S30)；并且如果所述第二比较额定值和第二比较实际值之间的偏差超过预设的允差，则触发错误反应(STOP)；以及
所述第二通道
获取第二入口额定值(qs)和第二入口实际值(q22、q32)；
将取决于所述第二入口额定值的第二比较额定值与取决于所述第二入口实际值的第二比较实际值彼此进行比较(S30)；并且如果所述第二比较额定值和第二比较实际值之间的偏差超过预设的允差，则触发错误反应(STOP)；
其中，
所述第二入口额定值和第二入口实际值具有所述机器的轴位置值(q)和/或具有所述轴位置值的一阶和/或更高阶的时间导数。
3.根据前述权利要求中任一项所述的方法，其特征在于，所述机器控制器基于所述与机器固定的参照物的参照物位置值和所述机器的轴位置值之间的变换来确定额定轴位置值(qs)，所述第一通道和所述第二通道由所述机器控制器获取所述额定轴位置值。
4.根据前述权利要求中任一项所述的方法，其特征在于，基于在驱动器控制器中确定的被动错误(Δ)和/或通过时间微分来确定入口和/或比较额定值和/或实际值。
5.根据前述权利要求中任一项所述的方法，其特征在于，所述第一通道和所述第二通道从所述机器控制器获取相同的第一入口额定值和/或第二入口额定值和/或第一入口实际值。
6.根据前述权利要求中任一项所述的方法，其特征在于，所述第一通道和第二通道从一检测器件(21、22、31、32)获取以冗余方式确定的第二入口实际值(q21、q22、q31、q32)。
7.根据前述权利要求中任一项所述的方法，其特征在于，所述第一通道和第二通道分别将比较额定值和/或比较实际值与特别是可变的、预设的边界值(X0)进行比较(S40)，并且如果偏差超过预设的允差，则触发错误反应(SAFE)。
8.根据前述权利要求中任一项所述的方法，其特征在于，所述安全性控制器特别是循环地实施自测试，并且如果所述自测试产生错误功能，则触发错误反应。
9.根据前述权利要求中任一项所述的方法，其特征在于，如果所述安全性控制器获取了外部的错误信号，则所述安全性控制器触发错误反应。
10.一种用于运行多轴机器、特别是机器人的系统，所述系统具有
机器控制器(10)，其用于控制所述机器的驱动器(23、33)；
和
安全性控制器，其用于监视所述机器，所述安全性控制器具有第一通道和对其冗余的、特别是多样性冗余的第二通道(100、200)，其中，所述系统被设计为用于实施根据前述权利要求中任一项所述的方法。
11.一种具有机器人和用于运行该机器人的根据前一权利要求所述的系统的设施。
12.一种具有程序编码的计算机程序产品，所述程序编码存储在计算机可读的介质上，所述计算机程序产品用于实施根据前述权利要求中任一项所述的方法。
CN201610081318.6A 2015-02-11 2016-02-05 用于运行多轴机器、特别是机器人的方法和系统 Active CN105856225B (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
DE102015001741.1A DE102015001741A1 (de) 2015-02-11 2015-02-11 Verfahren und System zum Betreiben einer mehrachsigen Maschine, insbesondere eines Roboters
DE102015001741.1 2015-02-11

Publications (2)

Publication Number Publication Date
CN105856225A true CN105856225A (zh) 2016-08-17
CN105856225B CN105856225B (zh) 2019-06-14

Family

ID=54707502

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610081318.6A Active CN105856225B (zh) 2015-02-11 2016-02-05 用于运行多轴机器、特别是机器人的方法和系统

Country Status (5)

Country Link
US (1) US10935955B2 (zh)
EP (1) EP3056322B1 (zh)
KR (1) KR102037565B1 (zh)
CN (1) CN105856225B (zh)
DE (1) DE102015001741A1 (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112585861A (zh) * 2018-08-22 2021-03-30 西门子股份公司 具有多个驱动器的机器的优化运行

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102015001741A1 (de) 2015-02-11 2016-08-11 Kuka Roboter Gmbh Verfahren und System zum Betreiben einer mehrachsigen Maschine, insbesondere eines Roboters
JP7296593B2 (ja) * 2018-05-16 2023-06-23 パナソニックＩｐマネジメント株式会社 エンコーダの異常検出方法、作動制御装置、ロボット及びロボットシステム
US20200069357A1 (en) * 2018-09-05 2020-03-05 Applied Medical Resources Corporation Electrosurgical generator verification system
WO2020233777A1 (en) * 2019-05-17 2020-11-26 Telefonaktiebolaget Lm Ericsson (Publ) Technique for parameter conversion between a robotic device and a controller for the robotic device
DE102019117972B4 (de) * 2019-07-03 2023-05-25 Kriwan Industrie-Elektronik Gmbh Verfahren und Vorrichtung zur Überwachung einer Anlage
CN110666797B (zh) * 2019-09-30 2023-01-06 东莞市李群自动化技术有限公司 一种机器人控制系统及方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0742505A2 (de) * 1995-05-11 1996-11-13 Siemens Aktiengesellschaft Einrichtung zum sicherheitsgerichteten Überwachen einer Maschine
US20070140821A1 (en) * 2005-12-19 2007-06-21 Betzalel Robotics, Llc Autonomous load/unload robot
JP2008188694A (ja) * 2007-02-02 2008-08-21 Jtekt Corp ロボット安全監視装置及びロボット駆動制御システム
US20100234996A1 (en) * 2007-10-20 2010-09-16 Kuka Roboter Gmbh Manipulator, Particularly Industrial Robot, Having A Redundant Sensor Arrangement, And Method For The Control Thereof
CN102666033A (zh) * 2009-10-21 2012-09-12 日本电产三协株式会社 机器人系统
US20130030570A1 (en) * 2011-07-25 2013-01-31 Sony Corporation Robot device, method of controlling the same, computer program, and robot system

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE602009000644D1 (de) * 2009-02-27 2011-03-03 Honda Res Inst Europe Gmbh Roboter mit automatischer Auswahl von aufgabenspezifischen Darstellungen zur Imitationserlernung
DE102010004474A1 (de) * 2010-01-13 2011-07-14 KUKA Laboratories GmbH, 86165 Steuerung für einen Manipulator
DE102010010717A1 (de) * 2010-03-09 2011-09-15 Kuka Laboratories Gmbh Winkelmessvorrichtung und Roboter
DE102011003539A1 (de) * 2011-02-02 2012-08-02 Kuka Roboter Gmbh Verfahren zum Referenzieren einer Antriebsstellung wenigstens eines elektrischen Antriebs
DE102012011108A1 (de) * 2012-06-05 2013-12-19 Kuka Roboter Gmbh Verfahren und Vorrichtung zum Steuern einer Manipulatoranordnung
DE102015001741A1 (de) 2015-02-11 2016-08-11 Kuka Roboter Gmbh Verfahren und System zum Betreiben einer mehrachsigen Maschine, insbesondere eines Roboters

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0742505A2 (de) * 1995-05-11 1996-11-13 Siemens Aktiengesellschaft Einrichtung zum sicherheitsgerichteten Überwachen einer Maschine
EP0742499A2 (de) * 1995-05-11 1996-11-13 Siemens Aktiengesellschaft Sicheres Verarbeiten von sicherheitsgerichteten Prozesssignalen
US20070140821A1 (en) * 2005-12-19 2007-06-21 Betzalel Robotics, Llc Autonomous load/unload robot
JP2008188694A (ja) * 2007-02-02 2008-08-21 Jtekt Corp ロボット安全監視装置及びロボット駆動制御システム
US20100234996A1 (en) * 2007-10-20 2010-09-16 Kuka Roboter Gmbh Manipulator, Particularly Industrial Robot, Having A Redundant Sensor Arrangement, And Method For The Control Thereof
CN102666033A (zh) * 2009-10-21 2012-09-12 日本电产三协株式会社 机器人系统
US20130030570A1 (en) * 2011-07-25 2013-01-31 Sony Corporation Robot device, method of controlling the same, computer program, and robot system

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112585861A (zh) * 2018-08-22 2021-03-30 西门子股份公司 具有多个驱动器的机器的优化运行
CN112585861B (zh) * 2018-08-22 2024-01-16 西门子股份公司 机器的运行方法、存储介质、控制装置和机器

Also Published As

Publication number Publication date
CN105856225B (zh) 2019-06-14
US20160231728A1 (en) 2016-08-11
EP3056322B1 (de) 2018-09-19
DE102015001741A1 (de) 2016-08-11
EP3056322A1 (de) 2016-08-17
KR102037565B1 (ko) 2019-10-28
KR20160098970A (ko) 2016-08-19
US10935955B2 (en) 2021-03-02

Similar Documents

Publication Publication Date Title
CN105856225A (zh) 用于运行多轴机器、特别是机器人的方法和系统
CN102681483B (zh) 一种自动补偿温度形变和刀具形偏的坐标系系统
DE102007050232A1 (de) Handhabungsroboter und Verfahren zur Steuerung eines Handhabungsroboters
CN105643621B (zh) 用于使机器人设备运行的方法和机器人设备
US10386811B2 (en) Numerical controller
US20180126554A1 (en) Method for motion simulation of a manipulator
US20160008979A1 (en) Method for checking a robot path
JP2012524352A (ja) 安全関連制御ユニット用アプリケーションプログラムの生成方法および装置
CN104669264B (zh) 用于机器人的故障处理的方法和装置
CN108772835B (zh) 一种障碍物与物理极限躲避方法
WO2018041476A1 (de) Verfahren und system zum rechnergestützten optimieren eines numerisch gesteuerten bearbeitungsprozesses eines werkstücks
Goodarzi et al. Global formulation of an extended Kalman filter on SE (3) for geometric control of a quadrotor UAV
JPS60205718A (ja) 制御軌道の監視方法
DE102013016019B3 (de) Verfahren zum Betreiben eines mehrgliedrigen Manipulators
Alwi et al. Real-time implementation of an ISM fault-tolerant control scheme for LPV plants
DE102015009892A1 (de) Verfahren und System zum Steuern eines Roboters
Osuský et al. Trajectory tracking robust control for two wheels robot
CN107000759B (zh) 车辆控制装置和方法
JPS6044293A (ja) 産業用ロボットの制御装置
US20220288773A1 (en) Safe operation of a multi-axis kinematic system
Laible et al. A fail-safe dual channel robot control for surgery applications
WO2019057490A1 (de) Verfahren zum lokalisieren eines mobilen roboters
JP2009538744A (ja) 旋削加工を制御する方法、および旋削加工に適したｎｃ機械
EP4000815A1 (de) Visualisieren eines schutzfeldes
CN106406317A (zh) 一种三坐标平移机构的控制方法及装置

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant