第3章 機器人運動學(xué)

1、1第三章第三章 機器人運動學(xué)機器人運動學(xué) 第一節(jié)第一節(jié) 概述概述第二節(jié)第二節(jié) 機器人的運動學(xué)基本問題機器人的運動學(xué)基本問題第三節(jié)第三節(jié) 機器人的雅可比矩陣機器人的雅可比矩陣 第一節(jié)第一節(jié) 概述概述 常見的機器人運動學(xué)問題可歸納如下：常見的機器人運動學(xué)問題可歸納如下：1 1對一給定的機器人，已知桿件幾何參數(shù)和關(guān)對一給定的機器人，已知桿件幾何參數(shù)和關(guān)節(jié)角矢量求機器人末端執(zhí)行器相對于參考坐標(biāo)節(jié)角矢量求機器人末端執(zhí)行器相對于參考坐標(biāo)系的位置和姿態(tài)。系的位置和姿態(tài)。2 2已知機器人桿件的幾何參數(shù)，給定機器人末已知機器人桿件的幾何參數(shù)，給定機器人末端執(zhí)行器相對于參考坐標(biāo)系的期望位置和姿態(tài)端執(zhí)行器相對于參考

2、坐標(biāo)系的期望位置和姿態(tài) ( (位姿位姿) )，機器人能否使其末端執(zhí)行器達到這個，機器人能否使其末端執(zhí)行器達到這個預(yù)期的位姿？如能達到，那么機器人有幾種不預(yù)期的位姿？如能達到，那么機器人有幾種不同形態(tài)可滿足同樣的條件同形態(tài)可滿足同樣的條件? ? 第一個問題常稱為運動學(xué)正問題第一個問題常稱為運動學(xué)正問題( (直接問題直接問題););第二個問題常稱為運動學(xué)逆問題第二個問題常稱為運動學(xué)逆問題( (解臂形問題解臂形問題) )。這兩個問題是機器人運動學(xué)中的基本問題。這兩個問題是機器人運動學(xué)中的基本問題。 第二節(jié)第二節(jié) 機器人運動學(xué)的基本問題機器人運動學(xué)的基本問題 一、運動學(xué)基本問題一、運動學(xué)基本問題 圖圖

3、3 31 1所示為所示為2 2自由度機器人手部的連桿機構(gòu)自由度機器人手部的連桿機構(gòu)。 圖中的連桿機構(gòu)是兩桿件通過轉(zhuǎn)動副聯(lián)接的關(guān)節(jié)結(jié)構(gòu)，圖中的連桿機構(gòu)是兩桿件通過轉(zhuǎn)動副聯(lián)接的關(guān)節(jié)結(jié)構(gòu)，通過確定連桿長度，以及關(guān)節(jié)角，可以定義該連桿機構(gòu)。通過確定連桿長度，以及關(guān)節(jié)角，可以定義該連桿機構(gòu)。在分析機器人的末端手爪的運動時，若把作業(yè)看作主要依靠在分析機器人的末端手爪的運動時，若把作業(yè)看作主要依靠機器人手爪來實現(xiàn)的，則應(yīng)考慮手爪的位置（圖中點的位置機器人手爪來實現(xiàn)的，則應(yīng)考慮手爪的位置（圖中點的位置）。一般場合中，手爪）。一般場合中，手爪姿勢也表示手指位置。從姿勢也表示手指位置。從幾何學(xué)的觀點來處理這個幾何

4、學(xué)的觀點來處理這個手指位置與關(guān)節(jié)變量的關(guān)手指位置與關(guān)節(jié)變量的關(guān)系稱為運動學(xué)（系稱為運動學(xué)（KinematicsKinematics）。）。 6引入向量分別表示手爪位置和關(guān)節(jié)變量，引入向量分別表示手爪位置和關(guān)節(jié)變量， 因此，利用上述兩個向量來描述一下因此，利用上述兩個向量來描述一下這個這個2 2自由度機器人的運動學(xué)問題。自由度機器人的運動學(xué)問題。手爪位置的各分量，按幾何學(xué)可表示為：手爪位置的各分量，按幾何學(xué)可表示為：xry 1211212coscos()xLL11212sinsin()yLL(3-1)(3-2)7用向量表示這個關(guān)系式，其一般可表示為用向量表示這個關(guān)系式，其一般可表示為 式中式中

