机器人的运动控制.pdf

《机器人的运动控制.pdf》由会员分享，可在线阅读，更多相关《机器人的运动控制.pdf（21页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、.2.42.4 手臂的控制手臂的控制运动控制对于机器人手臂的运动来说,人们通常关注末端的运动,而末端运动乃是由各个关节的运动合成实现的。因而必须考虑手臂末端的位置、姿态与各个关节位移之间的关系。此外,手臂运动,不仅仅涉及末端从某个位置向另外一个位置的移动,有时也希望它能沿着特定的空间路径进行移动。为此,不仅要考虑手臂末端的位置,而且还必须顾及它的速度和加速度。若再进一步从控制的观点来看,机器人手臂是一个复杂的多变量非线性系统,各关节之间存在耦合,为了完成高精度运动,必须对相互的影响进行补偿。1.关节伺服和作业坐标伺服现在来研究 n 个自由度的手臂,设关节位移以 n 维向量q (q1,q2,qn

2、)Tn表示,qi是第 i 个关节的位移,刚性臂的关节位移和末端位置、姿态之间的关系以下式给出：r fr(q)1rm是某作业坐标系表示的m 维末端向量,当它表示三维空间的位置姿态时,m=6。如式1 所示,对刚性臂来说,由于各关节的位移完全决定了手臂末端的位置姿态,故如欲控制手臂运动,只要控制各关节的运动即可。设刚性臂的运动方程式如下所示：M(q)q h(q,q)q g(q)2式中,M(q)nn为手臂的惯性矩阵；h(q,q)n为表示离心力和哥氏力的向量,nn为 粘 性 摩 擦 系 数 矩 阵；g(q)n为 表 示 重 力 项 的 向 量；(1,n)Tn为关节驱动力向量。机器人手臂的驱动装置是一个为

3、了跟踪目标值对手臂当前运动状态进行反馈构成的伺服系统。无论何种伺服系统结构,控制装置的功能都是检测各关节的当前位置q及速度q,将它们作为反馈信号,最后直接或间接地决定各关节的驱动力。图 1 给出了控制系统的构成示意图。来自示教、数值数据或外传感器的信号等构成了作业指令,控制系统根据这些指令,在目标轨迹生成部分产生伺服系统需要的目标值。伺服系统的构成方法因目标值的选取方法的不同而异,大体上可以分为关节伺服和作业坐标伺服两种。当目标值为速度、加速度量纲时,分别称之为速度控制或加速度控制,关于这些将在本节 2.和 3.中加以叙述。图 1刚性臂控制系统的构成1）关节伺服控制讨论以各关节位移的形式给定手

4、臂运动目标值的情况。1/21.令关节的目标值为qd(qd1,qd 2,qdn)Tn。图 2 给出了关节伺服的构成。若目标值是以关节位移的形式给出的,那么如图 2 所示,各个关节可以独立构成伺服系统,因此问题就变得十分简单。目标值qd可以根据末端目标值rd由式1 的反函数,即逆运动学inverse kinematics 的计算得出qd fr1(rd)3图 2 关节伺服构成举例如果是工业机器人经常采用的示教方法,那么示教者实际上都是一面看着手臂末端,一面进行示教的,所以不必进行式3 的计算,qd是直接给出的。如果想让手臂静止于某个点,只要对qd取定值即可,当欲使手臂从某个点向另一个点逐渐移动,或者

5、使之沿某一轨迹运动时,则必须按时间的变化使qd发生变化。为了简单起见,假设驱动器的动态特性忽略不计,各个关节的驱动力i可以直接给出。这时,最简单的一种伺服系统如下所示：i kpi(qdi qi)kviqi4kpi是比例增益,kvi是速度反馈增益。对于全部关节,可以将式4 归纳表示为 Kp(qdq)Kvq5nnnn式中,Kp diag(kpi)；Kv diag(kvi)。这种关节伺服系统把每一个关节作为简单的单输入、单输出系统来处理,所以其结构简单,现在的工业机器人大部分都由这种关节伺服系统来控制。但是,从式2 中可知,从手臂的动态特性来看,严格地说,每个关节都不是单输入、单输出系统,惯性项和速

6、度项在关节彼此之间存在动态耦合。在式 5 所表示的关节伺服中,这些耦合均被视为外部干扰来进行处理,为了减少外部干扰的影响,在保持稳定性围应该尽量将增益kpi、kvi设置得大一些。但无论怎样加大增益,由于重力项的影响,手臂在静止状态下,各个关节仍会产生稳态误差,即将式5 代入式6 中,若q q 0,将产生下式所示的稳态误差 e：e qdq Kp1g(q)6有时为了使稳态误差为零,可在式5 中再加上积分项,构成 Kp(qdq)KvqKi(qdq)dt7式中,Kinn为积分环节的增益矩阵,和Kp、Kv一样,它是一个对角矩阵。2/21.传统上,上述伺服系统是用模拟电路构成的。近年来,由于微处理器和信号

