第五讲微分变换.ppt

第五章第五章 微分变换微分变换 ChapterⅤ Differential RelationshipsChapterⅤ Differential Relationships5.1 5.1 引言引言5.2 5.2 微分矩阵微分矩阵 5.3 5.3 微分平移和旋转变换微分平移和旋转变换 5.4 5.4 微分旋转微分旋转 5.5 5.5 坐标系之间的微分变换坐标系之间的微分变换 5.6 5.6 机械手的微分变换方程机械手的微分变换方程 —— 雅可比方程雅可比方程 5.7 5.7 雅可比逆矩阵雅可比逆矩阵5.8 5.8 本章小结本章小结9/5/20241智能与控制工程研究所5.1 引言引言（Introduction） 微分变换在机器人视觉、动力学和机器人控制（如力控、刚度控制、阻抗控制、顺应控制等）中十分重要例如当摄像机或其它传感装置检测到机器人末端执行器的位置和方向的微小变化时，需要将该微小变化从摄像机或其它传感装置坐标转换到基坐标或参考坐标系。

在机器人刚度控制中，需要获得在控制坐标系中力与位置的微分变换又如将直角坐标的微分变换转化为关节坐标的微分变换，还有在下一章介绍的机器人动力学问题时，也会用到微分变换本章将介绍微分变换的基本原理和方法，包括微分平移、微分旋转、坐标系之间的微分变换、雅可比矩阵和逆雅可比矩阵及其应用 9/5/20242智能与控制工程研究所5.2 微分矩阵微分矩阵（Derivative Matrixes） 给出一个4×4的矩阵A                     （5.1）矩阵A的微分就是对矩阵A中的每一个元素对自变量x的微分，结果如下              （5.2）9/5/20243智能与控制工程研究所5.3 微分平移和旋转变换微分平移和旋转变换 ( Differential Translation and Rotation )               微分平移和旋转变换可以是针对基坐标或参考坐标系，也可以是针对某个指定的坐标系进行例如对于一个变换矩阵T，它对基坐标的微分变换可表示为             （5.3）              式中是在基坐标的x，y，z轴向上分别平移dx，dy，dz；和绕基坐标的向量k旋转dθ角。

由此可得到             （5.4）      如果上述微分变换不是针对基坐标而是针对坐标系T，那么微分变换的结果可表示为             （5.5）      此时，式中                            是在T坐标的x，y，z轴向上分别平移dx，dy，dz；                   是绕T坐标的向量k旋转dθ角由此可得到             （5.6） 9/5/20244智能与控制工程研究所      我们用符号   来表示式（5.4）和式（5.6）中的                                               并将它称为微分变换算子（5.6）      这样式（5.4）和式（5.6）就可写成如下形式                            （5.7）      和                                                                                                                  （5.8）      式（5.7）中的微分变换算子   是针对基坐标的，而式（5.8）中的微分变换算子       则是针对T坐标的。

              在第二章我们给出了平移和一般性旋转变换的齐次变换矩阵表达式，平移变换矩阵是                                                                      1   0   0   a                                                                      0   1   0   bTrans( a, b, c ) =     0   0   1   c                                     （5.9）                                                                      0   0   0   19/5/20245智能与控制工程研究所当平移向量是微分向量d＝dxi+dyj+dzk时，微分平移矩阵为                                                                       1   0   0   dx                                                                       0   1   0   dyTrans( d ) =    0   0   1   dz                                            （5.10）                                                                       0   0   0   1一般性旋转变换的变换矩阵是 kxkxversθ + cosθ kykxversθ - kzsinθ kzkxversθ + kysinθ  0 kxkyversθ + kzsinθ kykyversθ + cosθ kzkyversθ - kxsinθ    0Rot( k,θ) =   kxkzversθ - kysinθ kykzversθ + kxsinθ kzkzversθ + cosθ      0  (5.11)                                         0                                    0                                   0                1当进行微分旋转变换时，旋转角dθ极小，此时有如下关系9/5/20246智能与控制工程研究所将上述关系代入式（5.11）可得                                                   1 - kzdθ kydθ     0 kzdθ        1 - kxdθ     0                    Rot( k, dθ) =   - kydθ kxdθ 1         0                              (5.12)                                                   0            0             0         1由式（5.6）可得               (5.13)9/5/20247智能与控制工程研究所5.4 微分旋转微分旋转 (Differential Rotations)              式（5.13）给出的微分变换算子  是基于微分旋转角dθ的微分平移和旋转变换表达式，下面讨论绕坐标轴x、y、z旋转δx、δy、δz的微分变换。

              第二章给出的绕坐标轴x、y、z旋转的变换矩阵分别为                （5.14）                （5.15）                （5.16）9/5/20248智能与控制工程研究所在微分变换的情况下，sinθ→dθ，conθ→1，上面三个式子变为 （5.17） （5.18） （5.19）由此可得到 （5.20）9/5/20249智能与控制工程研究所             比较式（5.12）和式（5.20）可知，绕任意向量k旋转dθ的微分旋转与绕x、y、z轴分别旋转                    的结果相同，即                        （5.21）     由此可得到绕坐标轴x、y、z旋转δx、δy、δz的微分变换算子为                  （5.22）          微分变换算子中的元素由微分平移向量d和微分旋转向量δ的各个分量组成，即                       （5.23）                       （5.24）     将上述二个向量组合构成一个微分运动矢量D                （5.25）              这样，我们就可根据式（5.25）给出的微分运动矢量D直接得到微分变换算子    ，或基于T坐标的微分运动矢量                         的微分变换算子      。