5、表示向量函數(shù)。已知機器人的關(guān)節(jié)變量表示向量函數(shù)。已知機器人的關(guān)節(jié)變量 ，求其手爪位置的運動學(xué)問題稱為正運動學(xué)（求其手爪位置的運動學(xué)問題稱為正運動學(xué)（direct direct kinematicskinematics）。該公式被稱為運動方程式。如果，）。該公式被稱為運動方程式。如果，給定機器人的手爪位置，求為了到達這個預(yù)定的位給定機器人的手爪位置，求為了到達這個預(yù)定的位置，機器人的關(guān)節(jié)變量的運動學(xué)問題稱為逆運動學(xué)置，機器人的關(guān)節(jié)變量的運動學(xué)問題稱為逆運動學(xué)（inverse kinematicsinverse kinematics）。其運動方程式可以通過）。其運動方程式可以通過以下分析得到。以下

6、分析得到。 ( )rff(3-3)8如圖所示，根據(jù)圖中描述的幾何學(xué)關(guān)系，可得如圖所示，根據(jù)圖中描述的幾何學(xué)關(guān)系，可得 2221122sinarctan( )arctan()cosLyxLL22221212()arccos2xyLLL L式中式中(3-4)(3-5)(3-6)9同樣，如果用向量表示上述關(guān)系式，其一般可表同樣，如果用向量表示上述關(guān)系式，其一般可表示為示為 1( )fr 如圖所示，機器人到達給定的手爪位置如圖所示，機器人到達給定的手爪位置 r有兩個姿態(tài)滿足要求，即圖中的有兩個姿態(tài)滿足要求，即圖中的 也是也是其解。其解。這時這時 和和 變成為另外的值。變成為另外的值。即逆運動學(xué)的解不是

7、惟一的，即逆運動學(xué)的解不是惟一的，可以有多個解?？梢杂卸鄠€解。 12(3-7)二、機器人位置與關(guān)節(jié)變量的關(guān)系二、機器人位置與關(guān)節(jié)變量的關(guān)系 1 1表示方法表示方法 以手爪位置與關(guān)節(jié)變量之間的關(guān)系為例，以手爪位置與關(guān)節(jié)變量之間的關(guān)系為例，要想正確表示機器人的手爪位置和姿態(tài)，就要要想正確表示機器人的手爪位置和姿態(tài)，就要首先建立坐標(biāo)系，如圖首先建立坐標(biāo)系，如圖3 33 3所示，應(yīng)分別定義所示，應(yīng)分別定義固定機器人的基座和手爪的坐標(biāo)系，這樣才能固定機器人的基座和手爪的坐標(biāo)系，這樣才能很好地描述它們之間的位置和姿態(tài)之間的關(guān)系很好地描述它們之間的位置和姿態(tài)之間的關(guān)系。 圖圖3 33 3 基準(zhǔn)坐標(biāo)系和手爪坐

8、標(biāo)系基準(zhǔn)坐標(biāo)系和手爪坐標(biāo)系 基準(zhǔn)坐標(biāo)系基準(zhǔn)坐標(biāo)系,固定在基座上固定在基座上 BE手爪坐標(biāo)系手爪坐標(biāo)系 ，固定在手爪上，固定在手爪上 2姿態(tài)的變換矩陣姿態(tài)的變換矩陣 如圖如圖3 34 4所示，給出原點重合的兩坐標(biāo)系所示，給出原點重合的兩坐標(biāo)系 ()AAAAOX Y()BBBBOX Y則假設(shè)點則假設(shè)點 P 的位置的位置p 向量的向量的分量在兩坐標(biāo)系中分別表示分量在兩坐標(biāo)系中分別表示為為 AxAAyppp BxBByppp 13則從則從 向向 的變換為：的變換為：ABAT AATxxxBABAABAT AATyyypepeppRppepeApBpATxBAATyeRe 其中：其中：它是從它是從 坐標(biāo)