7、处理器等高性能、低价格的计算器件的普及,将伺服系统的一部分或全部改成数字电路的所谓软件伺服已经很普遍了。与模拟电路的情况相比,软件伺服能进行更精细的控制。例如,不再让各个关节的增益kpi、kvi固定不变,而是让其按照手臂不同姿态时所期望的响应特性而变化,用下式代替式7,通过对重力项的计算,直接实现重力项的补偿 Kp(qdq)Kvqg(q)8后续的容中,都是在软件伺服假设的前提下展开讨论的。如后面所述,软件伺服系统方式还能有比式7 和式8 更高级的控制方法,但是即使用式7 和式8 的简单的控制方法,闭环系统的平衡点qd也能达到渐进稳定,即经过无限长的时间,q能收敛于qd。即在多数场合,式7 和式

8、8 的控制方法已经足够了。2 作业坐标伺服控制关节伺服控制的结构简单,对软件伺服来说,计算量少,采样时间较短,所以是工业机器人经常采用的方法,这一点已经在前面有所论述。但在自由空间对手臂进行控制时,在很多场合都希望直接给出手臂末端位置、姿态运动的显式表达。例如,让手臂从某个点沿直线运动至另一个点就是这种情况。在这种情况下,很自然会取末端姿态向量r的目标值rd作为手臂运动的目标值。一旦得到rd,利用上述式3 变换为qd,当然也能应用关节伺服方式。但是,为此不但需要事前求解末端目标值rd,而且往往要在运动中对其加以在线修正,于是必须实时计算式3 的逆运动学方程式。此外,因为在关节伺服系统中各个关节

9、是独立受控的,它们的实际响应结果导致的末端位置、姿态的响应比较难以预测,而且为了得到期望的末端响应,对各关节伺服系统的增益调节也十分困难。因此,现在我们来研究不将rd变为qd,而把rd本身作为目标值来构成伺服系统。由于在很多情况下,末端位置、姿态rd是用固定于空间的某一个作业坐标系来描述的,所以把以rd作为目标值的伺服系统称为作业坐标伺服。下面举一最简单的作业坐标伺服的例子。为此,首先将式 1 的两边对时间进行微分,由此可得下式：r frq J(q)q9qT式中,J(q)q frqTmn,称之为雅可比矩阵,雅可比矩阵为q的函数。r和q通常如式 1 所示,为非线性关系。与此相反,由式 9 可知,

10、r和q为线性关系。3/21.式中J(q)是q的函数。根据式9 和虚功原理,可得下式：J(q)Tf10式中,J(q)T表示J(q)的转置,当 m=6 时,f (fx,fy,fz,m,m,m)T6,是组合向量,包括作业坐标系所描述的三维平移力向量和以欧拉角等描述的r的姿态所对应的三维旋转力向量,式10 表示与手臂末端的力和旋转力等效的各关节驱动力的关系式。若取欧拉角(,)作为r的姿态分量,则m,m,m为绕欧拉角各自旋转轴的力矩,这从直观上非常难以理解。所以,在机器人学中,雅可比矩阵经常不是根据式9,而是根据速度的关系直接按照下式来定义：s (vT,T)T Js(q)q11在式11 中,末端速度向量

11、s的姿态分量不是姿态分量的时间微分描述,而是用角速度向量3来表示。不过,在s中,v3是末端的平移速度,和r的位置分量的时间微分一致。式 11 的矩阵Js(q)也称为雅可比矩阵,它表示末端速度向量S与关节速度q之间的关系。虽然它不是从式9 原本的数学意义出发的,但是在机器人学常称之为雅可比矩阵。若采用式11 所定义的雅可比矩阵,对应于式10 右边的f就成为f,fxy,fz,mx,my,mz,f的旋转力分量就变成绕三维空间某些轴旋转的力矩向T量,这样从直觉就很容易理解。有了上面一些预备知识,可以用下式给出一个作业坐标伺服的例子：J(q)TKp(rdr)Kvqg(q)12此时对应的控制系统示于图 3

12、 中,再考虑附加积分环节,即如下式所示：J(q)TKp(rdr)Ki(rdr)dtKvq13图 3 作业坐标伺服举例如果将末端位置、姿态的误差向量rd r分解成位置和姿态分量,用TTTeTp,eo表示,各个分量可以用ep pd p,eod,d,d来表示。p3是末端位置向量,pd是目标值,(,)是欧拉角或横摇角、纵摇角、偏转角,(d,d,d)是其目标值。由式10 可知,与式12、式13 右边第一项中的Kp有关的项产生的使r与rd一致的潜在的力4/21f Kp(rdr)可视为.是施加在末端上的。式12、式13 中手臂末端的当前位置、姿态r可根据当前的关节位移q,由式1 的正运动学direct ki

