【正文】 基礎(chǔ)上，直觀的顯示效果和結(jié)果直接影響仿真過程的可信度。x運動學(xué)方程（可以被看作是一個從關(guān)節(jié)空間向操作空間的映射逆運動學(xué)的解決方案是在關(guān)節(jié)空間和映射的原始圖像得到的。xX的末端執(zhí)行器的位姿是在直角坐標空間的描述，這是用來表示空間方位空間操作或操作。（4）求末桿位姿矩陣 令，可得式中， ， ， ， ，式中， ， ， ， ， ，根據(jù)式和式可得式中， ， ， ， ， ， ， ， ， ， ， 若令，并將有關(guān)常量代入 矩陣，則有2．4機器人幾種空間的關(guān)系 在路徑規(guī)劃的機器人，用來驅(qū)動空間，關(guān)節(jié)空間，空間的概念和操作之間的映射關(guān)系。000160176。0001490176。000120176。、的單位向量分別記為n、o、a。與軸的交點為，設(shè)在臂的終端，是腕結(jié)構(gòu)的中心，重合是腕的第二個轉(zhuǎn)軸；與軸的交點為；、重合，是腕的第三個轉(zhuǎn)軸。圖28 PUMA560機械手坐標系解：（1）設(shè)定機器人各桿的坐標系 按DH坐標系建立各桿的坐標系如圖所示 將設(shè)置在關(guān)節(jié)1的轉(zhuǎn)軸上，和重合；、分別沿關(guān)節(jié)3的轉(zhuǎn)軸，∥。已知其。2．3 建立機器人運動學(xué)方程的實例 前面已經(jīng)講過了如何建立坐標系，如何對坐標系進行齊次變換，如何確定各參數(shù)以及如何建立運動學(xué)方程。反之，如果知道方程左邊的末端連桿的位姿(n,o,a,p)，由它們?nèi)デ蟾鱾€關(guān)節(jié)變量,…，我們稱為運動學(xué)的反解。它表示末端連桿的位姿(n,o,a,p)與關(guān)節(jié)變量,…之間的關(guān)系。表示末端連桿坐標系{n}相對于基坐標系{0}的描述，即 （220） 運動學(xué)方程：基于變換矩陣，根據(jù)各個關(guān)節(jié)位置傳感器的輸出，得到各個關(guān)節(jié)變量(i=1，2，……，n)的值，即可求出。具體的寫法，參考文獻。很顯然，與這四個連桿參數(shù)有關(guān)。（3） 連桿參數(shù)的總結(jié)根據(jù)所設(shè)定的連桿坐標系，相應(yīng)的連桿參數(shù)可定義如下：①：從到向測量的距離；②：從到繞旋轉(zhuǎn)的角度③：從到向測量的距離；④：從到繞旋轉(zhuǎn)的角度。（2） 連桿坐標系的規(guī)定為了確定機器人各個連桿之間相對運動關(guān)系，我們在各個連桿上分別固接著一個坐標系。上述描述機器人運動的方法是Denavit和Hartenberg提出來的，稱為DH方法。通過上述分析，我們知道每個連桿 ，由四個參數(shù)構(gòu)成，其中和是描述連桿i1本身的特征； 和只是描述連桿i1和連桿i之間的聯(lián)系。首末連桿對于具體情況有具體的規(guī)定。表示久與軸線i的交點到與軸線i的交點的距離，沿軸線i測量； 表示與之間的夾角，繞軸線i由到測量。 圖27 兩連桿連接的描述 兩條公法線與之間的距離稱為這兩條連桿之間的偏置: 與之間的夾角稱為關(guān)節(jié)角。由連桿長度和扭角就能完全定下連桿i1的特征。的指向規(guī)定為從軸線il繞公垂線轉(zhuǎn)至軸線i。 連桿i1的特征是由關(guān)節(jié)軸線i和i1的公法線長度和夾角所定的。其中，夾具和連接桿與底座6固定連接，底座固定不動[ 9 ]。連桿1與底座1通過鉸鏈連接，連桿，通過聯(lián)合2 1 2 3和連接桿與連接桿連接，2個關(guān)節(jié)連接的3，等等。機械手一般由轉(zhuǎn)動關(guān)節(jié)和關(guān)節(jié)移動形成的，每個節(jié)點有一個自由度，因此，有五個自由度的機械手是由五連桿和五個關(guān)節(jié)，六自由度機械手是由六連桿和六個關(guān)節(jié)。 為了研究在操作臂各個環(huán)節(jié)的操作之間的關(guān)系，各連桿坐標系與一個固定連接，然后介紹了坐標系之間的關(guān)系。2關(guān)節(jié)是由驅(qū)動器驅(qū)動，相對運動共同導(dǎo)致連桿，使夾持器構(gòu)成的要求。機器人可以被看作是一個開放的運動鏈，它是由一系列的旋轉(zhuǎn)或移動通過一系列形成的接頭連桿。注意一點的是，變換矩陣的左乘和右乘的運動解釋是不同的:變換順序“從右向左”，表明運動是相對固定坐標系而言的；變換順序“從左向右”，指明運動是相對運動坐標系而言的。可以簡化得到 (216)比較上面兩式可以看出，綜合表達了平移變換和旋轉(zhuǎn)變換，稱為齊次變換矩陣。{A} 圖24 復(fù)合變換復(fù)合變換是由坐標旋轉(zhuǎn)和坐標平移共同作用的。和都是正交矩陣，兩者互逆。用旋轉(zhuǎn)矩陣表示坐標系(B}相對于{A}的方位。 {A}{B} 圖22 平移變換（1） 旋轉(zhuǎn)變換設(shè)坐標系{B}和{A}有共同的原點，但是兩者的方位不同，如圖23所示；O 圖23 旋轉(zhuǎn)變換 用旋轉(zhuǎn)矩陣描述{B}相對于{A}的方位。把稱為{B}相對于{A}的平移矢量。從一個坐標系的描述到一個坐標系的描述之間的變換關(guān)系具體有:平移變換、旋轉(zhuǎn)變換、復(fù)合變換。而手爪的位置由位置矢量P所規(guī)定，它代表手爪坐標系的原點。（4）手爪坐標系：為了描述手爪的位置和姿態(tài)，規(guī)定一坐標系與手爪固接，稱手爪坐標系，如圖21所示， 圖21 機器人手爪坐標系其中，Z軸設(shè)在手指接近物體的方向，稱接近矢量a（approach）；軸設(shè)在兩手的連線方向，稱方位矢量o(orientation)；X軸由右手法則確定：n=oхa ,n稱為法向矢量（normal）。相對參考系{A}，由位置矢量和旋轉(zhuǎn)矩陣分別描述坐標系{B}的原點位置和坐標軸的方位。（3）位姿的描述：為了完全描述剛體B的空間的位姿(位置和姿態(tài))，通常將剛體B與坐標系{B}相固接。因為的三個列矢量都是單位主矢量，且兩兩相互垂直，所以它的9個元素滿足6個約束條件（正交條件）： （24） （25）因此旋轉(zhuǎn)矩陣是正交的,并且滿足條件: ； 。 稱為旋轉(zhuǎn)矩陣，上標A代表參考系{A}，下標B代表被描述的坐標系{B}。（2）方位的描述：為了規(guī)定空間某剛體B的方位，另設(shè)一直角坐標系{B}與此剛體固接。 的上標A代表參考坐標系{A}。利用齊次坐標變換的方法，在本文中，本實用新型具有運動的優(yōu)點，轉(zhuǎn)換和映射和矩陣在一起；此外，在空間機構(gòu)動力學(xué)研究的齊次變換，機器人控制算法，計算機圖形和視覺信息處理中得到廣泛應(yīng)用。因此，我們可以從剛體方面來描述它的位姿[ 14 ]。因為它是基于機器人的運動學(xué)和動力學(xué)，因此有必要對機器人的位姿描述的一般方程，運動學(xué)和動力學(xué)理論，對機器人的運動學(xué)和動力學(xué)方案的實現(xiàn)方法。機械手的軌跡，指的是過程中的位移，速度和加速度的運動。機器人設(shè)計成MOTOMANHP模式，而機器人軌跡規(guī)劃是一項系統(tǒng)工程，有時有必要在聯(lián)合空間中，主要涉及到的速度和加速度的問題運動學(xué)優(yōu)化軌跡。再次討論了機器人關(guān)節(jié)軌跡插補問題。并且在不同的空間之間的差異，并連接。本論文的主要內(nèi)容 軌跡規(guī)劃是基于運動學(xué)和機器人的動力，因此，本文探討了各種算法的研究，在機器人軌跡規(guī)劃應(yīng)用齊次坐標變換。此外，現(xiàn)有的算法也或多或少存在一些缺點。在中國，張凱等人（2002）專為IVECO束焊焊接軌跡規(guī)劃算法研究期間PP 6R機器人的運動。鮑仁斯坦和科倫（1990）對同樣的問題，也提出了一個特殊的啟發(fā)式算法。 Dubowsky和Blubaugh（1989）特別參考的工業(yè)應(yīng)用的例子，討論了各種有效應(yīng)用專用算法。產(chǎn)品裝配，在傳送帶上的電路板連接器的電子元件，點焊自動化設(shè)備，汽車部件或其它設(shè)備和切割操作，外層空間機器人空間貨物傳送操作以及一些高級工件夾具的生產(chǎn)是主要的應(yīng)用實例。PP基機器人任務(wù)操作，一般是指前后移動的各種運行點之間需要設(shè)置在工作空間中的機器人來執(zhí)行的一類任務(wù)的，它必須在機器人被定義為到達每個工作點，并且在每一個相應(yīng)的點留。 （2000），用于一些機器人動力學(xué)方程的特殊情況下，難以得到準確的，所提出的方法只使用運動軌跡規(guī)劃問題解決方法，以及尤其是利用進化策略的（進化策略，ES），以解決優(yōu)化模型，弄了一些最佳的解決方案。從那時起，Bazaz等（1999）以前的方法，后者必須集成并利用三次曲線段與平穩(wěn)過渡到一個新的方法來連接的關(guān)鍵點，即設(shè)計算法，取得了一定的效果。 （1997）指出，在考慮的前提下，速度和加速度的限制，最佳時間路徑規(guī)劃的過程，三次樣條曲線連接的最簡單的各個關(guān)節(jié)空間的關(guān)鍵點的多項式曲線的形式，并且因此提出了相應(yīng)的算法。然而，為簡單起見，這個方??法使用一個直線段與聯(lián)合空間的關(guān)鍵點的平滑過渡連接，這種缺陷不是在一個給定的操作的軌跡生成內(nèi)插的中間點。通迪等人。 （1983），并考慮到一個最優(yōu)軌跡規(guī)劃方法下一次的提議條款的機器人的位置，速度，加速度和第二加速度運動學(xué)約束，并使用靈活多面體接收電纜后（彈性Ployhedron搜索，F(xiàn)PS）的算法，以通過使用高次多項式曲線以連接在一系列關(guān)鍵點的機器人關(guān)節(jié)的空間，得到滿意的軌跡解決特定，此方法。分別基于運動學(xué)和動力學(xué)可以設(shè)計出各種不同的算法的機器人在機器人運動學(xué)設(shè)計的算法，主要有以下的結(jié)果。沿運動軌跡的最佳時間算法的預(yù)定路徑。在過去的十年中，整個時間駕駛剛性機器人最優(yōu)路徑規(guī)劃問題的描述和刻畫，并計算一直是一個活躍的研究領(lǐng)域。機器人軌跡規(guī)劃算法的性能優(yōu)化有很多指標，如時間最優(yōu)和最佳節(jié)能系統(tǒng)[4]。同時，隨著機器人軌跡規(guī)劃的進一步研究，機器人的運動精度有了很大的提高，因此，機器人可以更好地為我們服務(wù)，機器人將有進一步的發(fā)展。因此，機器人軌跡規(guī)劃的研究已成為機器人研究的一個重要課題。在過去的十年中，機器人和機器人技術(shù)的飛速發(fā)展也越來越成熟。機器人軌跡規(guī)劃機器人是研究的一個非常重要的領(lǐng)域。對于（2），有一個非伺服機器人。球坐標機器人?？刂疲?）機器人?？刂扑惴ǎ阂粋€序列的計算機指令，其提供以執(zhí)行工作的機器人的控制需要做[6]。環(huán)境模型，描述每個機器人的東西在空間。對于技術(shù)先進的機器人可以使用小型機，微型計算機和微處理器為主要控制單元進行編程。機器人接收來自所述傳感器的信號，對數(shù)據(jù)進行處理，并根據(jù)預(yù)先存儲的信息，該機器人的狀況和它的環(huán)境等，??生成機器人控制信號，以驅(qū)動各個關(guān)節(jié)。一個機器人系統(tǒng)，一般由四部分組成：互動的機器人，環(huán)境，任務(wù)，控制器，如圖13所示。一般是指執(zhí)行不同的功能和完成簡單任務(wù)的實際能力。機器人的特點，結(jié)構(gòu)和分類 通用性和適應(yīng)性的機器人的兩個主要特征。第二階段：從第二十世紀70至80年代中期；隨著自動控制理論的迅猛發(fā)展，計算機技術(shù)和航空航天技術(shù)，機器人技術(shù)已經(jīng)進入了一個新的發(fā)展階段。]。在現(xiàn)代制造業(yè)應(yīng)用工業(yè)機器人與柔性自動化密切相關(guān)。如圖11和圖12所示的機器人。 本文的機器人，工業(yè)機器人，機器人和機械手。計算機控制的機器人由于其高可靠性，靈活性和快速反應(yīng)能力和巨大的信息存儲和處理能力，贏的人。 研究，機器人的制造及應(yīng)用，它是由許多國家的重視，也象征著一個國家的科技水平和經(jīng)濟實力。同時，為了能夠知道規(guī)劃軌跡符合要求，我們將計劃軌跡仿真，可以提高軌跡規(guī)劃精度。同時，達到機器人的目標位置的路徑是不是唯一的，因此需要規(guī)劃出最優(yōu)軌跡。同時，隨著機器人運動精度的機器人路徑規(guī)劃的研究有了很大的提高，因此，機器人可以更好地為我們服務(wù)，機器人技術(shù)將有進一步的發(fā)展。所以，對機器人路徑規(guī)劃的研究已成為機器人研究的一個重要任務(wù)。近年來，機器人技術(shù)的迅速發(fā)展，機器人技術(shù)也越來越成熟。目錄引言………………………………………………………………………………1第1章 緒論…………………………………………………………………… 21．1機器人發(fā)展的概況……………………………………………………………21．2機器人軌跡規(guī)劃簡介…………………………………………………………41．2．1機器人軌跡規(guī)劃研究的背景和意義……………………………………41．3．2國內(nèi)外機器人軌跡規(guī)劃研究的現(xiàn)況……………………………………51．3本論文所研究的目標和內(nèi)容………………………………………………… 61．3．1本論文研究的目標………………………………………………………61．3．2本論文研究的主要內(nèi)容…………………………………………………6第2章 機器人數(shù)學(xué)模型的建立和幾何造型……………………………………72．1機器人位姿的描述……………………………………………………………72．1．1剛體位姿描述……………………………………………………………72．1．2坐標變換…………………………………………………………………92．2機器人運動學(xué)方程的建立……………………………………………………112．2．1連桿參數(shù)和連桿坐標系………………………………………………122．2．2連桿變換………………………………………………………………142．3 建立機器人運動學(xué)方程的實例……………………………………………152．4幾種機器人空間的關(guān)系………………………………………………………182．5機器人的動力學(xué)………………………………………………………………192．6 MOTOMANHP機器人的幾何造型…………………………………………202．7本章小結(jié)………………………………………………………………………21第3章MOTOMANHP機器人的軌跡規(guī)劃……………………………………223．1軌跡規(guī)劃簡介………