9、向坐標(biāo)進行位置向坐標(biāo)向坐標(biāo)進行位置向 量姿態(tài)變換量姿態(tài)變換的矩陣，稱為姿態(tài)變換矩陣（或旋轉(zhuǎn)矩陣）。的矩陣，稱為姿態(tài)變換矩陣（或旋轉(zhuǎn)矩陣）。 B為了加深印象，現(xiàn)在分析如圖為了加深印象，現(xiàn)在分析如圖3 35 5所示坐標(biāo)系所示坐標(biāo)系 ，它是將，它是將 圍繞圍繞 Z Z軸沿正方向旋轉(zhuǎn)角軸沿正方向旋轉(zhuǎn)角 后構(gòu)成后構(gòu)成的坐標(biāo)系。的坐標(biāo)系。pp211000cossin0sincos222ZYXO111ZYXO圖圖35 兩個坐標(biāo)系的旋轉(zhuǎn)坐標(biāo)變換兩個坐標(biāo)系的旋轉(zhuǎn)坐標(biāo)變換因此，在坐標(biāo)系因此，在坐標(biāo)系 上表示的坐標(biāo)上表示的坐標(biāo) 與在將坐標(biāo)系與在將坐標(biāo)系 繞繞Z Z軸沿正方向旋轉(zhuǎn)角軸沿正方向旋轉(zhuǎn)角得到的坐標(biāo)系得到的坐

10、標(biāo)系 上表示的上表示的坐標(biāo)坐標(biāo) 之間，存在下列關(guān)系式：之間，存在下列關(guān)系式： p1111ZYXO 222ZYXO p2pp211000cossin0sincos由上面知從由上面知從 坐標(biāo)系向坐標(biāo)系坐標(biāo)系向坐標(biāo)系 的坐標(biāo)變換矩陣為：的坐標(biāo)變換矩陣為： 111ZYXO 222ZYXO 1000cossin0sincos21R 因為上述變換是把某一坐標(biāo)系上表示的坐標(biāo)因為上述變換是把某一坐標(biāo)系上表示的坐標(biāo)，表示到另一坐標(biāo)系中，因此有時也稱它為坐標(biāo)，表示到另一坐標(biāo)系中，因此有時也稱它為坐標(biāo)變換。在該例子中是從變換。在該例子中是從 坐標(biāo)系向坐標(biāo)系坐標(biāo)系向坐標(biāo)系 的坐標(biāo)變換，由于坐標(biāo)系的坐標(biāo)變換，由于坐標(biāo)系

11、 是是 圍繞圍繞Z軸旋轉(zhuǎn)軸旋轉(zhuǎn)角后構(gòu)成的坐標(biāo)系，則該角后構(gòu)成的坐標(biāo)系，則該坐標(biāo)變換矩陣也可用坐標(biāo)變換矩陣也可用 來表示來表示111ZYXO 222ZYXO 222ZYXO 111ZYXO )(zR1000cossin0sincos)(21RRz 同理，上述例子中，當(dāng)考慮圍繞著同理，上述例子中，當(dāng)考慮圍繞著 x軸旋轉(zhuǎn)時（設(shè)軸旋轉(zhuǎn)時（設(shè)其旋轉(zhuǎn)量其旋轉(zhuǎn)量為），可得到如下關(guān)系式：為），可得到如下關(guān)系式： ppRpx221cossin0sincos0001)(另外，當(dāng)圍繞著軸另外，當(dāng)圍繞著軸y y旋轉(zhuǎn)時（設(shè)其旋轉(zhuǎn)量旋轉(zhuǎn)時（設(shè)其旋轉(zhuǎn)量為），可表示為），可表示為如下關(guān)系式為如下關(guān)系式 ppRpy221cos

12、0sin010sin0cos)(可以驗證可以驗證 該矩陣為單位矩陣式中該矩陣為單位矩陣式中* *表示表示 x x、y y 、z z中的任中的任何一個。所以有下列等式成立何一個。所以有下列等式成立 在分析機器人運動時，當(dāng)只用圍繞一個軸旋轉(zhuǎn)在分析機器人運動時，當(dāng)只用圍繞一個軸旋轉(zhuǎn)不能表示時，可以通過圍繞幾個軸同時旋轉(zhuǎn)的不能表示時，可以通過圍繞幾個軸同時旋轉(zhuǎn)的組合方式進行表示。組合方式進行表示。 )(xR)(yR)(zR均滿足均滿足 100010001)()(TRRxTRR)()(13 3齊次變換齊次變換 前面討論了機器人在進行旋轉(zhuǎn)運動前面討論了機器人在進行旋轉(zhuǎn)運動時的坐標(biāo)變換，一般來說，機器人的運

13、時的坐標(biāo)變換，一般來說，機器人的運動不僅是旋轉(zhuǎn)運動，有時要做平行移動動不僅是旋轉(zhuǎn)運動，有時要做平行移動，或以上兩種運動的合成，因此也應(yīng)考，或以上兩種運動的合成，因此也應(yīng)考慮平移運動時的坐標(biāo)變換，即齊次變換慮平移運動時的坐標(biāo)變換，即齊次變換?，F(xiàn)在來看下圖的兩個坐標(biāo)系，現(xiàn)在來看下圖的兩個坐標(biāo)系，坐標(biāo)系坐標(biāo)系 是將坐標(biāo)系是將坐標(biāo)系 單獨地平行移動單獨地平行移動 后，再后，再進行適當(dāng)?shù)匦D(zhuǎn)得到的坐標(biāo)系。進行適當(dāng)?shù)匦D(zhuǎn)得到的坐標(biāo)系。2222ZYXO 1111ZYXO 0p 這時，某一點這時，某一點P其在坐標(biāo)系其在坐標(biāo)系 和和 上的坐標(biāo)分別為上的坐標(biāo)分別為p 1 、p2 ，可以認(rèn)為，可以認(rèn)為 p 1 是由