13、nematics 计算求得。为了从直观上便于理解,可以认为式12、式13 的方法就是要把末端拉向目标值的方向。另外它还有一个特点,就是不含逆运动学计算。与式 7、式 8 一样,式 12 和式 13表明闭环系统的平衡点rd是渐进稳定的。3 姿态的误差表示在式12 或式13 中,可以用式11 中的雅可比矩阵Js(q)代替式9 中的雅可比矩阵。但此时s的姿态分量无对应的位置量纲来表示 的积分值没有物理意义,故必须留意末端的误差,即姿态分量rd r的表示方法。现令末端的姿态误差由基准作业坐标系的姿态矩阵0Rh33给出,即0Rhn,o,a14式中,n,o,a3表示姿态矩阵中的列向量,它们是基准坐标系表示

14、的末端坐标系中 x 轴,y 轴,z 轴方向的单位向量。姿态目标值也可以用姿态矩阵的形式来表示,即0Rhdnd,od,ad15在式 12 或式 13 中,如果用雅可比矩阵Js(q),则rd r的姿态向量可以用下式给出的e0代替e0：1e0nndoodaad162从而得到与式12 对应的式子如下：TTJs(q)TKpeTp,eoKvqg(q)17同样,用式16 所定义的e0,式13 可以变形为e0 ksin18式中,k是从0R转向0Rhd的等效旋转轴方向的单位向量图 4；表示绕此轴的旋转角。e0即是指向k方向的、大小为sin的向量。若用e0表示姿态的误差,虽然姿态的误差角超过2后e0的模反而会变小

15、,当时变为0,会产生错误的结果,但是,如果假设姿态误差不太大,如在2 2的围,那就没什么问题5/21.了。图 4 等效旋转轴若用欧拉角或横摇角、纵摇角、偏转角表示姿态,则式10 中f对应的姿态分量在直观上就变得难以理解了,而且在表现奇异点方面也会出现问题。用式16 定义的e0虽然在直观上容易理解,在表现奇异点方面也没有问题,但是只有在姿态误差小的条件下才有效。因此,这里最后介绍采用四元数quaternion 的姿态误差的表示法。四元法作为欧拉参数Euler parameters 为人们所熟知。设从基准姿态向某一个别的姿态0R1变化的等效旋转轴为u,绕该轴的旋转角为,则4用下式定义：四元数q c

16、os2,usin219在式 19 中要注意,等效旋转轴的向量u无论是从基准坐标系,还是从用0R1表示的坐标系,它的表达都是相同的,即0R1u 1R0u u。这时,旋转矩阵0R1与四元数具有如下式所示的关系：q0R1(221)I 2(T)20式中,为与向量的外积等效的变形对称矩阵；I为33单位矩阵。式20也可反过来应用,即给出四元数,求解与之对应的旋转矩阵。本书将与当前手臂末端姿态0Rh及其目标姿态0Rhd所对应的四元数分别定TTTThdhd,hdhh,h。和q义为q于是,与从末端姿态0Rh到目标姿态0Rhd的 等效旋转相对应的四元数qThhdhhd21T可以利用下式求出：hhdhdhhd22式

17、中,这时的等效旋转轴用0Rh或0Rhd表示的坐标系来描述。因此,若考虑用基准坐标系描述该等效旋转轴向量,设为 ksin给出：2(0Rh0Rhd),则可用下式hhdhdhhd236/21.要注意的是,与仅第三项的外积符号不同。这里使用式23 给出的代替前面的e0,虽然特性上它们同样是非线性的,但即使姿态的误差角超过 2,仍呈单调增加。2.速度控制在 1.中就关节伺服和作业坐标伺服的有关容作了说明,手臂的目标值是以位置量纲给出的。但是,有时手臂作业不用末端的位置和姿态来指定,而改成命令它从当前的位置向某一个方向移动,例如手臂末端从当前位置垂直向上运动,或者只绕规定轴旋转变化姿态,这相当于使用操纵杆

18、操纵遥控机械手的情况。对于这种类型的运动指令,虽然也允许用位置量纲的目标值给出,但必须沿着末端目标值运动的方向时时刻刻改变目标值。在关节伺服的场合还必须对每个末端目标值根据式3 进行一次逆运动学计算,以求得关节目标值,显然为此将花费很多计算时间。对于这种运动指令,人们很自然地想到把末端速度作为目标值给出。末端速度r或s与关节速度q之间具有如式 9 或式 11 所示的线性关系。设rd或sd为末端速度的目标值。假设手臂无冗余性,也不存在奇异状态,于是 m=n,式9 或式11 的雅可比矩阵为正则矩阵,这时实现rd或sd的关节速度qd(qd1,qdn)Tn可由下式求出：qd J(q)1rd24或qd

