工業(yè)機(jī)器人第二章

第二章位姿描述與齊次變換§2.1操作機(jī)器人工作過(guò)程分析一、操作機(jī)器人：具有和人類上肢相似的動(dòng)作功能，用于操作作業(yè)的機(jī)器人，稱為～。二、人類操作過(guò)程分析(先看人?。?板擦黑板→講臺(tái)：（眼）定位（手）到位(手）抓?。ㄊ直郏┻\(yùn)動(dòng)（手臂）停止（手）松開(kāi)…工作方法？手眼協(xié)調(diào)?。捎糜跈C(jī)器人嗎？）關(guān)鍵：位置（＋姿態(tài)），動(dòng)作順序，動(dòng)作要求三、機(jī)器人的典型工作分析（如何讓機(jī)器人完成？）：

1、軸孔類裝配

兩個(gè)基本問(wèn)題： （1）動(dòng)作順序及要求； （2）位置及姿態(tài)要求。

2、弧焊作業(yè)： 也需要解決上述兩個(gè)基本問(wèn)題！

3、搬運(yùn)作業(yè)（例如碼垛） （結(jié)論同上）

4、其它操作作業(yè)（噴漆、上下料、點(diǎn)焊、…）

操作機(jī)器人工作任務(wù)描述兩個(gè)基本問(wèn)題！ 關(guān)鍵：位姿描述！四、位姿定義：

位置和姿態(tài)合稱～。 （Position)(orientation)(pose)一、位姿表達(dá)

1、表達(dá)方式： 位置＋姿態(tài)

§2.2位姿描述與變換位姿可以用一個(gè)直角坐標(biāo)系表達(dá)，簡(jiǎn)記為：三個(gè)坐標(biāo)軸空間點(diǎn)坐標(biāo)原點(diǎn)空間方位（線、面、體）2、特點(diǎn)：

位姿描述是相對(duì)的！

坐標(biāo)系在坐標(biāo)系中的位置：點(diǎn)在中的坐標(biāo)值。二、位置描述數(shù)學(xué)表達(dá)式：參考坐標(biāo)系描述對(duì)象矢量表達(dá)形式坐標(biāo)值形式三、姿態(tài)描述為了方便起見(jiàn)，先以平面坐標(biāo)系為例進(jìn)行講解，然后推廣到三維情況！如右圖所示，先將平移到，然后繞旋轉(zhuǎn)得到現(xiàn)在求的兩個(gè)坐標(biāo)軸在坐標(biāo)系中的姿態(tài)。坐標(biāo)軸的姿態(tài)值可用其單位矢量在參考坐標(biāo)系中的投影值表示！注意！ 由于笛卡兒坐標(biāo)系各個(gè)坐標(biāo)軸之間存在內(nèi)部約束，因此坐標(biāo)系的姿態(tài)描述一般是冗余的。例如在平面坐標(biāo)系情況下，只有一個(gè)獨(dú)立量

已知某點(diǎn)在中的位置，試求其在中的位置值。四、絕對(duì)描述由幾何學(xué)可知，要求出一點(diǎn)在絕對(duì)坐標(biāo)系中的位置，關(guān)鍵是求出其在中的位置，然后與坐標(biāo)原點(diǎn)值相加即可得到該點(diǎn)絕對(duì)位置。由幾何法，得：寫(xiě)成矩陣形式？相對(duì)坐標(biāo)值分析：

該矩陣的出現(xiàn)是由于相對(duì)于旋轉(zhuǎn)造成的，即是由姿態(tài)引起的；（1）矩陣第一列：在中的姿態(tài)；（2）矩陣第二列：在中的姿態(tài)。五、姿態(tài)矩陣由坐標(biāo)系三個(gè)坐標(biāo)軸的姿態(tài)構(gòu)成的矩陣，稱為～。六、齊次表達(dá)根據(jù)幾何學(xué)知識(shí)，上面第四小節(jié)中給定點(diǎn)的絕對(duì)位置為：

比較此矩陣與在中的姿態(tài)表達(dá)式，可知：

在中姿態(tài)，記作。寫(xiě)成三維形式，有：

在中位置，記作分成兩塊，不便于記憶！若寫(xiě)成如下齊次形式，有：齊次變換矩陣七、齊次變換矩陣1.構(gòu)成：分為4塊。左上角是姿態(tài)矩陣，為一單位正交矩陣；右上角為對(duì)象坐標(biāo)系原點(diǎn)位置值；左下角為三個(gè)000，簡(jiǎn)記為0；右下角為1。（1）相對(duì)于描述的的位姿（從數(shù)學(xué)角度）；（2）把變換到的結(jié)果（從運(yùn)動(dòng)角度）。位姿描述的關(guān)鍵是求得其齊次變換矩陣！八、基本變換矩陣（應(yīng)牢記?。。。?.平移矩陣：2.含義：參考坐標(biāo)系未標(biāo)出，原因？2.繞X軸旋轉(zhuǎn)角（學(xué)生課堂推導(dǎo)?。?.繞Y軸旋轉(zhuǎn)角（課堂推導(dǎo)！）4.繞Z軸旋轉(zhuǎn)角（課堂推導(dǎo)?。┧膫€(gè)基本變換，要牢記?。ㄈ绾斡?？）九、多次變換機(jī)器人一般由多個(gè)桿件構(gòu)成，為了到達(dá)某一位姿往往需要各個(gè)桿件都做出運(yùn)動(dòng)，因此存在多次變換問(wèn)題；第四節(jié)中的絕對(duì)變換結(jié)果是通過(guò)幾何法求得的，不能總用此法計(jì)算機(jī)器人位姿（？）。如何計(jì)算多次變換結(jié)果？1.幾何法計(jì)算結(jié)果：分析：2.運(yùn)動(dòng)過(guò)程分析從運(yùn)動(dòng)到，可以分解成如下幾個(gè)基本變換：平移變換：繞旋轉(zhuǎn)：3.試按照運(yùn)動(dòng)順序計(jì)算相關(guān)基本變換矩陣相乘結(jié)果4.計(jì)算結(jié)果比較兩種方法結(jié)果相同！但后一種方法簡(jiǎn)單！問(wèn)題：是否僅僅按照運(yùn)動(dòng)變換順序?qū)⑾嚓P(guān)的基本變換矩陣相乘，即可以得到齊次變換陣？5.驗(yàn)證計(jì)算（繪圖即可）結(jié)論：