14、是由p2旋轉(zhuǎn)而進行坐標(biāo)變換后，即乘以旋轉(zhuǎn)坐標(biāo)變換旋轉(zhuǎn)而進行坐標(biāo)變換后，即乘以旋轉(zhuǎn)坐標(biāo)變換 R，在加上表示平移的向量，在加上表示平移的向量 p0而得到的，因此可寫而得到的，因此可寫出下列表達式：出下列表達式：1111ZYXO 2222ZYXO 021pRpp 因旋轉(zhuǎn)而進行的坐標(biāo)變換，與因平移而進因旋轉(zhuǎn)而進行的坐標(biāo)變換，與因平移而進行的坐標(biāo)變換，可以用一個坐標(biāo)變換矩陣來表行的坐標(biāo)變換，可以用一個坐標(biāo)變換矩陣來表示，記為示，記為A ，稱這個矩陣，稱這個矩陣 A為齊次坐標(biāo)變換矩為齊次坐標(biāo)變換矩陣，或簡稱為坐標(biāo)變換矩陣，表示為：陣，或簡稱為坐標(biāo)變換矩陣，表示為：100pRA三、機器人的運動學(xué)的一般表示三

15、、機器人的運動學(xué)的一般表示 前面所介紹的是任意兩個坐標(biāo)系之間的坐標(biāo)前面所介紹的是任意兩個坐標(biāo)系之間的坐標(biāo)變換，我們知道，機器人一般是有多個關(guān)節(jié)組成變換，我們知道，機器人一般是有多個關(guān)節(jié)組成的，各關(guān)節(jié)之間的坐標(biāo)變換可以通過坐標(biāo)變換相的，各關(guān)節(jié)之間的坐標(biāo)變換可以通過坐標(biāo)變換相乘后，結(jié)合在一起進行求解。如前所述，可以把乘后，結(jié)合在一起進行求解。如前所述，可以把機器人的運動模型看作是一系列由關(guān)節(jié)連接起來機器人的運動模型看作是一系列由關(guān)節(jié)連接起來的連桿機構(gòu)。一般機器人具有個自由度，為了分的連桿機構(gòu)。一般機器人具有個自由度，為了分析其運動，可將上述方法擴展一下。析其運動，可將上述方法擴展一下。 通常把描述