9/5/202410智能与控制工程研究所【例5.1】已知坐标A的变换矩阵为      当用微分平移矢量d = 1i + 0j + 0.5k和微分旋转矢量δ＝ 0i + 0.1j + 0k对坐标A 进行变换时，求出微分变换的结果dA解：首先，由式（5.22）求出微分变换算子        由式（5.7）可得        即微分变换结果如图5.1所示xyzzAyA+dAx图5.1 坐标A的微分变换9/5/202411智能与控制工程研究所5.5 坐标系之间的微分变换坐标系之间的微分变换 (Transforming Differential Changes between Coordinate Frames)              上节讨论了基于基坐标或某个指定坐标的微分变换，本节继续讨论坐标系之间的微分变换，也就是已知微分变换算子  ，如何求出T坐标的微分变换算子    由式（5.7）和（5.8）可知                       （5.26）      则为                                                                                                                   （5.27）              上式是一个重要的表达式，它描述了坐标系之间的微分变换关系。

下面我们用微分平移矢量d和微分旋转矢量    来推导       的表达式              已知变换矩阵T为9/5/202412智能与控制工程研究所9/5/202413智能与控制工程研究所我们用矢量的叉乘来得到式（5.27）等号右边二项的乘积           （5.29）式中d和    分别是微分平移和微分旋转矢量用      左乘式（5.29）可得       （5.30）上式矩阵元素都具有如下矢量三重积形式根据矢量三重积的性质有            （5.31）9/5/202414智能与控制工程研究所同时，三重积中只要有二个矢量是相同的，其结果为零如                       （5.32）根据上述性质，式（5.30）可写成    （5.33）对于正交矢量有                        （5.34）这样，式（5.33）可重写成          （5.35）9/5/202415智能与控制工程研究所     上式可进一步简化为                （5.36）     比较式（5.35）和式（5.36）的矩阵元素可得                                                 （5.37）                                                      （5.38）      在式（5.37）和式（5.38）中，n、o、a和p是微分坐标变换矩阵T的旋转和平移矢量，    和      是对应坐标T的微分平移和旋转矢量。

9/5/202416智能与控制工程研究所式（5.37）和式（5.38）也可用6×6的矩阵形式表示如下       （5.39）将上式写成式（5.36）和式（5.37）的形式如下                                                 （5.40）                                                      （5.41）式（5.40）和式（5.41）是后续内容中要经常用到的重要结果9/5/202417智能与控制工程研究所【例5.2】给出与例5.1相同的坐标的变换矩阵、微分平移矢量和微分旋转矢量如下： d = 1i + 0j + 0.5k δ＝ 0i + 0.1j + 0k                试求出坐标A上的等效微分变换dA。

