一种根据本发明专利技术的用于控制机械手，特别是机器人（１０）的方法，通过轨迹产生装置（１．１，１．２，１．３）预先给出机械手的预定轨迹（ｚ１（ｔ）），通过轨迹转换设备（２）基于预定轨迹自动确定控制轨迹（ｚ２（ｔ）），以及通过机械手控制器（３）利用机械手起始控制轨迹，在此轨迹转换设备（２）基于预定轨迹的曲率信息（ａｉｊ；ｔ１（ｔｉ））确定控制轨迹的曲率信息（ａｉｊ；ｔ２（ｔｉ））。
【技术实现步骤摘要】
本专利技术涉及一种用于控制机械手，特别是机器人，的方法和装置，在此机械手的预 定轨迹通过轨迹发生装置而预先给出，基于预定轨迹的控制轨迹通过轨迹转换设备而自动 确定和控制轨迹利用机械手通过机械手的控制器而起始(abgefahren)。
技术介绍
迄今为止，机械手，例如机器人，的运动通常通过姿势的序列而预先给出。在此单 个的姿势例如起动和由此“训练了的(geteacht) ”，或在计算机程序中离线通过用于参考坐 标系的坐标如工具中心点(TCP)或通过运动轴定义。然后机械手相继作出该姿势。在此机械手控制器在姿势之间插入例如线性或弓形控制轨迹。为了形成平滑的控 制轨迹，除了已知的叠加(Uberschleifenden)线性插值或圆形插值外，还可通过样条插值 (即函数，在基点之间分段定义)得到连续的姿势。EP 1 117 020 Bl提出，只有在基点处没有尖角时才通过样条-线段 (Spline-Abschnitte)插值。由US 2007/0030271A1获知的是，机器人控制器在考虑基点 处正切矢量的长度和角度下确定样条，以避免封闭叠加(geschlossene Schleifen)。US 7，295，891B2提出了相同的目标，位置、方向和附加轴彼此离散地参数化。由DE 102006 022 483 Al获知，由基点处轨迹切线以及垂直于轨迹切线的方向箭头指示。通过基点沿着 轨迹切线或其方向箭头移动而实现基点的移动。EP 0 312544 Bl说明了一种有效地计算用 于机器人臂的单个轴的样条的中间值的方法。例如，当存在待由机器人加工的零件的CAD模型时，所期望的笛卡尔轨迹已经以 函数形式，特别是样条或贝塞尔曲线，形成在离散姿势位置处。然而现在的机械手控制器不 允许这样的预定轨迹直接作为控制轨迹应用。换而言之，预定轨迹首先在基点处离散，并且 机械手控制器作为预期姿势预先给出，然后在它的一侧进行插值并开始形成控制轨迹。自 然地当机械手控制器通过样条对预期姿势进行插值时，不能保证所形成的轨迹以此再次产 生初始样条。如图1所示，在基点Z1,. . . . 26中通过二个不同的样条Zl(t)，z2(t)进行插值， 其在基点处是其本身值和一阶导数，通过切线tl(t)，t2(t)描述，根据用于次序插值的样 条的度和自由度显示。从而假如例如CAD工具产生预定轨迹zl (t)，那么其在基点Zl，...， Z6离散，机械手控制器以不期望方式对预定轨迹zl (t)进行插值，从而得到不规则的控制轨 迹 z2(t)。
技术实现思路
本专利技术的目的是，提供一种改善的用于控制机械手的方法。该目的通过具有权利要求1的特征部分的方法实现。权利要求14提供了一种装 置，权利要求15或16提供了一种计算机程序或计算机程序产品，特别是存储介质或数据载 体，用于实施根据权利要求1所保护的方法。从属权利要求涉及有利的改进。基于该思想，本专利技术在确定控制轨迹的曲率信息时考虑预定轨迹的附加曲率信息。而迄今为止，如与图1有关的上文中所描述的那样，在确定控制轨迹z2(t)时，不考 虑曲率信息，预定轨迹zl (t)在基点Z1, .... Z6离散，然后插值，和控制轨迹z2 (t)在基点 Z1, ....Z6之间趋向部分地巨大地偏离预定轨迹zl (t)，本专利技术使得领先于预定轨迹的精确 起始成为可能。在此首先通过轨迹产生装置预先给出机械手的预定轨迹。轨迹产生装置可例如包 括CAD( “计算机辅助设计”)工具、轨迹优化器和/或一个用于预先给出轨迹的基点、轨迹 处的切线的(特别是图形的)输入装置或类似装置。特别地，存在称为笛卡尔轨迹的参数函数，其函数值说明了诸如TCP的机械手的 参照系的位置和/或方向。假如例如TCP的位置或机械手的其他的参考坐标原点通过三个 坐标(X，y，ζ)描述，即在基本坐标系中相对于基本坐标体系的距离，它的方向通过四元数 q0+i X Qi+j X q2+k X q3描述，S卩，相对于基本坐标体系的参考坐标的三个欧拉角或三个万向 角(α，β，Y)，因此笛卡尔轨迹可以用轨迹参数t(特别是运行时间)表示，参数化为z(t) = T(l)这个函数例如可以是分段的，特别是基点zl = ζ (tl) ,z2 = z (t2)之间所定义的函数，特别是g次的多项式函数， g 即所谓的样条。g = 3的样条为立方样条，g > 3的样条相应地称作高次样条。预定 轨迹和/或控制轨迹也可预先给出或确定为B-样条，例如在Carl de Boor的“A practical guide to splines”，Springer Verlag，1978(《样条实用指南》，施普林格出版社，1978)中 所描述的那样。其优点是系数的改变只是局部的，也即不在所有基点之间起作用。轨迹转换设备基于预定轨迹自动确定控制轨迹，然后以已知的方式通过具有机械 手的机械手控制器开始，例如，通过机械手控制器对控制轨迹采样，并且所采集的点在考虑 预先给出的例如速度梯形轮廓的速度或加速度轮廓下起始。由此，只要预定轨迹在基点是分散的，并且只通过控制轨迹插值，根据本专利技术的控 制轨迹的曲率信息基于预定轨迹的曲率信息确定。在本专利技术的意义中，曲率信息可特别包括针对某轨迹参数对预定轨迹和/或控制 轨迹进行一阶和/或更高阶微分。笛卡尔轨迹以参数函数的形式给出，则基于针对轨迹参 数tl，对预定轨迹进行一阶和/或更高阶微分 由 1(,1) d2z\{t\)⑷ dt\ ‘ dt\2 ""确定针对轨迹参数t2，对控制轨迹进行的一阶和/或更高阶微分 dz2{t2) dh2{t2) dtl ‘ dtl2 "“其中，tl和t2可以是相同的。同样地，在本专利技术的意义中，曲率信息包括轨迹的正切方向和/或其变型。(5)dt描述了基点Z1 = z(t,)处的正切矢量和5(6) dt dt2或法线矢量和副法线矢量，即其变型，则可根据预定轨迹的正切方向及其变型确 定控制轨迹的正切方向及其变型。轨迹的正切方向和/或其变型可以有利地在轨迹的基点Zi的局部坐标系中定义。同样地，在本专利技术的意义中，曲率信息可以包括多项式系数，特别是一次或更高次 的多项式系数。从(2)在(3)至(6)的使用显示出特别是微分和正切(变型)也可通过多 项式，例如样条的多项式系~等价地描述。同样地，轨迹可预先给出或确定为贝塞尔曲线。则曲率信息可包括所谓的控制点。在优选实施方式中，在选择优选的线段方式，特别是在基点之间，在考虑预定轨迹 的曲率信息的情况下确定和仅仅基于基点，例如线性或圆形插值或任意样条插值，的情况 下确定之间时，轨迹转换设备根据预定轨迹的曲率信息选择地或随意地确定控制轨迹的曲 率信息。以这种方式，特别是线段方式，可强取预定轨迹的精确起始点，在此需要的是，在其 他的部分中可利用常规的、快速的工具产生控制轨迹。优选地，控制轨迹在预先给出的相对于预定轨迹的最大偏离下进行近似。例如控 制轨迹的基点数量可相对于预定轨迹的基点数量改变，特别是减少。因为具有较少基点的 控制轨迹在使用上述插值方法时通常不能精确地复制预定轨迹，为了减少基点，可允许偏 离直至预先给出的最大偏离。在优选的实施方式中，已经预定的轨迹或控制轨迹在二个现有的基点之间补充至 少一个基点，而没有实本文档来自技高网...
【技术保护点】
一种用于控制机械手，特别是机器人（１０），的方法，其具有下列步骤：通过轨迹产生装置（１．１，１．２，１．３）预先给出机械手的预定轨迹（ｚ１（ｔ））；通过轨迹转换设备（２）基于预定轨迹自动确定控制轨迹（ｚ２（ｔ））；和通过机械手控制器（３）利用机械手而使控制轨迹起始，其特征在于，所述轨迹转换设备（２）基于预定轨迹的曲率信息（ａ↓［ｉｊ］；ｔ１（ｔ↓［ｉ］））确定控制轨迹的曲率信息（ａ↓［ｉｊ］；ｔ↓［２］（ｔ↓［ｉ］））。
【技术特征摘要】
...
【专利技术属性】
技术研发人员：马丁怀斯，克里斯汀逊勒，
申请(专利权)人：库卡机器人有限公司，
类型：发明
国别省市：DE
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。