多次變換結(jié)果不僅與變換順序有關(guān)，而且與相對(duì)的坐標(biāo)系有關(guān)！ （1）必須正確確定變換順序！ （2）必須正確確定每次變換所相對(duì)的坐標(biāo)系的性質(zhì)！

若每次變換都是相對(duì)于前一個(gè)坐標(biāo)系進(jìn)行的，則變換結(jié)果等于各個(gè)基本變換矩陣順序相乘；若每次變換都是相對(duì)于參考坐標(biāo)系進(jìn)行的，則變換結(jié)果等于各個(gè)基本變換矩陣逆序相乘；問(wèn)題：上述結(jié)論只是根據(jù)2次變換得到的，適應(yīng)于多次嗎？十、相對(duì)變換、絕對(duì)變換相對(duì)變換：若變換是相對(duì)于上一次變換得到的坐標(biāo)系進(jìn)行的，則稱為～。絕對(duì)變換：若變換是相對(duì)于參考坐標(biāo)系進(jìn)行的，則稱為～。相對(duì)變換結(jié)果：

順序相乘！絕對(duì)變換結(jié)果：

逆序相乘！十一、左乘、右乘左乘：在某一變換矩陣左面乘以一個(gè)矩陣絕對(duì)變換右乘：在某一變換矩陣右面乘以一個(gè)矩陣相對(duì)變換若確定了變換性質(zhì)，就沒(méi)必要再標(biāo)出所相對(duì)的坐標(biāo)系了！十二、逆變換已知，求物理含義：已知，問(wèn)如把再變回到，其齊次變換矩陣＝？用途：機(jī)器人運(yùn)動(dòng)控制！求法： （1）矢量法（不講，請(qǐng)同學(xué)自己做，作業(yè)） （2）解析法設(shè)：由于其逆變換陣仍然為齊次矩陣，因此可以假設(shè)：此外，有：∵∴有：即：利用矩陣塊乘法，得：（利用單位正交矩陣性質(zhì)）則：§2.3非直角坐標(biāo)系描述前面講的是如何用直角坐標(biāo)系進(jìn)行位姿描述及變換，其方法適用于所有機(jī)器人。但對(duì)某些機(jī)器人，用其它非直角坐標(biāo)系描述可能更為方便。一、圓柱坐標(biāo)系圓柱坐標(biāo)機(jī)器人（圖2－1）典型應(yīng)用場(chǎng)合：機(jī)床上下料位姿描述參數(shù)：圖2－1主要特點(diǎn)：機(jī)構(gòu)特點(diǎn)：運(yùn)動(dòng)特點(diǎn)：優(yōu)缺點(diǎn)：P-R-P水平面內(nèi)相對(duì)姿態(tài)不變特別適合搬運(yùn)，占地大，平衡性差，…二、極坐標(biāo)系極坐標(biāo)機(jī)器人（圖2－2）典型應(yīng)用場(chǎng)合：空間運(yùn)用位姿描述參數(shù)：圖2－2主要特點(diǎn)：機(jī)構(gòu)特點(diǎn)：運(yùn)動(dòng)特點(diǎn)：優(yōu)缺點(diǎn)：R-R-P極坐標(biāo)式運(yùn)動(dòng)占地小，工作空間大，運(yùn)動(dòng)控制較復(fù)雜，…坐標(biāo)系選擇原則：

視方便而定。一般情況下，上述兩種機(jī)器人采用專用坐標(biāo)系更方便。三、RPY(Roll,Pitch,Yaw)角直角坐標(biāo)系位姿描述法： 位置：坐標(biāo)原點(diǎn)，3個(gè)參數(shù)； 姿態(tài)：3根坐標(biāo)軸，3×3矩陣，9個(gè)參數(shù)。姿態(tài)矩陣9個(gè)參數(shù)中只有3個(gè)是獨(dú)立的！可否只用3個(gè)量完成姿態(tài)描述？如何求得？RPY角（圖2－3）：Roll:（繞本身縱軸－Z軸）側(cè)滾Pitch:（前后-繞Y軸）俯仰Yaw:偏航（繞X軸）側(cè)滾俯仰偏航RPY變換過(guò)程：各運(yùn)動(dòng)均是相對(duì)于當(dāng)前參考坐標(biāo)系進(jìn)行的！圖2－3RPY變換結(jié)果（絕對(duì)變換）：四、歐拉角變換過(guò)程1（Z-Y-X)：變換過(guò)程2(Z-Y-Z)