1、工業(yè)機器人技術(shù)課程總結(jié) 任課： 班級： 學(xué)號： 姓名： 之前在工廠實習(xí)見識和操作過很多工業(yè)機器人，有焊接機器人，涂裝機器人，總裝機器人等，但是學(xué)習(xí)了蓋老師教授的工業(yè)機器人課程，才真正算是進入了工業(yè)機器人的理論世界學(xué)習(xí)機器人的相關(guān)知識。以下是課程總結(jié)。1、 第一章主要是對機器人的概述，從機器人的功能和應(yīng)用、機器人的機構(gòu)以及機器人的規(guī)格全面呈現(xiàn)學(xué)習(xí)機器人的框架。研制機器人的最初目的是為了幫助人們擺脫繁重勞動或簡單的重復(fù)勞動，以及替代人到有輻射等危險環(huán)境中進行作業(yè)，因此機器人最早在汽車制造業(yè)和核工業(yè)領(lǐng)域得以應(yīng)用。隨著機器人技術(shù)的不斷發(fā)展，工業(yè)領(lǐng)域的焊接、噴漆、搬運、裝配、鑄造等場合，己經(jīng)開始大量使用

2、機器人。另外在軍事、海洋探測、航天、醫(yī)療、農(nóng)業(yè)、林業(yè)甚到服務(wù)娛樂行業(yè)，也都開始使用機器人。本書主要介紹工業(yè)機器人，對譬如軍用機器人等涉及不多。機器人的機構(gòu)方面，主要介紹了操作臂的工作空間形式、手腕、手爪、和閉鏈結(jié)構(gòu)操作臂。工作空間形式常見的有直角坐標式機器人、圓柱坐標式機器人、球（極）坐標式機器人、SCARA機器人以及關(guān)節(jié)式機器人。手腕的形式也可分為二自由度球形手腕、三軸垂直相交的手腕以及連續(xù)轉(zhuǎn)動手腕。同時手爪也可分為夾持式手爪、多關(guān)節(jié)多指手爪、順應(yīng)手爪。機器人的其他規(guī)格主要介紹驅(qū)動方式、自動插補放大、坐標軸數(shù)、工作空間、承載能力、速度和循環(huán)時間、定位基準和重復(fù)性以及機器人的運行環(huán)境。第一章的

3、內(nèi)容主要是對機器人各個方面有個簡單的介紹使機器人更形象化和具體化。工業(yè)機器人定義為一種擬人手臂、手腕和手功能的機電一體化裝置，能將對象或工具按照空間位置姿態(tài)的要求移動，從而完成某一生產(chǎn)的作業(yè)要求。工業(yè)機械應(yīng)用：主要代替人從事危險、有害、有毒、低溫和高熱等惡劣環(huán)境中的工作；代替人完成繁重、單調(diào)重復(fù)勞動。它帶來的好處：減少勞動力費用提高生產(chǎn)率改進產(chǎn)品質(zhì)量增加制造過程柔性減少材料浪費控制和加快庫存的周轉(zhuǎn)消除了危險和惡劣的勞動崗位。機器人的直角坐標型：結(jié)構(gòu)簡單；定位精度高；空間利用率低；操作范圍??；實際應(yīng)用較少。圓柱坐標型：結(jié)構(gòu)簡單；剛性好；空間利用率低；用于重物的裝卸和搬運。球坐標型：結(jié)構(gòu)緊湊，所占

4、空間較小。關(guān)節(jié)坐標型：動作范圍寬。第2章 主要講述了位姿描述和齊次變換。剛體的位姿是指剛體參考點的位置。對組成工業(yè)機器人的每一個連桿都可以看作是一個剛體。若給定了剛體上某一點的位置和該剛體在空間的姿態(tài)，則這個剛體在空間上是完全確定的。設(shè)有一剛體Q，如圖2-4所示，在剛體上選任一點O，建立與剛體固連的坐標系OXYZ，稱為動坐標系。動坐標系位姿的描述就是相對固定坐標系對動坐標系原點位置的描述以及對動坐標系三個坐標軸方向的描述剛體的姿態(tài)描述方法主要分為齊次變換法，矢量法，旋量法，四元數(shù)法等，它們的作用都是將運動、變換和映射與矩陣運算聯(lián)系起來。位置的描述（位置矢量）對于不同的坐標系比如直角坐標系，圓柱

