1、機器人運動學與動力學運動學：從幾何的角度（指不涉及物體本身的物理性質和加在物體上的力）描述和研究物體位置隨時間的變化規律的力學分支。以研究質點和剛體這兩個簡化模型的運動為基礎，并進一步研究變形體（彈性體、流體等）的運動。即既涉及運動又涉及受力情況的，或者說跟物體質量有關系的問題。常與牛頓第二定律或動能定理、動量定理等式子中含有 m的學問。含有m說明要研究物體之間的的相互作用（就是力）。動力學：理論力學的一個分支學科，它主要研究作用于物體的力與物體運動的關系。動力學的研究對象是運動速度遠小于光速的宏觀物體。跟質量與受力無關，只研究速度、加速度、位移、位置、角速度等參量的常以質點為模型的題。只有一

2、個物體的話研究它的質量沒有什么意義，因為質量就是它的慣性大小，或被力影響的強弱，而力必須是兩個物體之間的。工業機器人運動學涉及到機器人手臂（機械手）相對于固定參考坐標系原點幾何關系的分析研究，特別機器人手臂末端執行器位置和姿態與關節空間變量之間的關系。.運動學方程的正解正問題：已知關節變量 qi的值，求手在空間的位姿 To正解特征：唯一性用處：檢驗、校準機器人.運動學方程的逆解逆問題：已知手在空間的位姿T,求關節變量qi的值。逆解特征分三種情況：多解、唯一解、無解多解的選擇原則：最近原則計算方法：逆遞推法.桿件坐標系的建立：坐標系號的分配方法機器人的各連桿通過關節連接在一起，關節有移動副與轉動

3、副兩種。按從機座到末端執行 器的順序，由低到高依次為各關節和各連桿編號，如圖 1.15所示。機座的編號為桿件 0, 與機座相連的連桿編號為桿件1,依此類推。機座與連桿 1的關節編號為關節1,連桿1與連桿2的連接關節編號為 2,依此類推。各連桿的坐標系Z軸方向與關節軸線重合（對于移動關節，Z軸線沿此關節移動方向）。圖L心機器人坐標系的與加末端執行器上的坐標系依據夾持器 （手爪）手指的運動方向固定在末端執行器上。 原點位于形 心；Xn沿末端執行器手指組成的平面的法向，故又被稱為法線矢量；Yn垂直于手指，稱為姿態矢量。Zn的方向朝外指向目標，稱為接近矢量。.建立并求解運動學方程(1)建立坐標系機座坐

4、標系0建立原則：Z0 軸垂直，X0軸水平，X0方向指向手部所在平面。桿件坐標系i, i=1, 2,，n建立坐標系的總原則：是使桿件的單步坐標變換簡單建立三維運動坐標系的三原則：第一原則：一軸與關節軸線重合，第二原則：另一軸與兩關節軸線的距離重合，第三原則：二者必有一軸沿桿件指向。桿件坐標系有兩種：第一種：i坐標系建立在第i+1關節上;第二種：i坐標系建立在第i關節上。桿件坐標系i第一種坐標系：i坐標系建立在第i+1關節上。i坐標系建立在第i+1關節上。O第二種坐標系：i坐標系建立在第i關節上。在第一種桿件坐標系下，h與n坐標系重合。在第二種桿件坐標系下，h與n坐標系的方向保持一致。(2)確定參

5、數桿件幾何參數(不變)I、桿件長度ai：兩關節軸線的距離。II、桿件扭角 如兩關節軸線的夾角。關節運動參數I、關節平移量di：II、關節回轉量 Qi：關節變量：di平移關節；Qi回轉關節。E1.16轉前關節隹樸坐標系建立示總囹(3)相鄰桿件位姿矩陣E1.16轉前關節隹樸坐標系建立示總囹（4）建立方程用表示機器人連桿 n坐標系的坐標變換成連桿 n 1坐標系的坐標的齊次坐標變換矩陣， 通常把上標省略，寫成 An。對于n個關節的機器人，前一個關節向后一個關節的坐標齊次 變換矩陣分別為r ；- 也就是-其中，A1表示桿件1上白1 1號坐標系到機座的 0號坐標系的齊次坐標變換矩陣。在機器人的基座上，可以

6、從第一個關節開始變換到第二個關節，然后到第三個；再到機器人的手，最終到末端執行器。若把每個變換定義為，則可以得到許多表示變換的矩陣。在機器人的基座與手之間的總變換則為：RTh = RTT22T3n1Tn 二 A 4 A3A其中n是關節數。對于一個具有六個自由度的機器人而言，有6個A矩陣。例：已知三自由度平面關節機器人如圖所示，設機器人桿件 建立機器人的運動學方程。4解：（1）建立坐標系（第一種）4a、機座坐標系 0b、桿件坐標系 ic、手部坐標系 h（與末端桿件坐標系 n重合）idi0ili(Xiidi0ili(Xiqi10a1100120取120023003130031、2、3 的長度為 l

7、i, 12, 13。y2典（3）相鄰桿件位姿矩陣M 01 =Rot(z,%) Trans (11,0,0)cos-sin x sin 01 cos6100_00cos %-sin %sin 91cos6100_000 0 10 00 0 0 1 01 0 0 0 10 10000 11 cos 10l1sin 日 1（4）建立方程將相鄰桿件位姿矩陣依次相乘，則有:111001同理可得：M 12 =Rot(z,i2) Trans(12,0,0)cos02-sin 02012 cos日 2sin仇cos 62012 sin02-0010一 0001同理可得：M 23(h) = Rot(z,03)

8、Trans(13,0,0)cos 63-sin03013 cos03sin acos 63013sin03-0010-000112+ 13c8123 I+ 131230。123-弭2301槨+ 12cBS1230123011soi十 12s00010J 00012 +63 ),S%23 =Sin(d十 %+ 63),S12= sin(61g)12式中：0123 =COS(F .二C% =COS口 12Moh =Mo1 M12 M 23(h)若用矩陣形式表示，則為:ABxCxPx-。8123-s123011c91 +12c012十 13cg123AyByCyPyS6123。6123011sH1

9、+12s%+ 13s6123AzBzCzPz00100001 _10001若用方程組形式表示，則為：Ax =明23Ay = $8123Bx = -s9123By =c%3Px =124 +12鳳 +13風3Py 二履弓 ks413s43解：（1）建立坐標系（第二種）a、機座坐標系 0b、桿件坐標系 ic、手部坐標系 h（與末端桿件坐標系 n方向一致）iai-1為-1dii0qi1iai-1為-1dii0qi10001012110020231200303(2)確定參數(3)相鄰桿件位姿矩陣M01 =Rot(z,q)cos sin 91-I 0I 0-sincos%00001001001M12 =

10、Trans(li,0,0) Rot(z,%)cos%-sin2011sin %cos%000010_ 0001_M23 =Trans(12,0,0) Rot(z3) cos%-sin%012sin 4cos30000100001_M3h =Trans(l3,0,0)1 0 0 I3 0 10 0 0 0 10 9 0 0 11(4)建立方程將相鄰桿件位姿矩陣依次相乘，則有：包3S123M0h =M01M12 M23 M3h =010- S?123011C，1 2CF2+130123C7,1230LS，12S%+13s1123010001式中：0-123 =COS(M-2-3), S-123 =sin(，