《速度运动学》由会员分享，可在线阅读，更多相关《速度运动学（7页珍藏版）》请在金锄头文库上搜索。
1、第4章速度运动学一一雅可比矩阵在数学上，正运动学方程在笛卡尔位置和姿态空间与关节位置空间之间定义了一个函数， 速度之间的关系由这个函数的雅可比矩阵来决定。雅可比矩阵出现在机器人操作的几乎各个方面：规划和执行光滑轨迹，决定奇异位形， 执行协调的拟人动作，推导运动的动力学方程，力和力矩在末端执行器和机械臂关节之间的 转换。1. 角速度：固定转轴情形=0k( k是沿旋转轴线方向的一个单位向量，。是角度0对时间的倒数)2. 反对称矩阵一个nX n的矩阵S被称为反对称矩阵，当且仅当ST + S = 0,我们用so(3)表示所有3 x 3反对称矩阵组成的集合。如果S e so(3)，反对称矩阵满足、可+%
2、 = 0 i, j = 1,2,3，所以S的=0，S仅包含三个独立项，并且每个3 x 3的反对称矩阵具有下述形式：0- s s-s s 0如果a = (a ,a ,a )t是一个3维向量，我们将对应的反对称矩阵S(a)定义为如下形式:S (a)=a a 0- y x-反对称矩阵的性质1) S(以a + P) =aS(a) + pS(b)向量a、b 属于 R3，a、p 为标量2) S(a)p = a x p 向量a、b属于R3，ax p表示向量叉乘3) RS(a)Rt = S(Ra)，左侧表示矩阵S(a)的一个相似变换，这个公式表明：S(a)在坐标系中经过R旋转操作的矩阵表示与反对称矩阵SR(a
3、)相同，其中SR(a)对应于 向量a被转过R这种情形。4) 对于一个nxn的反对称矩阵S,以及任何一个向量X e Rn，有XtSX = 0旋转矩阵的导数ddoR = SR (0)公式表明：计算旋转矩阵的R的导数，等同于乘以一个反对称矩阵s的矩阵乘法操作。3.角速度：一般情况_!，、 ，、_，、 一，、 ，、R(t) = s(w(t)R(t)，其中，矩阵S(w(t)是反对称矩阵，向量w(t)为t时刻旋转坐标系相对于固定坐标系上的点P。4. 角速度求和一 _ _ _ _ . 、 一 假定我们有 R0 = R0Ri.Rt，则 R。= S(w 0 )R0，其中 n 1 2 nn0,nnw 0 =w 0
4、 + R 0W1 + R 0W 2+R 0W 3 +. + R 0 w n-1 0,n 0,111,222,333,4n-1 n-1,n=W0 +W0 +W0 +W0 + . + W0(w 0表示对应于R1导数的角速度在坐标系O X y z中的表达式) 1,220 0 0 05. 移动坐标系上点的线速度p 0 = Rp1 + o = S (w) Rp1 + o = wx r + v其中，r = Rp1是从o 1到p的向量在坐标系oxy z的姿态中的表达式，v是原点o运 0 0 0 01动的速度。6. 雅可比矩阵的推导当机器人运动时，关节变量以及末端执行器的位置o和姿态Ro都将为时间的函数。&
5、= Jq其中，&和j由下式给出v 0nw 0nJ和J = J Jw向量&有时被称为体速度。矩阵J被称为机械臂的雅可布矩阵。角速度：末端执行器相对于基座坐标系的总的角速度w 0 :nw0 = p q k + p q r0k+.+p q r0 k = Y p q z0 n 1 1221n n n-1i i i-1i=1其中，关节i为转动时，P,等于1,；而关节i为平动时，P,等于0。这是因为Z01 = Ro k，当然，Z0 = k = (0,0,1)r。所以 J = (P z .p z )w 1 0 n n-1线速度：,do 0J =，雅可比矩阵的第i列可以通过下列方式生成：固定除第i个关节之外的
6、 vi dqi所有关节，同时以单位速度驱动第i个关节。平动关节：Jv = Zi-1 i转动关节：J = z X (o -o )v,i-1ni-1小结：雅可比矩阵的上半部分J由下式给出:vJ = (J .J)1n其中，矩阵的第1列J.为_J zX(o-O)对于转动关节iv, = t 1-1 1 T对于平动关节i雅可比矩阵的下半部分为J / ( J w J w )对于转动关节i 对于平动关节i1n其中，矩阵的第i列J =zi-1W I 0计算雅可比矩阵仅需知道单位向量*以及原点o.，on的坐标。*相对于基座坐标系的 坐标，可由T0第3列中的3个元素给出，同时o,由T0第4列中的3个元素给出。7.
7、工具速度末端执行器和工具坐标系之间的固定空间关系由下列恒定齐次变换矩阵给出:tool由于两个坐标系之间的刚性连接，工具坐标系的角速度与末端执行器坐标系的角速度相如果末端执行器坐标系以6= (VT , 3 T)T的体速度运动，那么工具坐标系的原点(它被刚性固连到末端执行器坐标系中)的线速度由下式给出：vtooi = v6+% X r，r是从末端执行器坐标系原点到工具坐标系原点的向量。8. 分析雅可比矩阵前面推导的雅可比矩阵有时称为几何雅可比矩阵，这是为了区别于分析雅可比矩阵，后者表示为J (q)，它基于对末端执行器姿态的最小表示，令d (q)a (q)X =: 表示末端执行器的姿态，其中，d(q
8、)是从基座坐标系原点到末端执行器 坐标系原点的一般向量，a表示末端执行器坐标系相对于基座坐标系的姿态的最小表示。分析雅可比矩阵J (q)可以根据几何雅可比计算如下J (q)q =dB(a )aI 00 B(a)I00 B(a)J (q)q(条件：det B (a )主 0)9. 奇点所有可能的末端执行器速度是雅可比矩阵向量的线性组合：6 = j q + j q +.+j q1 12 2n n矩阵的秩(rank)等于矩阵中线性独立的列(或行)的数目。因此，当rankJ = 6，末端执行器可以以任意速度运行。与矩阵J(q)的秩小于其最大值情况相对应的位形被称为奇点或奇异位型。识别机械臂的奇点很重要
9、，其原因如下：奇.直tt小打此位倏卜.某墅厅向的/时忻陇无注让倒疗帝点姓.曾孵的来教行寻迎忒可K肉隗十无障的X心谏值希奶的抻加可血于M加职即的力E画逾们幡爵9章。现以一点心翊EJS于机械费环空丽边界加即机的*奇点时应于机物工作空5迁杼数由长匿瞄*可刑岫网法到IS的点.对那些带有球型手腕机械臂的奇异位形进行解耦，即分解为两个更简单的问题。第一个 问题是确定所谓的手臂奇点，也就是由于手臂(包括前三个或更多连杆)运动而产生的奇点;第二个问题是确定由球型手腕运动而引起的手腕奇点。如果机械臂由一个3自由度手臂和一个3自由度球型手腕构成，我们将雅可比矩阵J分 解成如下3 x 3的矩阵块:(J J )*21
10、22 因此，机械臂奇异位形的集合是满足det J11 = 0的手臂位形集合以及满足det J 22= 0的 手腕位形集合的并集。任何两个转动关节轴共线时，都将会产生奇点，这是因为两个转角相等但方向相反的旋 转所对应的综合结果是末端执行器保持不动。10.静态力/力矩关系令F = (F , F , F ,n ,n ,n )t表示末端执行器的力和力矩向量。令t表示对应的关节 x y z x y z力矩向量。那么，F和1之间可以由下式联系起来：t = Jt (q)F其中，Jt (q)是机械臂雅可比矩阵的转置。11.逆速度和加速度逆速度问题是指，求解生成期望末端执行器速度所需的关节速度qq = Jt&对于6自由度机械臂，逆速度和逆加速度方程可被写为(d q = J (q)q + -J (q) qI dt a )以及(dY-q = J (q)TX-J (q)qaat a J上述公式成立的条件是：detJ 0）。0 a