5、坐標和球面坐標都有特定的位置矢量來描述。而方位的描述可以用旋轉(zhuǎn)矩陣來表示剛體B相對于坐標系A(chǔ)的方位。坐標系B的三個單位主矢量相對于坐標系A(chǔ)的方向余弦，其中正交矩陣，滿足關(guān)系應(yīng)該如下而為了完全描述剛體的位姿，需要已知物體B相對于坐標系A(chǔ)的位置矢量和旋轉(zhuǎn)矩陣。當然也可以只表示位置或者方向，但是坐標系B的相應(yīng)的形式會有不同。如果只表示位置時，如果只表示方位時，坐標系B的形式為。對于手爪的描述大致可分為手爪坐標系與手爪固接一起的坐標系。z軸手指接近物體的方向，接近矢量a(approach)y軸兩手指的連線方向，方位矢量o(orientation)x軸右手法則規(guī)定，n=oa，n(normal)。而坐標變

6、換可分為坐標平移和坐標旋轉(zhuǎn)。齊次變換具有較直觀的幾何意義，和非齊次交換相比，它非常適合描述坐標系之間的變換關(guān)系。另外，齊次變換可以將旋轉(zhuǎn)變換與平移變換用一個矩陣來表達，關(guān)系明確，表達簡潔。所以常用于解決工業(yè)機器人運動學(xué)問題。齊次變換的優(yōu)點：書寫簡單，表達方便，在計算機圖形學(xué)，計算機視覺有廣泛應(yīng)用。齊次坐標的表示不是唯一的。如果將列陣p中的元素同乘一非零系數(shù)w后，仍然代表同一點P。齊次變換矩陣T除了實現(xiàn)點在不同坐標系的映射外，還可解釋為描述B相對于A的位姿（位置加方位）。齊次變換矩陣也代表坐標平移與坐標旋轉(zhuǎn)的復(fù)合將其分解成兩個矩陣相乘的形式之后就可以看出這一點。齊次變換矩陣的物理含義是指作為坐標

7、變換、坐標系的描述和運動算子，還可以定義齊次變換矩陣的運算。變換矩陣求逆指已知坐標系B相對A的描述，希望得到B相對A的描述。求逆方法分為直接對齊次變換矩陣求逆利用其次變換矩陣的特點，簡化矩陣求逆運算。其計算方法有直接計算逆矩陣和其它方法。建立變換方程通過方程計算。至于歐拉角與RPY角，引入其它參數(shù)法表示還是很有必要性的：旋轉(zhuǎn)矩陣R用9個元素表示3個獨立變量，表示不方便，自然存在用3個參數(shù)方法；R作為算子或變換使用比較方便，作為方位的描述并不方便，需要輸入較多信息；廣泛的應(yīng)用于航天、航海和天文學(xué)。歐拉角描述坐標系B的方法如下：B的初始方位與參考系A(chǔ)重合。首先將B繞zB轉(zhuǎn)阿爾法角，再繞yB轉(zhuǎn)白塔角

8、，最后繞xB轉(zhuǎn)伽馬角。這種描述中的各次轉(zhuǎn)動都是相對運動坐標系的某軸進行的，而不是相對于固定的參考系A(chǔ)。這樣的三次轉(zhuǎn)動稱為歐拉角。又因轉(zhuǎn)動的順序是繞z軸，y軸和x軸，故稱這種描述為z-y-x（歐拉角）。這種描述中的各次轉(zhuǎn)動都是相對運動坐標系的某軸進行的，而不是相對于固定的參考系A(chǔ)。這樣的三次轉(zhuǎn)動稱為歐拉角，又因轉(zhuǎn)動的順序是繞z軸，y軸和x軸，故稱這種描述為z-y-z（歐拉角）。旋轉(zhuǎn)變換通式可表示為：旋轉(zhuǎn)變換通式解決了根據(jù)轉(zhuǎn)軸和轉(zhuǎn)角建立相應(yīng)旋轉(zhuǎn)變換矩陣的問題；反向問題則是根據(jù)旋轉(zhuǎn)矩陣求其等效轉(zhuǎn)軸與等效轉(zhuǎn)角。兩點值得注意多值性，k,不是唯一的，還存在另外一組解 ：病態(tài)情況，當轉(zhuǎn)角很小時，由于式2.6

