【正文】 的齊次矩陣，分別表示沿軸移動的距離。繞x、y、z軸旋轉的可以表示為（）符號為表示旋轉的齊次矩陣，表示繞軸，表示轉過的角度。 ，式（）是基本的齊次變換陣。當兩個坐標系之間變換時，可以通過基本的齊次坐標變換矩陣相乘可以得到最后的齊次變換矩陣。但是當兩個矩陣存在多次變換時，可以相對于共同的參考系，也可以相對變換過程中不同的坐標系，這樣就存在矩陣的相乘順序。左乘、右乘情況如下【25】：1)若坐標系變換的過程中始終相對于同一個參考（基礎）坐標系，則齊次變換矩陣左乘。 2)若坐標系之間的變換是相對于一個變化的坐標系進行變換時，則其次變化矩陣右乘。通過齊次變換矩陣把在坐標系中的描述用齊次坐標表示的矢量映射到基礎坐標系【49】即： （） （）. DenavtHartenberg(DH)表示法為了描述機器人各關節(jié)之間的變換關系，1955年，Denavit和Hartenberg提出了在每個桿件關節(jié)處建立44齊次變換矩陣，來描述兩個桿件之間的關系，即DH法【43】。它的基本思想是：首先設立一個基礎坐標系，然后在機器人每個關節(jié)上建立坐標系坐，確定從到齊次變化矩陣，將所有變化矩陣相乘起來，就確定了末端執(zhí)行器與基坐標系之間的總變化齊次變化矩陣，建立運動學方程。本文基于法建立坐標系并求解裝配加工機器人的運動學方程。關節(jié)機器人需要建立個坐標系，其中基礎坐標系表示為，末端執(zhí)行器的坐標系為，第個關節(jié)上的坐標系為,確定和建立坐標系應遵循以下幾個規(guī)則【26】：1)軸與第個關節(jié)的關節(jié)軸重合，正方向的確定以坐標變換方便為原則。2)軸垂直于和軸并指向離開軸的方向.3)軸按右手坐標系的要求建立.最終用法建立串聯(lián)機器人的坐標系如圖36圖36 機器人坐標系Fig36 Robot coordinateDH表示法取決于四個幾何參數(shù)【50】：：從軸到軸沿軸測量的距離，代表連桿的長度，因此規(guī)定。：從軸到軸繞軸旋轉的角度，的值可正、可負。：從軸到軸沿軸測量的距離，的值可正、可負。：從軸到軸繞軸旋轉的角度，的值可正、可負。機器人各連桿參數(shù)及關節(jié)變量如表31所示：表31 機器人連桿參數(shù)Table 31 Link parameters of robot關節(jié)變量其他參數(shù)0100a0均為設計參數(shù)，其中1200b23n0034d00045e90005mf0000基于法建立了機器人各桿件坐標系后，坐標系與間的變換可以用齊次變換矩陣表示， 與四個參數(shù)有關。經(jīng)以下變換得到的【50】:(1)繞軸旋轉角；(2)沿軸平移；(3)繞軸旋轉角；(4)沿軸平移；上述變換時坐標系在每次轉動或者移動后都發(fā)生了變動，后一次的變換都是相對前一次坐標變換的，所以右乘就得到坐標系與坐標系的齊次變換矩陣為： （）將表31中的各連桿參數(shù)代入式()，可以得到到坐標系下的位姿變換矩陣,結果如下： （）其中,最后得到機器人的運動學方程為： （）式中 當給定各個關節(jié)的變量時，就可以求出具體的數(shù)值，即根據(jù)機器人的運動學方程求出運動學正解。分別給定三組值如表32所示。表32 運動學正解Table 32 kinematics positive solutions關節(jié)變量10200300302303000304530300306030代入式（）正解如下：通過編程，分別讓, 的速度同時旋轉5秒，繪制出末端執(zhí)行器相對基礎坐標系在X、Y、Z方向的位移曲線如圖37，在仿真曲線如圖38所示。分別取三組值將解析解和仿真解進行對比，如表33所示。圖37機器人解析的末端位置變化曲線Fig37 Robot end displacement curve圖38機器人仿真的末端位置變化曲線Fig38 Robot end displacement curve表33 解析解與仿真解對比Table 33Analytical solution amp。 simulation solutions contrast解析解仿真解202010100404020200808040400通過圖37，圖38，表33可以看出解析結果與仿真結果基本相同，驗證了解析解得正確性。機器人的工作空間指的是機器人的末端執(zhí)行器在空間運動時能達到的最大工作范圍，它與機器人的形式（串聯(lián)、并聯(lián)）、自由度數(shù)目、關節(jié)類型（移動、轉動）以及配置形式有很大的關系。通常機器人的工作空間是由臂部的運動確定的，不同的自由度數(shù)和關節(jié)類型，就可以構成不同的工作空間。工作空間的大小和形狀反映了機器人實際的工作能力，它對機器人的運動、完成作業(yè)任務、避障有十分重要的意義。 圖解法、解析法、以及把兩種方法綜合起來數(shù)圖解法是求解機器人工作空間的常用方法，對于結構簡單、自由度數(shù)目比較少的機器人，可以用幾何算法，一般可以在基座坐標系中用工作空間的截面圖來表示，但對于結構復雜，自由度數(shù)多的機器人，采用圖解法就比較繁瑣。所以對于多自由度結構復雜的機器人采用解析法，即求機器人的運動學方程進行計算和判別。本文使用的蒙特卡洛法()又稱隨機數(shù)模擬法來求解機器人的工作空間。其基本思想是利用隨機抽樣值，然后進行統(tǒng)計處理，結果作為問題解的一種數(shù)值方法。即在機器人各關節(jié)的取值范圍內，各關節(jié)的值隨機選取，代入運動學方程就可以求出末端執(zhí)行器相對基礎坐標系的點坐標，所有點坐標的集合就構成了機器人的工作空間【27】。根據(jù)式（38）所求出的機器人運動學方程得到末端執(zhí)行器相對基礎坐標系 （）本文利用mat lab軟件進行編程計算工作空間，工作空間的計算框圖如圖39圖39 計算框圖Fig39 Calculation diagram代入機器人各桿件的參數(shù)后即可以通過自編程序得到機器人的工作空間，分別設時得到機器人工作空間的三維圖、XOY平面圖如圖310, 311.圖310 N=10000時工作空間Fig 310 Work space of robot at 10000 point圖311 N=30000工作空間Fig311 Work space of robot at 30000 point可以看出點數(shù)越多，越接近實際的工作空間，其工作空間是一外徑約為1650mm，內徑為350mm，高為1300mm的空心圓柱，這樣的工作空間滿足實際的工作要求?？梢酝ㄟ^分析機器人工作空間來確定機器人各桿件的尺寸參數(shù)，滿足給定的工作要求。 機器人逆解就是求解運動學方程的逆解，即知道機器人末端執(zhí)行器在基礎坐標系下所描述的位置和姿態(tài)時，如何根據(jù)運動學方程求出機器人每個時刻各關節(jié)的變量值。本文主要采用遞推逆變換法求逆解，遞推逆變換法是將相鄰桿件的齊次變換矩陣的逆矩陣左乘裝配加工機器人運動學方程，得到的矩陣方程可以確定一組方程式，這些方程式只包含一個或者多個待求關節(jié)變量，求解方程各關節(jié)的變化量。從而求解。推導過程如下： （） 一步一步遞推下去，遞推過程不一定要全部完成，就可以利用矩陣對應元素相等，求出全部關節(jié)變量，即求出機器人的逆解。機器人的正解是唯一的，但機器人運動學的逆解卻有無解、唯一解和多解三種情況。機器人逆解的數(shù)目與機器人自由度數(shù)、關節(jié)數(shù)目、連桿參數(shù)、關節(jié)類型、關節(jié)的運動范圍都和機器人運動學逆解的數(shù)量有很大的關系【28】。有時候雖然有解，但是由于各種因素不一定采用，通常自由度越多，可動桿件的數(shù)目就越多，機器人就越靈活，到達指定目標的路徑就越多，相應的逆解數(shù)目也就越多。多解的情況下就存在所有的可行解中選擇最優(yōu)解的問題，在關節(jié)運動的范圍之內，一般按照最短路徑、多移動小關節(jié)，少移動大關節(jié)來擇優(yōu)選取。由上節(jié)求出的運動學方程可知 （） (312)由上式對應元素相等可以得到可以求出 可以求出在聯(lián)立方程組 (313)令： 求解 同理:到此，已經(jīng)全部解出。利用編程的軟件求解給定的三組正解的逆解如表34，與其進行比較。Table 34 The inverse solution組數(shù)逆解1102003022003021300231030030圖312為三組逆解值在平面的臂行。圖312機器人逆解臂形 Robotarmshaped of inverse solution按照最短路徑、多移動小關節(jié)，少移動大關節(jié)，減少機器人的慣性力的影響，從圖312可以看出①臂是最優(yōu)解。對于圖37所示的解析出機器人末端X、Y、Z向位移曲線進行求逆解，得到各個時刻關節(jié)位移的曲線如圖313：從圖313可以看出從初始位置到對于末端執(zhí)行器的位姿有兩組逆解當繼續(xù)運動時就有一組逆解，這是因為逆解的第二組解的第四個關節(jié)，達到了第四個關節(jié)運動范圍的最大值，所以只有一組解。圖313機器人的逆解曲線Fig313 Inverse solution curve of robot對于逆解的仿真是通過在中對末端執(zhí)行器施加多自由度點驅動，進行機器人運動學逆解仿真，一般的點驅動可以施加三個方向的位移函數(shù)或旋轉函數(shù)。最后將仿真出逆解位移曲線與解析所求的逆解得到的各關節(jié)角位移曲線相對比，驗證解析解的正確性。仿真出的位移曲線如圖314所示.圖314 逆解位移曲線Fig314 Inverse solution displacement curve從圖314可以看出，ADAMS仿真出逆解位移曲線與解析所求的逆解得到的各關節(jié)角位移曲線與相差很大。原因是機器人起始位置的大臂、小臂、末端執(zhí)行器處于同一條直線上,是機器人的奇異形位；末端位移曲線擬合成樣條函數(shù)時產(chǎn)生了誤差；主要原因是對末端執(zhí)行器施加點驅動時，沒有考慮到機器人末端執(zhí)行器的位姿，造成末端執(zhí)行器正解輸出的角位移和仿真出的末端執(zhí)行器的角位移驅動函數(shù)的不同，由此可見末端執(zhí)行器的位姿對各關節(jié)位移有很大的影響【29】。然而對于確定的位姿，逆解也可能有多組解，由于關節(jié)運動范圍的限制要將其中一些不符合要求的解舍去。在軌跡插補的過程中。一般在剩下的所有解中選擇與機器人當前位置最接近的那一組解，當做機器人的解，具體的做法是：先解出所有的解，然后舍去超過機器人運動范圍的那些解，然后選擇機器人在每個間隔時間內得到逆解，與前一個位置的差值最小原理選擇合適的那組解。如圖黑色的物體為工件，在工件上打一個深100mm的孔，孔坐標為（1500,100,）相對于大地坐標系。取機器人大臂、小臂、手腕在一條直線上為初始位置，要進行打孔，機器人末端執(zhí)行器的位姿必須從初始位置先到達如圖315的位姿。圖315 機器人的位姿Fig315 robot pose預先到達圖315所示的末端執(zhí)行器的位姿，通過解析有兩種逆解如表35表35 機器人逆解Table35 the inverse solution of robot組數(shù)1300023000從表35可以看出，第一組解相對于機器人初始位置的差值和最小，所以選擇第一組解為機器人在打孔中的初始位置。在打孔的過程中末端執(zhí)行器的位姿一直不變，只是在X軸有變化，設末端執(zhí)行器沿X軸運行的速度為20mm/s,完成整個過程需要五秒。通過解析解得到各關節(jié)的轉動位移如圖316圖316 各關節(jié)位移曲線Fig316 Each joint displacement curve由于在運動的過程中恒等于0，通過計算算出三個關節(jié)相對初始位置所轉過的角度如圖317，通過Adams仿真出的各關節(jié)相對初始位置轉過角度為圖318圖317 解析的各關節(jié)相對位移曲線Fig317 Each joint relative displacement curve圖318 仿真的各關節(jié)位移曲線Fig 318 Simulation of each joint relative displacement curve分別取三組值將解析解和仿真解進行對比，如表36表36 解析解與仿真解對比Table 36 Analytical solution amp。 simulation solutions contrast解析解仿真解124通過比較圖313與314,得知解析解與仿真解曲線變化的趨勢相同，由表36可知解析解出的相對位移與仿真出來的相對位移基本相同，驗證了解析解的正確性。3. 5雅可比矩陣的推算和速度分析機器人的雅克比矩陣不但可以建立末端執(zhí)行器在基礎坐標的速度與各關節(jié)