16、一個連桿與下一個連桿間相對關(guān)系通常把描述一個連桿與下一個連桿間相對關(guān)系的齊次變換稱為的齊次變換稱為A矩陣。一個矩陣。一個A矩陣就是一個矩陣就是一個描述連桿坐標(biāo)系間相對平移和旋轉(zhuǎn)的齊次變換描述連桿坐標(biāo)系間相對平移和旋轉(zhuǎn)的齊次變換。如果用。如果用 表示第一個連桿在基系的位置和表示第一個連桿在基系的位置和姿態(tài)，姿態(tài)， 表示第二個連桿相對第一個連桿的位表示第二個連桿相對第一個連桿的位置和姿態(tài)，那么第二個連桿在基系的位置和姿置和姿態(tài)，那么第二個連桿在基系的位置和姿態(tài)可由下列矩陣的乘積求得態(tài)可由下列矩陣的乘積求得 01A12A12012AAT 同理，若同理，若 表示第三個連桿相對第二個連桿表示第三個連桿相

17、對第二個連桿的位置和姿態(tài)，那么第三個連桿在基系的位置的位置和姿態(tài)，那么第三個連桿在基系的位置和姿態(tài)可由下列矩陣的乘積求得和姿態(tài)可由下列矩陣的乘積求得 23A2312013AAAT 于是，對于六連桿的機器人，有下列矩陣于是，對于六連桿的機器人，有下列矩陣 成立成立一般，每個連桿有一個自由度，則六連桿組成的一般，每個連桿有一個自由度，則六連桿組成的機器人具有六個自由度，并能在其運動范圍內(nèi)任機器人具有六個自由度，并能在其運動范圍內(nèi)任意定位與定向。其中，三個自由度用于規(guī)定位置意定位與定向。其中，三個自由度用于規(guī)定位置，另外三個自由度用來規(guī)定姿態(tài)。所以，表示了，另外三個自由度用來規(guī)定姿態(tài)。所以，表示了機

18、器人的位置和姿態(tài)。機器人的位置和姿態(tài)。 5645342312016AAAAAAT 對于具有對于具有n個關(guān)節(jié)的機器人，若設(shè)坐標(biāo)系個關(guān)節(jié)的機器人，若設(shè)坐標(biāo)系 為固定在指尖上的坐標(biāo)系時，則從坐標(biāo)系為固定在指尖上的坐標(biāo)系時，則從坐標(biāo)系 到基準(zhǔn)坐標(biāo)系到基準(zhǔn)坐標(biāo)系 的坐標(biāo)變換矩陣的坐標(biāo)變換矩陣T可由下可由下式給出：式給出： T 不僅是從不僅是從 坐標(biāo)系到坐標(biāo)系坐標(biāo)系到坐標(biāo)系 的坐標(biāo)變換，而且同時還可以解釋為在基準(zhǔn)坐標(biāo)的坐標(biāo)變換，而且同時還可以解釋為在基準(zhǔn)坐標(biāo)系系 上看到的表示指尖位置和方向的矩上看到的表示指尖位置和方向的矩陣。陣。 nnnnzyxO nnnnzyxO 0000zyxO 1231201 nn

19、nAAAATnnnnzyxO 0000zyxO 0000zyxO 四、機器人運動問題的示例四、機器人運動問題的示例 1機器人正運動學(xué)問題機器人正運動學(xué)問題 機器人正運動學(xué)問題就是求機器人運動學(xué)機器人正運動學(xué)問題就是求機器人運動學(xué)的正解（的正解（forward kinematics），即在給定），即在給定組成運動副的相鄰連桿的相對位置情況下，確組成運動副的相鄰連桿的相對位置情況下，確定機器人末端執(zhí)行器的位置和姿態(tài)。通過上述定機器人末端執(zhí)行器的位置和姿態(tài)。通過上述分析可知，運動學(xué)正解可用一個反映此相對關(guān)分析可知，運動學(xué)正解可用一個反映此相對關(guān)系的變換矩陣來表示，這里一般是指開式鏈的系的變換矩陣來表