解：由坐标变换矩阵A可得到相应的旋转与平移矢量        由此可求出        根据式（5.40）和式（5.41）得到9/5/202418智能与控制工程研究所用上述结果来验证坐标A上的等效微分变换dA，由式（5.8）有由已求出的     、     和式（5.36）可得到则上述结果与例5.1相同9/5/202419智能与控制工程研究所5. 6 机械手的微分变换方程机械手的微分变换方程——雅可比方程雅可比方程 （The Manipulator Jacobian）              在第三章我们介绍过，机械手的运动学方程由它的末端相对于基坐标的齐次变换矩阵T6表示，即T6 = A1 A2 A3 A4 A5 A6                                   （5.42）              其中每一个关节变换矩阵Ai描述了该关节坐标相对于前一个关节坐标的变换关系，关节变量用qi表示，如果是旋转关节，关节变量是θi，它是绕前一个关节坐标z轴的旋转角度；如果是滑动关节，关节变量是di，它是沿前一个关节坐标z轴滑动的距离同样，当我们讨论机械手的微分变换方程时，首先定义微分关节变量为dqi，如果是旋转关节，则为dθi，如果是滑动关节，则为ddi。

9/5/202420智能与控制工程研究所              机械手第i个关节的微分变换引起第6个连杆末端（即机械手末端）的微分变换dT6可由下式表示：           （5.43）      则                                                 （5.44）      由式（5.27）可得到机械手末端的微分变换算子               （5.45）      其中                       （5.46）      如果关节i是旋转关节，则di = 0，式（5.40）和式（5.41）变为 （5.47）（5.48）9/5/202421智能与控制工程研究所              当                          ，为单位微分旋转矢量时，式（5.47）和（5.48）可进一步简化为      （5.49）                     （5.50）      如果关节i是棱形滑动关节，则δi＝0，di = 0i + 0j + 1k，式（5.40）和式（5.41）变为                     （5.51）                       （5.52）              机械手末端坐标T6的微分变换是所有6个关节微分变量的函数，可用6×6的矩阵表示，矩阵元素由6个关节的微分平移和微分旋转矢量构成，该矩阵称为雅可比矩阵。

它的每一列元素为对应关节的微分平移和微分旋转矢量应用雅可比矩阵的机械手微分变换方程——雅可比方程如下：      （5.53）9/5/202422智能与控制工程研究所5.7 雅可比逆矩阵雅可比逆矩阵（The Inverse Jacobian）              当微分变换是由直角坐标空间向关节坐标空间进行时，由式（5.53）可得到   （5.72）                            上式等号右边矩阵是雅可比逆矩阵显然，用符号运算来得到雅可比逆阵是很困难的，因为微分变换要进行大量算术运算，同时当机械手出现退化时，其结果会出错              为此，我们采用第四章介绍的根据T6的值计算关节坐标值的方法和步骤来计算微分关节坐标值将关节坐标的微分变换表示为dT6中各元素的函数，然后求出各关节的微分变换值该方法相对比较简单，而且在机械手出现退化时，将相应关节的微分变换值设置为零，这就不会影响后续关节的计算结果在后面的讨论中，我们假设机械手的符号解存在，而且关节变量的正弦和余弦值已知9/5/202423智能与控制工程研究所              为了计算dT6,我们首先根据式（5.37）和式（5.38）对T6进行微分变换得到微分平移矢量    和微分旋转矢量     ，然后根据式（5.22）求出      ，最后根据式（5.8）得到dT6。

              下面通过对第四章介绍的斯坦福机械手逆运动学解的微分变换来说明上述方法的具体步骤              由第四章式（4.15）有－S1 px＋C1 py = d2                                           （5.73）      对式（5.73）求导可直接得到第一个关节变量θ1的微分                        （5.74）     对于正切函数                       （5.75）     其微分公式为           （5.76）9/5/202424智能与控制工程研究所由第四章式（4.24）和式（4.25）有                 （5.77）                       （5.78）对式（5.77）和式（5.78）求微分得到           （5.79）                                 （5.80）由公式（5.76）可得到第二个关节变量θ2的微分                 （5.81）将式（5.77）代入第四章的式（4.31）有                      （5.82）对式（5.82）进行微分可直接得到第三个滑动关节变量d3的微分         （5.83）9/5/202425智能与控制工程研究所       由第四章式（4.38）和式（4.39）有NS4 =－S1ax＋C1ay                                      （5.84）               NC4 = C2D41－S2az                                       （5.85）其中                                        D41 = C1ax＋S1ay                                          （5.86）对式（5.84）~式（5.86）进行微分得到              （5.87）           （5.88）           （5.89）由式（5.76）可得到第四个关节变量θ4的微分dθ4。