9、5的分子、分母都很小，轉(zhuǎn)軸難于確定。當接近0 或180 是無法確定，需另找新方法。可以證明：任何一組繞過原點的軸線的復(fù)合轉(zhuǎn)動總是等效于繞某一過原點的軸線轉(zhuǎn)動R(k,)自由矢量：維數(shù)、大小和方向，如速度矢量和純力矩矢量。線矢量：維數(shù)、大小、方向和作用線，如力矢量。速度矢量在不同坐標系BA之間的映射只與R相關(guān)。即有 ，而與坐標原定的位置 無關(guān)。純力矩矢量在不同坐標系BA之間的映射只與R相關(guān)。即有 ，而與坐標原定的位置 無關(guān)。有關(guān)線矢量的描述比較復(fù)雜，超出本課程范圍，需要引入旋量法等。 第三章主要跟隨老師一起學(xué)習(xí)了操作臂運動學(xué)。操作臂運動學(xué)：各連桿間的位移關(guān)系：速度關(guān)系，加速度關(guān)系操作臂：開式運動鏈

10、轉(zhuǎn)動關(guān)節(jié)、移動關(guān)節(jié)。軌跡規(guī)劃：操作臂末端執(zhí)行器相對固定參考系的空間描述關(guān)節(jié)（運動副）分為高副和低副， 低副：旋轉(zhuǎn)副、平移副、 圓柱副、平面副、 螺旋副、球面副連桿：保持其兩端的關(guān)節(jié)軸線具有固定的幾何關(guān)系。軸線：決定了連桿的特征連桿i-1是由關(guān)節(jié)軸線i-1和i的公法線長度ai-1和夾角ai-1所規(guī)定的。特殊情況：兩軸線平行得：ai-10。兩軸線相交得：ai-10, ai-1指向不定。連桿i-1：長度ai-1關(guān)節(jié)軸線i-1指向關(guān)節(jié)軸i的公法線長度（恒為正）。 扭角ai-1從軸線i-1繞公垂線轉(zhuǎn)至軸線i的夾角（可正可負）。連桿的變換通式： 同時PUMA 560運動學(xué)方程的大致建立步驟：設(shè)定各個連桿坐

11、標系，列出相應(yīng)的連桿參數(shù)；寫出各個連桿變換；寫出手臂變換矩陣和運動學(xué)方程可簡單表示為運動學(xué)正解（where）：根據(jù)關(guān)節(jié)變量qi的值，計算機器人末端抓手或工具相對于工作站的位姿。（對于每一組關(guān)節(jié)變量值，有唯一確定的解，求解簡單。）運動學(xué)反解（solve）： 為了使機器人所握工具相對于工作站的位姿滿足給定要求，計算相應(yīng)的關(guān)節(jié)變量。運動學(xué)反解的幾個重要特征： a、將問題細分成幾個子問題b、每個子問題可能無解、有一個解或多個解（與執(zhí)行的形體有關(guān)）c、如果某個子問題有多解，整個求解過程應(yīng)考慮對應(yīng)子問題每一個解的情況。求解方法： Paul的反變換法，Lee幾何法和Pieper的方法。6個自由度的機器人具有

12、封閉反解的充分條件（Pieper準則）(1) 三個相鄰關(guān)節(jié)軸交于一點；（PUMA、Stanford機器人）(2) 三個相鄰關(guān)節(jié)軸相互平行；（ASEA，MINIMOVER機器人）對于滿足條件（1）的機器人（如PUMA），運動學(xué)方程可分解為式中： 規(guī)定腕部參考點的位置， 規(guī)定腕部的方位。求解步驟：（1）腕部位置的反解，依次解出q3 q 2 q 1，主要利用消元法和三角函數(shù)中的幾何代換公式，將超越方程代數(shù)方程.（2）腕部方程的反解，求出數(shù)值，利用相對應(yīng)的歐拉角求解方法。機器人操作臂運動學(xué)反解的數(shù)目決定于：關(guān)節(jié)數(shù)目連桿參數(shù)和關(guān)節(jié)變量的活動范圍。 一般而言，非零連桿參數(shù)愈多，運動學(xué)反解的數(shù)目愈多。例如P