20、示，這里一般是指開式鏈的機器人結(jié)構(gòu)。機器人結(jié)構(gòu)。 以一個以一個6自由度的機器人為例，如圖所示，自由度的機器人為例，如圖所示，在該機器人中，除第在該機器人中，除第3個關(guān)節(jié)為平移關(guān)節(jié)外個關(guān)節(jié)為平移關(guān)節(jié)外，其余均為旋轉(zhuǎn)關(guān)節(jié)。，其余均為旋轉(zhuǎn)關(guān)節(jié)。 對于這個機器人，根據(jù)圖中表示的坐標(biāo)系對于這個機器人，根據(jù)圖中表示的坐標(biāo)系 為基準(zhǔn)坐標(biāo)系，正運動學(xué)問題就是求該機器人末端為基準(zhǔn)坐標(biāo)系，正運動學(xué)問題就是求該機器人末端手指關(guān)節(jié)手指關(guān)節(jié)6的位置和姿態(tài)，也就是在基準(zhǔn)坐標(biāo)系上看的位置和姿態(tài)，也就是在基準(zhǔn)坐標(biāo)系上看關(guān)節(jié)關(guān)節(jié)6，因此找出由，因此找出由 到到 的坐的坐標(biāo)變換矩陣標(biāo)變換矩陣T即可。即可。也就是表示這個機器人的末

21、也就是表示這個機器人的末端指尖的位置和方向，可以由下式給出：端指尖的位置和方向，可以由下式給出： 0000zyxO 6666zyxO 0000zyxO )()()()()()(656545434323212101AAAdAAAT 其中其中10000100cos0sin0sin0cos)(01111101lA10000100cos0sin0sin0cos)(12222212lA100010000100001)(3323ddA100000100cos0sin0sin0cos)(4444434A100000100cos0sin0sin0cos)(5555545A100000100cos0sin0si

22、n0cos)(4444434A100000100cos0sin0sin0cos)(5555545A100010000cossin00sincos)(26666656lA上式即為該上式即為該6自由度機器人的運動學(xué)正解。對于自由度機器人的運動學(xué)正解。對于不同類型的機器人，其坐標(biāo)變換矩陣的形式不同不同類型的機器人，其坐標(biāo)變換矩陣的形式不同，要根據(jù)實際結(jié)構(gòu)求得。，要根據(jù)實際結(jié)構(gòu)求得。 2 2機器人逆運動學(xué)機器人逆運動學(xué) 機器人的逆解問題比較復(fù)雜，為了說明問題，下面機器人的逆解問題比較復(fù)雜，為了說明問題，下面先以先以2自由度的機器人為例。自由度的機器人為例。如圖所示，已知機器人末端的坐標(biāo)值（如圖所示，已

23、知機器人末端的坐標(biāo)值（x,y） ，試?yán)?，試?yán)?x,y表示表示 2 2 根據(jù)圖中的幾何關(guān)系可知： )cos(cos21211llx)sin(sin21211lly （338） （339） 聯(lián)立求解上述兩方程，可分別求出聯(lián)立求解上述兩方程，可分別求出 的表達式。的表達式。21,221222122cos2llllyx因此可進一步得到：因此可進一步得到： )2(cos2122212212llllyx將該式代入前面的幾何表達式就可求出的將該式代入前面的幾何表達式就可求出的 表達式。表達式。 1 從機器人的手爪末端位置姿態(tài)出發(fā)從機器人的手爪末端位置姿態(tài)出發(fā)，可以求出機器人對應(yīng)的各關(guān)節(jié)的角度，可以求出機

24、器人對應(yīng)的各關(guān)節(jié)的角度。該例的機器人是屬于平面多關(guān)節(jié)機器。該例的機器人是屬于平面多關(guān)節(jié)機器人，對于一般的機械手來講，其求解過人，對于一般的機械手來講，其求解過程比較復(fù)雜，往往其解不是唯一的。請程比較復(fù)雜，往往其解不是唯一的。請有興趣的愛好者參考相關(guān)的文獻書籍。有興趣的愛好者參考相關(guān)的文獻書籍。 第三節(jié)第三節(jié) 機器人的雅可比矩陣機器人的雅可比矩陣 一、雅可比矩陣的定義一、雅可比矩陣的定義 前面討論了機器人的指尖位置和方向與前面討論了機器人的指尖位置和方向與各關(guān)節(jié)的變化位置之間的關(guān)系。在本節(jié)各關(guān)節(jié)的變化位置之間的關(guān)系。在本節(jié)將進一步討論指尖的速度與各關(guān)節(jié)的速將進一步討論指尖的速度與各關(guān)節(jié)的速度（轉(zhuǎn)

25、動或平移）之間的關(guān)系。度（轉(zhuǎn)動或平移）之間的關(guān)系?？紤]機械手的手爪位置考慮機械手的手爪位置r和關(guān)節(jié)變量和關(guān)節(jié)變量的的關(guān)系用正運動學(xué)方程表示如下：關(guān)系用正運動學(xué)方程表示如下： 假定這里考慮的是假定這里考慮的是 )(fr 121, mTmRrrrr121, nTmR的一般情況，并設(shè)手爪位置包含表示姿態(tài)的變量，的一般情況，并設(shè)手爪位置包含表示姿態(tài)的變量，以及關(guān)節(jié)變量由回轉(zhuǎn)角和平移組合而成的情況。以及關(guān)節(jié)變量由回轉(zhuǎn)角和平移組合而成的情況。（355）若用每個分量表示，則變?yōu)槿粲妹總€分量表示，則變?yōu)?在在 的情況下，將變?yōu)槭肿ξ恢玫年P(guān)節(jié)變量的情況下，將變?yōu)槭肿ξ恢玫年P(guān)節(jié)變量有無限個解的冗余機器人。而工業(yè)上