在计算第五个关节变量微分时，为了简化计算，我们可将式（5.76）简化为             （5.90）        由第四章式（4.42）和式（4.43）有S5 = C4NC4+ NS4                                          （5.91）C5 = S2D41 + C2az                                          （5.92）9/5/202426智能与控制工程研究所对式（5.91）和式（5.92）进行微分得到        （5.93）                （5.94）由式（5.90）可得到第五个关节变量θ5的微分dθ5        最后，我们由第四章式（4.49）和式（4.50）有S6 =－C5N61－S5N612                                    （5.95）C6 =－S4N611 + C4N6112                                （5.96）其中N6111 = C1ox + S1oy                                                       （5.97）dN6111 = dC1ox + C1dox + dS1oy + S1doy                       （5.98）N6112 =－S1ox + C1oy                                                    （5.99）dN6112 =－dS1ox－S1dox + dC1oy + C1doy                 （5.100）9/5/202427智能与控制工程研究所N611 = C2N6111－S2oz                                                             （5.101）dN611 = dC2N6111 + C2dN6111－dS2oz－S2doz                        （5.102）N612 =－S2N6111－C2oz                                                          （5.103）dN612 =－dS2N6111 + S2dN6111－dC2oz－C2doz                     （5.104）N61 =－C4N611 + S4N6112                                                       （5.105）dN61 =－dC4N611 + C4dN611 + dS4N6112－S4dN6112               （5.106）对式（5.95）和式（5.96）进行微分得到              （5.107）           （5.108）由式（5.90）可得到第六个关节变量θ6的微分dθ6。

9/5/202428智能与控制工程研究所5.8 本章小结本章小结（Summary）              本章介绍了微分变换的基本原理和方法，包括微分平移、微分旋转、坐标系之间的微分变换、雅可比矩阵和逆雅可比矩阵及其应用              首先我们给出了微分变换矩阵的两种表示方式，即                            （5.7）和                                                                                                             （5.8）              其中式（5.7）是针对基坐标的微分变换表达式，式（5.8）是针对T坐标的微分变换表达式式中的   称为微分变换算子，它是针对基坐标的；而     则是针对T坐标的              微分变换算子   由微分平移向量d和微分旋转向量δ的各个分量组成，即                  （5.22）9/5/202429智能与控制工程研究所             式中的微分旋转向量δ的各个分量δx，δy，δz是分别绕基坐标的x、y、z轴旋转的角度，如果微分旋转是绕任意向量k旋转一个微小角dθ，则其对应的各个分量为                        （5.21）       微分变换算子     与      的转换公式为                       （5.27）             式（5.27）中T是由旋转向量n、o、a和平移向量p组成的齐次变换矩阵，    的各个元素可由      的元素计算得到，计算公式如下                                                 （5.40）                                                      （5.41）              根据微分变换的基本原理和方法，我们推导了机械手的末端直角坐标与各关节坐标的微分变换关系和相应的计算方法，这就是所谓的雅可比矩阵和逆雅可比矩阵，并以斯坦福机械手为例，详细说明了该计算方法的具体应用。

9/5/202430智能与控制工程研究所。