19、Js(q)1sd25如果手臂具有冗余性,即 nm 时,或者手臂处于奇异状态下,不存在雅可比矩阵的逆矩阵,那么就无法直接应用式 24 或式 25。在实际的计算中,与其按式 24或式25 直接求解雅可比矩阵的逆矩阵,不如把式24 或式25 看作是雅可比矩阵,写出系数矩阵的联立代数方程,然后用消去法去求解rd,从计算量的角度来看后者会更有利些。我们可以把式24 或式25 视为把末端运动分解成必要的关节运动,故称之为分解速度控制RMRC：Resolved Motion Rate Control。式24、式25 的目标是速度,与其说是这些式子本身在实施控制,倒不如将其视为以速度量纲进行逆运动学计算更妥当

20、。和式3 一样,应该把它们的作用看成是把末端空间的目标值变换为关节空间的目标值。如果在各个关节处具备独立跟踪目标速度qdi的速度伺服系统,那么只要把式24 或式25 所求得的qd的各个元素作为各个关节伺服系统的目标值即可。因此,这种情况可以说是利用关节伺服进行的速度控制。图 5 给出了此时控制系统的构成。图 5 关节伺服的速度控制举例另外,式 24 和式 25 中的各个关节伺服系统也适用于本节1.中所涉及的把关节位移qdi作为目标值的情况。设末端速度的目标值用时间函数rd(t)给出,而且关节目标值的初始值为7/21.rd(t0),则在时刻 t 的目标值rd(t)为qd(t)J(q(t)1rd(

21、t)26qd(t)qd(t0)qd(v)dv27t0t用式26 和式27 计算qd(t),相当于式3 的逆运动学计算的数值计算,这个方法对用式3 的无解析解的手臂尤其有效。不过,若反复用式26、式27 进行计算,存在着与目标位置之间的位置积累误差增大的问题。为了解决这一问题,只要在式26 中加上位置反馈即可,如下式所示：qdJ(q)1rdKp(rdr)28对含雅可比矩阵Js的式25 也可以采用同样的办法,不过此时应该将对应于s 的姿态分量的末端姿态误差改换成式16 中的e0,或者用式23 的表示,如下式所示：TTqdJs(q)1sdKpeTp,eo29在式28 或式29 中,是从末端误差rd

22、r的角度来求解qd的,因此将qd作为各个关节速度伺服系统的目标值进行控制的方法,无法明确地区分是属于关节伺服还是属于作业坐标伺服。3加速度控制前面就将目标值设定为位置或速度的场合的手臂伺服系统的构成做了介绍。但是在关节伺服的情况下,即使给出正确的目标值qd、qd,实际的响应情况仍然被各个关节伺服系统的性能所左右。通常的做法是在保证稳定的情况下调大增益,减小与目标值的偏差,然而手臂的运动速度越快、加速度越大,则离心力、哥式力、惯性力和关节轴间耦合的影响也就越大,误差也越严重。即使保证作业坐标伺服的式12 和式13 具有目标值的渐进稳定性,也无法保证过渡特性的好坏,而且随着手臂姿态的不同,响应特性

23、还可能会发生变化。这些问题之所以产生,是因为在迄今所考虑的控制策略中,并未涉及手臂动态特性的式2 所致。因此,在本小节中所叙述的方法是将目标值再追加加速度,即考虑手臂的动态特性,以显式的形式给出过渡特性的要求。首先,设目标值为qd、qd、qd,即包括关节变量加速度,这时考虑采用如下的控制方法：M(q)qdKv(qdq)Kp(qdq)h(q,q)qg(q)30这是关节伺服加速度控制,图 6 表示伺服系统的结构。在式 30 中,M(q)、h(q,q)、g(q)均和式 2中的意义相同,式 30相当于进行逆运动力学 inverse dynamics8/21.计算,以求出能实现由qadjqdKv(qdq

24、)Kp(qdq)所给出的关节加速度的关节驱动力。为简便起见,先假设M(q)、h(q,q)等的值可以正确计算。把式 30代入式2 的左边整理后,得M(q)e KveKpe 031式中,e qdq。因为M(q)是正定对称矩阵,故两边乘上M(q)1后得到eKveKpe 032图 6 用关节伺服的加速度控制适当选择位置增益Kp、速度增益Kv,可以使e渐进收敛于 0,使q与qd达到一致。瞬态响应特性可由Kp、Kv来确定。例如,设Kv kvI、Kp矩阵,若kv 2n、kp kpII是n n的单位2n,则式32 的响应是角频率为n、阻尼系数为的二阶系统响应。控制手臂运动时,一般不希望出现超调量,所以通常取1

25、。这样在加速度控制中之所以瞬态特性也能被满足,是因为通过离心力、哥氏力、重力等的补偿,使非线性手臂的动态特性被线性化,同时考虑了惯性项使系统解耦的结果。因此,可以将式30 的加速度控制视为本节 4.中打算加以说明的动态控制dynamic control的一种方式。式 30 所示的加速度控制由于能够给定瞬态特性,所以这种控制策略非常有效,不过也应该指出它的问题是计算量非常大。为了缩短采样时间,可将式30 的部分计算省略,采用下面简化的公式：MqdKv(qdq)Kp(qdq)Ki(qdq)dt33式33 中省略了h(q,q)、q、g(q)的计算,M nn被M(q)取代,简化为仅由对角元素构成的常数

26、矩阵。M的对角元素最好选择M(q)的对角元素的代表值。此外,为了消除稳态误差,在式33 中重新补上了积分项。各种工业机器人减速比的数值比较大,故驱动器惯性的影响也会比较大,所以M(q)的对角元素比非对角元素大得多,而轴间耦合的影响相对变小。因而在很多情况下,采用式33 的近似控制策略能够满足计算的要求。下面讨论目标值为rd、rd、rd的情况,此时目标值包括了末端位置、姿态的加速度。为此,首先应该求出末端加速度和关节加速度之间的关系。将式9 的两边对时间进行微分,即可得r J(q)q J(q)q34式中,J(q)表示dJ(q)dt。9/21.为了跟踪目标轨迹rd,把根据rd所修正的末端加速度ra

27、dj以下式给出：radjrdKv(rdr)Kp(rdr)35式中,Kv、Kp是适当的增益矩阵；r是当前的末端速度,它由传感器测得的关节速度q用式9 求得。从式34 可以求得实现给定的末端加速度radj的关节加速度为qadjJ(q)1radj J(q)q36再由下式求出实现该关节加速度的关节驱动力：M(q)qadjh(q,q)qg(q)37将式35式37 归纳为一个式子,得到M(q)J(q)1rdKv(rdr)Kp(rdr)J(q)qh(q,q)qg(q)38这就是作业坐标伺服的加速度控制,它与式30 给出的关节伺服加速度控制是相对应的。我们假设正确地完成了式 37 的逆动力学计算,即M(q)、

28、h(q,q)、g(q)的计算结果正确,把式37 代入式2 中后可得下式：q qadj39即实际响应与给定加速度qadj一致。把式39 代入式36 中后得rradj,再把它代入式35 中后可得erKverKper 040式中,errdr。式40 是与关节伺服的式32 相互相对应的。式35式37给出的作业坐标伺服,是为了在末端产生期望加速度而求解出各个关节的加速度,因而称其为分解加速度控制resolved acceleration control。它可以视为是由上述分解运动控制向加速度的扩展。但必须注意的是,分解速度控制只是为了把末端目标速度向关节速度变换,而分解加速度控制则要考虑当前值和目标值之

29、间的误差,并将之视为伺服系统的一部分。另外,在分解速度控制中,实际上无法保证分解的各个关节目标速度正确地被实现,但在分解加速度控制中,若正确掌握了手臂的动态特性模型,则如式39 所示,指令加速度将得到正确的实现。图7 表示了分解加速度控制的总体结构。图 7 分解加速度控制在式36 中,若用Js(q)代替J(q),则目标值以sd,sd,pd、Rhd给出,于是可用下式代替式35 和式36：TTqadjJ(q)1sdKv(sd s)KpeT,epo Js(q)q41这就是原来由 Luh 等提出的分解加速度控制的方案。另外,也可以将姿态分量的误差置10/21.换为式23 定义的,以代替e0。如前所述,

30、若姿态误差用e0来表示,则在产生特大姿态误差时增益会等效下降,瞬态特性恶化。用虽然可以改善瞬态特性,但误差是非线性的这一条并无改变。但是无论在什么情况下用e0时除了 的特殊情况以外,理论上是保证姿态逐渐收敛于目标姿态。另外,如有必要,也可以用四元数让姿态误差的响应特性成为线性关系。4.轨迹控制本小节中,将首先讨论目标轨迹的给定方法,然后介绍手臂高精度跟踪目标轨迹的方法,即动态控制的方法。1）轨迹控制方式如果想让机器人手臂末端沿目标轨迹运动,有两种给定轨迹的方式：一种是所谓示教机器人中采用的示教再现方式；另一种是把目标轨迹用数值形式给出的数值控制方式。所谓示教再现方式是在执行作业前,让手臂末端沿

31、着实际目标值进行移动,同时将相应的数据和作业速度等其他信息一起存入机器人中,在执行时将所示教的动作再现,于是手臂末端就沿目标轨迹运动。示教时手臂运动的方式也分为两种：一种是直接示教方式操作者直接用手握住机器人手臂末端使其做动作；另一种是远距离示教方式 用示教盒的按钮或开关发出运动指令。在示教再现方式中,记忆再现轨迹的方式通常有点位控制 PTP control:Point-To-Pointcontrol 和连续路径控制CP control：Continuous Path control两种图 8。图 8 PTP 控制和 CP 控制1PTP 控制例如,点焊等作业,人们关注在示教点上对末端的位置和姿

32、态定位的问题。至于向该点运动的路径和速度等则不是主要的问题。这种不考虑路径,而是一个接一个地在示教点处反复进行定位的控制就是PTP 控制。2CP 控制例如,弧焊、喷漆等作业,必须控制机器人以示教的速度沿着示教的路径进行运动。这样的控制称为 CP 控制。按示教的方法不同 CP 控制又分为两种：其一是示教时让机器人沿着实际的路径运动,并每隔一个微小的间距就大量记忆该路径上的位置,再现时把所记忆的点一个接一个地作为伺服系统的目标值给出,以达到路径跟踪的目的；另一个是和 PTP控制一样,示教时只记忆路径上的主要点,再现时则在这些主要点之间用直线或圆弧来插补,计算出每个微小间距的路径上的点,再把它们输出

33、给伺服系统图 9。后者和前者相比,需要记忆的点数较少,路径修正也比较容易,因而系统具有灵活性,但必须对其进行插补修正。a 圆弧插补b 直线插补图 9 带插补的 CP 控制所谓数值控制方式,它和数控机床一样,是把目标轨迹以数值、数据的形式给出。所谓数据,是把作业对象的 CAD 数据、在实施控制中所得到的来自传感器的测量数据等各种数据经过变换后给出的。可见,数值控制方式比单纯的再现示教轨迹的示教再现方式更具有一般性、通用性、灵活性。然而,把目标值以数值的形式给出可能会导致计算时间过长,出现机器人装配误差、每台设备本身的分散误差带来新的问题等麻烦。2 目标轨迹生成在 PTP 控制和 CP 控制中,轨

34、迹是由示教直接给出的,而在数值控制方式中,目标轨迹,即输出给伺服系统的目标值的时间函数必须以数值的形式给出。随着机器人手臂面临的作业不同,作业空间的末端轨迹不一定非要从起点至终点在整个区间都要预先给定,有时仅给定起点和11/21.终点,有时仅给定起点、终点及路径所经过的若干中间点即可。在这种情况下,必须人为设定未给定区间适当的轨迹。下面我们就来研究,当手臂末端由某个位置 包括姿态,下同r0历经某一时间tf移向另一个位置rf时,如何确定r0和rf之间轨迹的问题。实际上,这个问题也适用于 CP 控制中的插补。在求目标轨迹时应该注意的是,为了生成实际可行的光滑轨迹,至少应保证位置和速度的连续性条件。

35、另外,为了不使末端产生不必要的振动,还希望能够保证加速度的连续性条件。关于目标轨迹生成的方法,目前已有许多种方案,本节只介绍利用时间多项式给定轨迹的方法。这个方法进一步可分为用关节变量描述轨迹和用末端位置变量描述轨迹两种,它们分别对应于关节伺服和作业坐标伺服。首先就关节变量的方法加以讨论。设对应于r0和rf的关节变量q0和qf已经给出。若只给出r0、rf,则可以求解逆运动学方程,预先求出q0、qf。任意选一个关节变量qi记作,令初始时刻 0 的值为0,终点时刻tf的值为f,即(0)0,(tf)f42再将另外两个时刻的的速度和加速度作为边界条件以下式表示：(0)0,(tf)f43(0)0,(tf

36、)f44虽然满足这些条件的光滑的函数很多,但考虑到简化计算和形式简单,本节选择时间 t 的多项式。能满足任意给出的式42式44 的边界条件的多项式,其最低次数是应该为 5,所以设(t)a0 a1t a2t2 a3t3 a4t4 a5t545经过计算,满足式42式44 的待定系统a0a5结果如下：a0046a11471a20482a3122020(812)t(3)tf0f0f0ff4932tf123030(1416)t(32)t0ff0f0ff502t4f12/21a4.a5112f120(6f60)tf(f)t2f5152tf特殊是,若0f 0、0、f、0、f满足如图 10 所示的关系,即f0

37、tf2(0f)52时,a5 0,于是(t)为 4 次多项式。图 10 起点时刻和终点时刻的边界条件若把这个4次多项式和直线插补结合起来应用,就可以比较容易地给出各种轨迹。例如,下面讨论一个情况,即从起点0的静止状态开始,经加速、等速、减速,最后到点f停止。如图 11 所示,先适当选择决定加减时间的参数,然后确定中间的辅助点02、f 1。在这里是这样确定的,首先把01、f 2取为010、f 2f,然 后 让02和f 1处 于01和f 2相 连 的 直 线 上。接 着 用 折 线001f 2f把0、02之间和f 1、f之间的各个端点连接起来,并用 4次多项式的关系使其加速度为0。再将02、f 1之

38、间以直线相连接。于是2 t tf 2为等速区间；tf 2 t tf为减速区间。0 t 2为加速区间；图 11 从起点到终点的轨迹再讨论用多项式连接0和f的情况。若只考虑位置、速度的边界条件式42、式 43,而不考虑表示加速度连续性的式 44,那么目标轨迹可以不用式 45给出,而用 t 的 3 次多项式给出,特别当0、f、0、f满足式52 时,(t)变为2 次多项式。即有时 3 次多项式和 2 次多项式也可以代替上述的 4 次多项式。上面介绍了关节变量的方法。不过若用这种方法确定r0和rf之间的轨迹,就可能难以预测末端将沿着什么样的轨迹进行运动。另外,有些场合要求给定末端轨迹本身,例如作业希望末

39、端沿直线移动。在这种情况下,就可以选择由末端位置变量来确定r0和rf之间轨迹的方法。有许多种方法可以用来描述末端移动位置和姿态的6个变量,一旦选定某种方法,确定了一组变量后,剩下的就完全可以用与关节变量同样的处理方法来确定各个变量的目标时间轨迹。即在 6 个变量中任选一个,令其为,并假定一个如式 45 所示的时间多项式,然后求出满足边界条件的系数即可。这样就得到沿直线路径运动的目标时间轨迹,而该直线连接六维欧13/21.几里德空间表示末端位置的两个点r0和rf。表示末端移动位置的3个变量,常常用末端坐标系原点相对于基准直角坐标系的坐标来表示。在上述目标轨迹决定法的例子中,末端坐标系的原点位置做

40、直线运动。关于末端的姿态,若取描述姿态的三个变量为欧拉角或横摇角、纵摇角、偏转角,则直线运动也与这些变量有关。既然末端姿态的运动是在基准直角坐标系所表示的,却要由围绕 3 个斜交的轴旋转来合成,这样显然造成了直观上理解的困难。为了改进这个问题,可以将对应于r0的末端坐标系姿态矩阵设为O0,将对应于rf的末端坐标系的姿态矩阵设为Of,于是能求出从O0转向Of的等效旋转轴kf和转角f,若用式 45 来描述姿态目标轨迹绕kf轴由 0 旋转至f的目标轨迹,那么从基准坐标系来观察该轨迹,就得到一条围绕唯一的、方向固定的旋转轴kf旋转的轨迹,这样从直观上就变得容易理解了。3 动态控制在示教再现方式中,目标

41、轨迹通常是以各个关节变量的形式来记录的,因而手臂的控制依赖由每个关节伺服回路组成的关节伺服就足够了,其构成也很简单。但在这种情况下,离心力、哥氏力、重力等引起的各个关节之间的耦合是作为外部干扰来处理的,往往无法满足高速、高精度控制的要求。如在本节 2.中所述,当目标轨迹以时间函数qd(t)或rd(t)给出时,速度qd(t)、rd(t)和加速度qd(t)、rd(t)也可以通过解析法求得。在这种场合采用涉及手臂动态特性的高级控制策略更为可取。所谓动态控制法dynamic control 或计算转矩法computed torque method就是一种考虑机器人手臂动态特性,并能实现给定目标轨迹的控

42、制方法。下面将介绍它的两级控制方式,即针对非线性系统的线性补偿和针对线性系统的伺服补偿方法。设机械手的运动方程式表示为M(q)qh(q,q)qG(q)53要注意的是,现在可以把q,q 作为这个系统的状态变量,将uq作为新的输入,并按下述关系进行非线性状态的反馈补偿：TTT(q,q)M(q)uq54h式中,(q,q)h(q,q)qG(q)55h于是可得q uq56这是一个对于关节变量来说的线性解耦系统。也就是说,式54 完成了线性补偿。如果14/21.式54 中不含有建模误差,而且在系统中未混入外部干扰,假设将目标加速度qd(t)以uq给出,则它能完全实现q(t)qd(t)的目标轨迹。但是,由于

43、建模误差和外部干扰是无法避免的,所以一个基本的方法就是通过设置对式56 线性系统的伺服补偿器来减少上述因素的影响。图 12 所示即为该系统的方框图。图 12 关节变量线性化和伺服补偿的两级控制例如,考虑设置如下式所示的补偿值：uqqdKv(qdq)Kp(qdq)57若将误差e定义为e qdq58由式57 和式58 可得eKveKpe 059若取KvKp为对角元素是正值的对角矩阵,即对每个关节设置了 PD 动作反馈回路,则e的各个元素均收敛于 0。那么,即使有建模误差和外部干扰,也能够在某种程度上减少其影响以上是基于有关关节变量的线性化的方法。但是,有些场合并非要求关节变量,而是希望针对机械手作

44、业直接相关的变量,如末端位置、姿态等加以解耦和伺服补偿。所以,下面讨论对 n 维输出变量 r 线性化的方法,此时 r 由下式给出：r R(q)60若对式60 进行微分,可得r J(q)q61式中,J(q)是以J(q)R q给出的雅可比矩阵。假设在 q 的适当围雅可比矩阵J(q)是正则矩阵,若将ur作为新的输入,并按下式关系进行非线性状态反馈补偿：Th(q,q)M(q)J1(q)J(q)qur62则得到 ur63即得到对输出 r 的线性解耦系统,于是和式56 的情况一样,若对线性系统式 63 设置适当的伺服补偿器,则可以得到如图 13 所示的控制系统。这样的伺服补偿器有很多种设计方法,如选用下式

45、：urrdKv(rdr)Kp(rdr)64则当e rdr时,就与式59 相同。值得指出的是,它的控制原则与本节 3.中所述的分解15/21.加速度控制的形式相同。选用这种两级控制方式时必须考虑的因素是,由于式54 或式62的计算非常复杂,所以必须使用数字计算机进行,因而就产生了如何缩短采样周期的问题。另外,还要尽可能减少原数学建模的建模误差和外部干扰的影响,即必须设计所谓鲁棒伺服补偿器。前者可以考虑选择牛顿-欧拉计算公式的逆运动学问题计算来解决。后者就要参考用 2个自由度伺服系统的研究方法或灵敏度函数、互补灵敏度函数的研究方法来解决。图 13 输出的线性化和伺服补偿的两级控制5.解耦控制在本小

46、节中,将介绍非线性系统的解耦控制理论,并把它用于机械手,然后介绍同时进行动态特性线性化、输出变量间的解耦和任意极点配置的方法。这个理论给出了在本节4.中所介绍的两级控制中线性补偿的理论根据,所以是很有意义的。现在我们来研究 n 输入、n 输出的非线性时变系统,该系统如下式所示：x(t)a(x,t)B(x,t)u(t)65y(t)c(x,t)D(x,t)u(t)66式中,x为ns维状态向量；y为 n 维输出向量；u 为 n 维输入向量。另外,a(x,t)、B(x,t)、c(x,t)、D(x,t)是已知向量或矩阵。在该系统中,通过实施如下所示的适当的非线性时变状态反馈控制律：u(t)e(x,t)G

47、(x,t)u(t)67输出 y 的各个元素不但可以相互解耦,而且具有任意指定的极点。式 67 中u(t)为新的 n 维输入向量。假设D(x,t)的第 i 行向量为di(x,t),c(x,t)和 y 的第 i 个元素为ci(x,t)和yi,(j)另外,设yi对于时间的 j 阶导函数为yi。这时,若反复就时间对yi进行微分,并用式65 和式66 整理,直至 u 的系数不为 0 为止,则对适当的正整数vi,可得如下关系：yi(j)ci j(x,t)(j 0,1,vi1)68yi(vi)civi(x,t)divi(x,t)u69(0)00式中,yi yi,ci(x,t)ci(x,t),di(x,t)d

48、i(x,t)ci j(x,t)(j1)(j1)yiTyia(x,t)70tx di j(x,t)Tyi(j1)B(x,t)71x16/21.另外,vi(i 1,2,n)是直至 u 开始出现为止的微分次数,并假定在被研究对象系统中,无论 x,t 的值如何,vi都是一定的。再设v1c1(x,t)v2c(x,t)72c*(x,t)2vncn(x,t)d1v1(x,t)v2d(x,t)73D*(x,t)2vnd(x,t)n(x,t)c(x,t)colikyi(k)74*(k)ikik0k0vi1vi1 diag1,2,n75*式中,col为列向量；diag为对角矩阵；ik、i为任意常数。这时假如D(x

49、,t)是正则矩阵,在式67 中若规定*e(x,t)D*1(x,t)c(x,t)(x,t)76G(x,t)D*1(x,t)77则系统对于输出 y 就是一个解耦系统。实际上,如果在式65 和式66 中使用式67、式76 和式77,即可得到下式：yi(vi)i(vi1)y(vi1)i0yiiui(i 1,2,n)78在此,适当地选择ik、i,就可在解耦后的各个单输入、单输出系统中给出任意的极点配置和增益。下面我们将上述理论应用于机械手。将手臂运动方程式53 表示为(q,q)79M(q)qh(q,q)为式 55 所给出的函数。另外,如果将任意的 n 维作业向量 r 作为输出,它满足式中,h下列关系：y

50、 r R(q)80y r J(q)q81再有,若把驱动力看成是输入,在这种情况下,取q,q 作为状态向量,则式 79 变成如下TTT17/21.形式：q0 x 1821M(q)h(q,q)M(q)对于式80、式82,vi(i 1,2,n),则有D*J(q)M1(q)83我们把rankJ n的手臂姿态用 q 表示的整个手臂的位置、姿态称为奇异姿态奇异点,对于除奇异姿态以外的手臂任意姿态,式83 中的D为正则矩阵,并且能够实现解耦。根据式67、式76 和式77,若设Ji(q)为J(q)的第 i 行向量,则可以求得如下式所示的状态反馈律：*(q,q)M(q)J1(q)colJi(q)qi1yii0y