26、常用的多有無限個解的冗余機器人。而工業(yè)上常用的多關(guān)節(jié)機器人手臂，通常用于作業(yè)的所需手爪應(yīng)關(guān)節(jié)機器人手臂，通常用于作業(yè)的所需手爪應(yīng)有有3個位置變量和個位置變量和3個姿態(tài)變量，總計個姿態(tài)變量，總計6個變量個變量。而且由于不采用冗余機器人結(jié)構(gòu)，所以。而且由于不采用冗余機器人結(jié)構(gòu)，所以),(21njjfr ), 2 , 1(mj mn6 mn將式（355）的兩邊對時間微分，可得到下式 Jr （357）其中 nmnmmnTRfffffJ 1111)(（358）稱稱 為雅可比矩陣（為雅可比矩陣（Jacobian matrix）。若）。若在式（在式（357）的兩邊乘以微小時間）的兩邊乘以微小時間 ，則可，則

27、可得到得到 JdtJddr （359）該式是用雅可比矩陣表示微小位移間關(guān)系的關(guān)系式。該式是用雅可比矩陣表示微小位移間關(guān)系的關(guān)系式。 二、與平移速度相關(guān)的雅可比矩陣二、與平移速度相關(guān)的雅可比矩陣 現(xiàn)在設(shè)基準(zhǔn)坐標(biāo)系為現(xiàn)在設(shè)基準(zhǔn)坐標(biāo)系為 ，固定于指尖，固定于指尖的坐標(biāo)系為的坐標(biāo)系為 ，在，在 上表示的上表示的的坐標(biāo)為的坐標(biāo)為 ，則，則 可以表示如下：可以表示如下： 0000zyxO eeeezyxO 0000zyxO eOePeP)(1000qfTPe（360） 這時，指尖的平移速度可以寫成：這時，指尖的平移速度可以寫成： qJdtdqJdtdqdqdfdtdPvLLe（361） 式中，式中， ，其

28、中，其中 是關(guān)節(jié)的數(shù)目。這是關(guān)節(jié)的數(shù)目。這里的里的 稱為與平移速度相關(guān)的雅可比矩陣。稱為與平移速度相關(guān)的雅可比矩陣。 Tnqqq),(1 nLJ下面以下面以2自由度機械手為例，如前面圖自由度機械手為例，如前面圖32所所示的示的2自由度機械手的雅可比矩陣。前面已推自由度機械手的雅可比矩陣。前面已推導(dǎo)過，該機器人的指尖位置可以表示為導(dǎo)過，該機器人的指尖位置可以表示為 )cos(cos21211llx)sin(sin21211lly則與這個機器人的平移速度相關(guān)的雅可比矩陣則與這個機器人的平移速度相關(guān)的雅可比矩陣，可以下列形式給出：，可以下列形式給出： )cos()cos(cos)sin()sin(s

29、in21221211212212112121llllllyyxxJL（363） 現(xiàn)在，我們來討論一下現(xiàn)在，我們來討論一下 的各列向量的幾何學(xué)意的各列向量的幾何學(xué)意義，即在義，即在 時，考慮時，考慮 ， 的幾何學(xué)的幾何學(xué)意義。根據(jù)式（意義。根據(jù)式（363），）， 是在時是在時 ，也就，也就是第是第2關(guān)節(jié)固定時，僅在第關(guān)節(jié)固定時，僅在第1關(guān)節(jié)轉(zhuǎn)動的情況下，關(guān)節(jié)轉(zhuǎn)動的情況下，指尖平移速度在基準(zhǔn)坐標(biāo)系上表示出的向量。指尖平移速度在基準(zhǔn)坐標(biāo)系上表示出的向量。同樣，同樣， 是第是第1關(guān)節(jié)固定時，僅在第關(guān)節(jié)固定時，僅在第2關(guān)節(jié)轉(zhuǎn)動關(guān)節(jié)轉(zhuǎn)動的情況下，指尖平移速度在基準(zhǔn)坐標(biāo)系上表示出的情況下，指尖平移速度在基準(zhǔn)

30、坐標(biāo)系上表示出的向量。的向量。 LJ),(21LLLJJJ1LJ2LJ1LJ022LJ因此，當(dāng)用圖表示因此，當(dāng)用圖表示 和和 時，就變成了時，就變成了如圖所示的情況。如圖所示的情況。 11LJ22LJ 圖圖39 和和 的幾何學(xué)說明的幾何學(xué)說明 11LJ22LJ三、與旋轉(zhuǎn)速度相關(guān)的雅可比矩陣三、與旋轉(zhuǎn)速度相關(guān)的雅可比矩陣 一般來講，指尖的旋轉(zhuǎn)速度表示方法，有以下一般來講，指尖的旋轉(zhuǎn)速度表示方法，有以下兩種類型：兩種類型： 1考慮由表示指尖方向的三變量組合（例如為考慮由表示指尖方向的三變量組合（例如為歐拉角）構(gòu)成向量歐拉角）構(gòu)成向量 ，然后由它對時間的微分，然后由它對時間的微分 進行表示的一種方法

31、。進行表示的一種方法。2以基準(zhǔn)坐標(biāo)系的各坐標(biāo)軸作為旋轉(zhuǎn)軸，以分以基準(zhǔn)坐標(biāo)系的各坐標(biāo)軸作為旋轉(zhuǎn)軸，以分別圍繞各旋轉(zhuǎn)軸的角速度作為分量構(gòu)成向量別圍繞各旋轉(zhuǎn)軸的角速度作為分量構(gòu)成向量 ，然后用然后用 進行表示的方法。進行表示的方法。 在第二種表示方法中，可以把在第二種表示方法中，可以把 解釋為在基準(zhǔn)解釋為在基準(zhǔn)坐標(biāo)系上，圍繞坐標(biāo)系上，圍繞x軸，軸，y軸和軸和 z軸的旋轉(zhuǎn)速度的軸的旋轉(zhuǎn)速度的合成，因為物理意義明確。這時，公式合成，因為物理意義明確。這時，公式 qJA（364） 其中矩陣其中矩陣JA稱為與旋轉(zhuǎn)速度相關(guān)的雅可比矩陣。稱為與旋轉(zhuǎn)速度相關(guān)的雅可比矩陣。 四、雅可比矩陣的計算方法四、雅可比矩陣的

32、計算方法 考慮一般情況，如六維向量，它可以指尖的平考慮一般情況，如六維向量，它可以指尖的平移速度和旋轉(zhuǎn)速度作為其向量的分量，即移速度和旋轉(zhuǎn)速度作為其向量的分量，即 vp （365） 這時，若采用這時，若采用 和和 表示機器人的雅可比表示機器人的雅可比矩陣，則表示矩陣，則表示 LJAJqJJqJpAL（366） 這里，為了計算雅可比矩陣中的各分量，需對進這里，為了計算雅可比矩陣中的各分量，需對進一步作下列分割一步作下列分割 式中，式中，n為機器人的關(guān)節(jié)數(shù)，為機器人的關(guān)節(jié)數(shù)， 和和 分別表示分別表示 和和 的第個列向量。而的第個列向量。而 和和 則分別表則分別表示只有第示只有第i個關(guān)節(jié)以速度個關(guān)節(jié)以速度 運行，其他的關(guān)節(jié)運行，其他的關(guān)節(jié)都固定時的指尖平移速度向量