13、UMA 560最優(yōu)解：如何從多重解中選擇一個最優(yōu)解？最優(yōu)準則？尋求方法？ 在避免碰撞的前提下，通常按“最短行程”準則使每個關(guān)節(jié)的移動量為最小。對于典型工業(yè)機器人應(yīng)遵循“多移動小關(guān)節(jié)、少移動大關(guān)節(jié)”的原則。 第四章主要學(xué)習(xí)操作臂的雅可比。位移分析：第三章的運動學(xué)分析：速度分析：操作空間速度與關(guān)節(jié)空間速度 之間的線性映射關(guān)系 雅可比矩陣 J (q) 力 分 析：末端操作力與各關(guān)節(jié)驅(qū)動力之間的線性映射關(guān)系力雅可比矩陣JT(q)操作臂的雅可比矩陣是指操作速度與關(guān)節(jié)速度的線性變換。 奇異形位(singular configuration)：操作臂的雅可比矩陣的秩減少的形位（數(shù)學(xué)上）；操作臂在操作空間的自

14、由度將減少（物理上）。雅可比矩陣的行列式判別奇異形位：。當q2=0 或q 2=180時，雅可比行列式為0，矩陣秩為1，因而處于奇異狀態(tài)。從幾何上看，機械手完全伸直(q 2=0)，或完全縮回(q 2=180)，機械手末端不能實現(xiàn)徑向自由度，只能沿切向運動。奇異時，自由度減少。而微分運動與廣義速度則指出剛體或坐標系的微分運動包含微分移動矢量 d 和微分轉(zhuǎn)動d。d 由沿三個坐標軸的微分移動組成；由繞三個坐標軸的微分轉(zhuǎn)動組成。雅可比矩陣的構(gòu)造法：雅可比矩陣J(q) ：既可當成是從關(guān)節(jié)空間向操作空間的速度傳遞的線性關(guān)系也可看成是微分運動轉(zhuǎn)換的線性關(guān)系因此，可將雅可比J(q)分塊，PUMA560的雅可比的

