专利名称：用于控制机械手的方法及装置的制作方法
技术领域：
本发明涉及一种用于控制机械手，特别是机器人，的方法和装置，在此机械手的预 定轨迹通过轨迹发生装置而预先给出，基于预定轨迹的控制轨迹通过轨迹转换设备而自动 确定和控制轨迹利用机械手通过机械手的控制器而起始(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) = [x(t), y(t), z(t), α ⑴，β (t)，Y (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)的使用显示出特别是微分和正切(变型)也可通过多 项式，例如样条的多项式系~等价地描述。同样地，轨迹可预先给出或确定为贝塞尔曲线。则曲率信息可包括所谓的控制点。在优选实施方式中，在选择优选的线段方式，特别是在基点之间，在考虑预定轨迹 的曲率信息的情况下确定和仅仅基于基点，例如线性或圆形插值或任意样条插值，的情况 下确定之间时，轨迹转换设备根据预定轨迹的曲率信息选择地或随意地确定控制轨迹的曲 率信息。以这种方式，特别是线段方式，可强取预定轨迹的精确起始点，在此需要的是，在其 他的部分中可利用常规的、快速的工具产生控制轨迹。优选地，控制轨迹在预先给出的相对于预定轨迹的最大偏离下进行近似。例如控 制轨迹的基点数量可相对于预定轨迹的基点数量改变，特别是减少。因为具有较少基点的 控制轨迹在使用上述插值方法时通常不能精确地复制预定轨迹，为了减少基点，可允许偏 离直至预先给出的最大偏离。在优选的实施方式中，已经预定的轨迹或控制轨迹在二个现有的基点之间补充至 少一个基点，而没有实质性地改变控制轨迹。假如例如应用B样条，这样的改变只是局部性 地起作用。后来补充到预定轨迹或控制轨迹中的基点例如可以是开关点，例如用于激活工 具或使工具无效。通过考虑曲率信息，从而阻止了预定轨迹和控制轨迹之间的偏离，后来的 附加基点的插入也不导致预定轨迹和控制轨迹之间的偏离。如上所述，预定轨迹和/或控制轨迹可说明诸如TCP的机械手参照系的位置和/ 或方向。在此位置和方向例如可各以样条或其他的曲线描述的形式离散地给出，例如以 用于位置的三个笛卡尔坐标X，1，Z的三维样条和另一个用于四元数，优选为标准四元数 Cl2Jq2Jq2^q23= 1，方向的欧拉角或万向角的三维样条。同样地，位置和方向例如以高维样 条一起给出，例如由三个位置坐标和三个方向坐标，DENAVIT-HARTENBERG坐标等构成的矢 量。预定轨迹和/或控制轨迹也可包括一个或多个冗余机械手的附加轴。对于笛卡尔位置 和方向坐标所表示的位置，预定轨迹和/或控制轨迹也可称为参数化函数，它的函数值给 出机械手的关节坐标，特别是关节角度Qi。
其他的优点和特征由从属权利要求书和实施例给出。在此部分地示意性地示出图1 根据现有技术的经预定的和控制轨迹的部分视图；和图2 根据本发明的实施方式用于控制机器人的装置。图例说明表1.1 CAD 工具1.2轨迹优化器
6
1. 3图形输入装置2轨迹转换设备3机械手控制器10机器人ζ (t)轨迹zl (t) 预定轨迹z2 (t) 控制轨迹ζ Ui)基点t (、) 正切矢量
具体实施例方式图1示出了预定轨迹zl (t)的部分视图，例如由CAD工具预先给出。根据现有离散 技术，诸如立方样条的轨迹转换设备根据(2)在基点Z1, ...，Z6预先给出预定轨迹zl (t)。 因为没有考虑曲率数据，特别是预定轨迹zl (t)在基点Z1,...，Z6处的切线tl (t》，机械手 控制器同样以立方样条z2(t)形式对控制轨迹进行插值，尽管显示为相同的基点Zl，. . . ,Z6 但如图1所示，其基点间的趋势与预定轨迹zl(t))的不同。不利的是，机械手控制器根据 现有技术也不沿预定轨迹zl (t)，而是在此明显地沿不规则的控制轨迹z2(t)起始运行。图2示出了根据本发明的实施方式的用于实施控制机器人10的方法的一种装置。形式为CAD工具1. 1、轨迹优化器1. 2或图形输入装置1. 3的轨迹产生装置根据预 先给出的、许可的点和图形的切线，预先设定机器人10的TCP的预定轨迹Zl (t)，例如，如图 2所示，通过预先给出基点Ziai)及此处的切线tl(ti)。在未图示的变型中，预定轨迹的轨 迹产生装置也通过预先给出的样条的多项式系数或贝塞尔曲线的控制点而预先设定。轨迹转换设备2基于预定的轨迹zl (t)自动确定控制轨迹z2(t)。在此其不只是 确定它的基点z2 (、)，而且还确定曲率信息，例如如图2中所示，样条的多项式系数或在 未图示的变型中的基点Ζ2(、)的切线t2(ti)或贝塞尔曲线的控制点。这种曲率信息由预 定轨迹的曲率信息，例如基点Ziai)的切线Uai)决定，其与基点Ziai) —起由轨迹产生 装置输出。对于样条或贝塞尔曲线，可通过基点及基点处的切线进行等价转换。在未图示的变型中，轨迹转换设备2减少控制轨迹的基点Ζ2(、)的数量，以减少 计算费用。因为这样的控制轨迹通常不能准确地描绘预定轨迹，在轨迹转换设备中预先给 出最大距离从而确定控制轨迹，即它对于预定轨迹的距离不超过这个最大距离。如果预定 轨迹与控制轨迹不能相互表示，也可实施或者可能需要更高的计算费用。在另一个未图示的变型中，在确定控制轨迹之前在预定轨迹的二个基点Ζ1(、)， zl (ti+1)之间插入另一个点，例如用于激活机器人10的工具的开关点。附加地或替代地，已 经确定的控制轨迹也可在二个基点Ζ2(、)，z2(t1+1)之间补充其他的点。因为在根据预定 轨迹确定控制轨迹时也考虑曲率信息，从而允许或禁止预定轨迹与控制轨迹之间的偏差， 有利地，插入一个或多个其他的点不会导致控制轨迹的改变。在另一未图示的变型中，控制轨迹只是线段式的，例如在预定轨迹的基点zl(t2) 和ζια5)之间在考虑曲率信息的情况下确定，而在线段[t1;t2]和[t5，t6]中通过线性插值 确定。
机械手控制器3沿机器人10的TCP的控制轨迹运行，根据控制轨迹z2 (t)确定六 个关节坐标^至q6的预期增量Δ q，进而相应地控制机器人10的触发或调整。与上述相 关地，预定轨迹和控制轨迹都是笛卡尔轨迹，其描述了机器人10的TCP的空间位置和方向。预定轨迹和/或控制轨迹也可以例如以计算机程序的形式预先给出或编辑。例如 下述形式LIN(xl, yl, zl, α 1, β 1, y 1)SPLINE (χ2, y2, ζ2, α 2，β 2，γ 2), TANGENT 1 (χ, y, ζ)，TANGENT2 ( Δ χ，Δγ, Δ ζ)·
. 进行，根据基点Ht1)而线性起动及由此通过基点ζ (t2)而设置样条，在该处具有 通过切点(x，y，z)和方向矢量(Δχ，Δγ, Δ ζ)而预先给出的切线。
8
权利要求
一种用于控制机械手，特别是机器人(10)，的方法，其具有下列步骤通过轨迹产生装置(1.1，1.2，1.3)预先给出机械手的预定轨迹(z1(t))；通过轨迹转换设备(2)基于预定轨迹自动确定控制轨迹(z2(t))；和通过机械手控制器(3)利用机械手而使控制轨迹起始，其特征在于，所述轨迹转换设备(2)基于预定轨迹的曲率信息(aij；t1(ti))确定控制轨迹的曲率信息(aij；t2(ti))。
2.根据权利要求1的方法，其特征在于，所述曲率信息包括对轨迹参数(t)进行轨迹的一阶和/或更高阶的微分…)O
3.根据上述权利要求之一的方法，其特征在于，所述曲率信息包括轨迹的正切方向(t(ti))和/或其变型(^)，^),...)。
4.根据权利要求3的方法，其特征在于，在轨迹的基点的局部坐标体系中定义所述轨 迹的正切方向和/或其变型。
5.根据上述权利要求之一的方法，其特征在于，所述曲率信息包括多项式系数(aij)， 特别是一次或更高次的多项式系数。
6.根据上述权利要求之一的方法，其特征在于，所述曲率信息包括控制点。
7.根据上述权利要求之一的方法，其特征在于，所述预定轨迹和/或控制轨迹预先设 定为样条或确定为样条，特别是立方的或更高次的样条或者B-样条。
8.根据上述权利要求之一的方法，其特征在于，将所述预定轨迹和/或控制轨迹预先 设定或确定为贝塞尔曲线。
9.根据上述权利要求之一的方法，其特征在于，所述轨迹转换设备基于所述预定轨迹 的曲率信息，选择性地和/或逐段地确定所述控制轨迹的曲率信息。
10.根据上述权利要求之一的方法，其特征在于，对所述控制轨迹在预先给出的相对于 所述预定轨迹的最大偏离下进行近似。
11.根据上述权利要求之一的方法，其特征在于，所述控制轨迹的基点数量相对于所述 预定轨迹的基点数量而改变，特别是减少。
12.根据上述权利要求之一的方法，其特征在于，所述预定轨迹和/或控制轨迹包括机 械手的参照系(TCP)的笛卡尔轨迹。
13.根据上述权利要求之一的方法，其特征在于，所述预定轨迹或控制轨迹补充至少一 个基点，而不改变所述控制轨迹的形状。
14.一种用于控制机械手，特别是机器人(10)，的装置，其具有用于预先给出机械手的预定轨迹(zl(t))的轨迹产生装置(1. 1，1.2，1.3)； 用于基于预定轨迹自动确定控制轨迹(z2(t))的轨迹转换设备(2)，以及 用于利用机械手起始控制轨迹的机械手控制器(3)； 其特征在于，所述轨迹转换设备用于实施根据上述权利要求之一的方法。
15.一种计算机程序，当其在根据权利要求14所述的装置中运行时，执行根据权利要 求1-13之一的方法。
16.一种具有程序编码的计算机程序产品，其储存在机器可读的载体上，并且包括根据权利要求15的计算机程序。
全文摘要
一种根据本发明的用于控制机械手，特别是机器人(10)的方法，通过轨迹产生装置(1.1，1.2，1.3)预先给出机械手的预定轨迹(z1(t))，通过轨迹转换设备(2)基于预定轨迹自动确定控制轨迹(z2(t))，以及通过机械手控制器(3)利用机械手起始控制轨迹，在此轨迹转换设备(2)基于预定轨迹的曲率信息(aij；t1(ti))确定控制轨迹的曲率信息(aij；t2(ti))。
文档编号B25J13/00GK101898358SQ201010188439
公开日2010年12月1日 申请日期2010年5月31日 优先权日2009年5月29日
发明者克里斯汀·逊勒, 马丁·怀斯 申请人:库卡机器人有限公司