15、計算有一、用微分變換法計算TJ(q)二、用矢量積方法計算J(q)。力雅可比末端廣義力矢量 其中 ，f 力，n 力矩 末端廣義虛位移 其中，d微分移動，在靜態(tài)條件下，廣義操作力矢量應(yīng)與各關(guān)節(jié)的驅(qū)動力相平衡 利用虛功原理，可以導(dǎo)出關(guān)節(jié)力矢量和廣義力矢量之間的關(guān)系?？偺摴榱?。同樣也表示操作臂的力雅可比就是它的運動雅可比轉(zhuǎn)置?？梢钥闯隽ρ趴杀扰c運動雅可比之間的緊密關(guān)系對偶關(guān)系。J(q) 是 m*n 階矩陣，n 表示關(guān)節(jié)數(shù)，m 表示操作空間的維數(shù)。對于給定的q，J(q) 的值域空間 R(J(q) 表示關(guān)節(jié)運動能夠產(chǎn)生的全部操作速度的集合第五章主要學(xué)習(xí)了操作臂動力學(xué)。動力學(xué)研究的是物體運動和受力之間的關(guān)

16、系：動力學(xué)正問題根據(jù)關(guān)節(jié)驅(qū)動力或力矩，計算操作臂的運動(位移、速度和加速度）動力學(xué)逆問題根據(jù)軌跡運動對應(yīng)關(guān)節(jié)的位移、速度和加速度，計算所需的關(guān)節(jié)力或力矩動力學(xué)建模方法主要有：拉格朗日Lagrange方法：牛頓-歐拉Newton-Euler方法，高斯Gauss方法，凱恩Kane方法，旋量對偶數(shù)方法，羅伯遜-魏登堡Roberson-Wittenburg方法。 牛頓-歐拉Newton-Euler方法 基于運動坐標系和達朗貝爾原理的優(yōu)缺點：沒有多余信息，計算速度快建立復(fù)雜系統(tǒng)比較麻煩同時動力學(xué)研究的目的也是利用動力學(xué)模型，實現(xiàn)最優(yōu)控制，以期達到良好的動態(tài)性能和最優(yōu)指標操作臂動力學(xué)：復(fù)雜的動力學(xué)系統(tǒng)多連

17、桿、多輸入、多輸出系統(tǒng)，耦合關(guān)系和非線性。多體系統(tǒng)動力學(xué)多剛體系統(tǒng)和剛-柔耦合多體系統(tǒng)。由旋轉(zhuǎn)通式(2.58)可知，R(t+t)可看成R(t)在時間間隔t內(nèi)繞某軸k 轉(zhuǎn)動微分角度得到兩端除以t，并取極限，可以定義角速度算子矩陣：剛體的速度和加速度表示為：根據(jù)不同的情況可以對上式進行簡化：A固定不動，剛體與B固接；B只相對于A移動；B只相對于A滾動而關(guān)節(jié)驅(qū)動力或力矩計算各連桿所承受的力和力矩向量中，某些分量由操作臂本身的連桿結(jié)構(gòu)所平衡， 一些分量由各關(guān)節(jié)的驅(qū)動力或力矩所平衡力雅可比矩陣的遞推方法類似于速度雅可比矩陣遞推法。對于連桿靜力學(xué)分析，靜力分析：首先考慮一個連桿i，然后建立該連桿的力和力矩

18、平衡方程，力雅可比矩陣的遞推方法類似于速度雅可比矩陣遞推法操作臂動力學(xué)的研究有很多方法拉格朗日Lagrange方法牛頓-歐拉Newton-Euler方法高斯Gauss方法凱恩Kane方法旋量對偶數(shù)方法羅伯遜-魏登堡Roberson-Wittenbrug方法本節(jié)用運動（速度和加速度）遞推和力遞推來建立操作臂動力學(xué)方程并討論動力學(xué)逆問題的求解方法 一、牛頓-歐拉方程：操作臂=剛體 質(zhì)心加速度，總質(zhì)量 m 與產(chǎn)生這一加速度的作用力 f 之間滿足牛頓第二定理：當剛體繞過質(zhì)心的軸線旋轉(zhuǎn)時，角速度，角加速度，慣性張量 ，與作用力矩之間滿足歐拉方程：慣性張量 表示剛體質(zhì)量分布的特征，其值與選取的參考值坐標系

19、有關(guān)。若所選取的坐標系c 的方位使各慣性積均為零慣性張量變成對角型 則此坐標系的各軸稱為慣性主軸，相應(yīng)的質(zhì)量慣性矩稱為主慣性矩。動力學(xué)逆問題根據(jù)關(guān)節(jié)位移、速度和加速度。求所需的關(guān)節(jié)力矩或力。整個算法由兩部分組成：向外遞推：計算各連桿的速度和加速度。，由牛頓-歐拉公式計算各連桿的慣性力和力矩。向內(nèi)遞推：計算各連桿相互作用的力和力矩，以及關(guān)節(jié)驅(qū)動力或力矩封閉形式的動力學(xué)方程。遞推公式(5.645.72)有兩種用途數(shù)值計算和推導(dǎo)封閉形式動力學(xué)方程。只要知道各桿的質(zhì)量、慣性張量、質(zhì)心和旋轉(zhuǎn)矩陣的值，即可直接計算實現(xiàn)給定運動所需的關(guān)節(jié)驅(qū)動力矩和力（數(shù)值計算）。然而，為了闡明動力學(xué)方程的結(jié)構(gòu)，比較重力和慣

20、性力影響的主次，分析向心力和哥氏力的影響是否可以忽略等，通常希望將某一機器人的動力學(xué)方程(5.645.72)寫成封閉解的形式，即將關(guān)節(jié)力矩和力寫成關(guān)節(jié)位移、速度和加速度的顯函數(shù)形式。仍以平面2R機械手為例說明之。 第六章主要跟隨老師一起學(xué)習(xí)軌跡規(guī)劃相關(guān)知識。在機器人完成給定作業(yè)任務(wù)之前，應(yīng)該規(guī)定他的操作順序，行動步驟和作業(yè)進程。人工智能范圍內(nèi)，規(guī)劃就是問題求解技術(shù)，從某個特定的初始狀態(tài)出發(fā)，構(gòu)造一系列操作，使之達到解決該問題的目標狀態(tài)軌跡：操作臂在運動過程中的位移、速度和加速度。軌跡規(guī)劃：根據(jù)作業(yè)任務(wù)要求，計算出預(yù)期的運動軌跡。首先，對機器人的任務(wù)、運動路徑和軌跡進行描述。其次，在計算機內(nèi)部描

21、述所要求的軌跡，即選擇習(xí)慣規(guī)定及合理的軟件數(shù)據(jù)結(jié)構(gòu)。最后，對內(nèi)部描述的軌跡，實時計算機器人的運動的位移、速度和加速度，生成運動軌跡。 常用的兩種軌跡規(guī)劃方法：1）對于選定的軌跡結(jié)點上的位姿、速度和加速度給出一組顯式約束，軌跡規(guī)劃器從一類函數(shù)中選取參數(shù)化軌跡，對結(jié)點進行插值，并滿足約束條件。2）給出運動路徑的解析式，如：直角坐標空間中的直線路徑，軌跡規(guī)劃器在關(guān)節(jié)空間或直角坐標空間中確定一條軌跡來逼近預(yù)定的路徑第一種方法：約束的設(shè)定和軌跡規(guī)劃均在關(guān)節(jié)空間中進行。不足：操作臂手部沒有施加任何約束，很難弄清手部的實際路徑。碰撞第二種方法：路徑約束是在直角坐標空間中給定的，而關(guān)節(jié)驅(qū)動器是在關(guān)節(jié)空間中受控

22、的。因此，為了得到與給定路徑十分接近的軌跡，首先必須采用某種函數(shù)逼近的方法將直角坐標路徑約束轉(zhuǎn)化為關(guān)節(jié)路徑約束， 而后確定滿足關(guān)節(jié)路徑約束的參數(shù)化路徑。軌跡規(guī)劃既可以在直角空間中進行，也可以在關(guān)節(jié)空間中進行，但所規(guī)劃的軌跡函數(shù)都必須連續(xù)和平滑，使得操作臂的運動平穩(wěn)。在關(guān)節(jié)空間進行規(guī)劃時，是將關(guān)節(jié)變量表示成時間的函數(shù)，并規(guī)劃它的一階和二階時間導(dǎo)數(shù)；在直角空間進行規(guī)劃時，是將手部位姿、速度和加速度表示為時間的函 數(shù)，相應(yīng)的關(guān)節(jié)信息由手部信息導(dǎo)出。用戶：根據(jù)作業(yè)給出各個路徑節(jié)點，規(guī)劃器的任務(wù)包含：解變換方程、進行運動學(xué)反解和插值運算等；在關(guān)節(jié)空間進行規(guī)劃時，大量工作是對關(guān)節(jié)變量的插值運算。確定路徑點

23、上的關(guān)節(jié)速度，可有以下三種方法規(guī)定：（1）根據(jù)工具坐標系在直角坐標空間中的瞬時線速度和角速度來確定每個路徑點的關(guān)節(jié)速度；（2）在直角坐標空間或關(guān)節(jié)空間中采用適當?shù)膯l(fā)式方法，由控制系統(tǒng)自動地選擇路徑點的速度。（3）為了保證每個路徑點上的加速度連續(xù)，由控制系統(tǒng)按此要求自動地選擇路徑點的速度。 方法（1），利用操作臂在此路徑點上的雅可比，把該點的直角坐標速度映射為所要求的關(guān)節(jié)速度。當然，如果操作臂的某個路徑點是奇異點，這時就不能任意設(shè)置速度值。按照方法（1）生成的軌跡雖然能滿足用戶設(shè)置速度的需要，但是逐點設(shè)置速度畢竟要耗費很大的工作量。 因此，機器人的控制系統(tǒng)最好具有方法（2）和（3）的功能，或者二者兼而有之方法（2），系統(tǒng)采用某種啟發(fā)式方法自動選取合適的路徑。方法（3），保證路徑點處的加速度連續(xù)設(shè)法用兩條三次曲線在路徑點處按一定規(guī)則連接起來，拼湊成所要求的軌跡。約束條件：速度和加速度連續(xù)設(shè)所經(jīng)過的路徑點處的關(guān)節(jié)角度為qv，與該點相鄰的前后兩點的關(guān)節(jié)角分別為q0和q g 從0到 v