機(jī)器人學(xué)基礎(chǔ)實(shí)驗(yàn)報(bào)告

經(jīng)典word整理文檔，僅參考，雙擊此處可刪除頁眉頁腳。本資料屬于網(wǎng)絡(luò)整理，如有侵權(quán)，請(qǐng)聯(lián)系刪除，謝謝！實(shí)驗(yàn)報(bào)告一、基本理論本實(shí)驗(yàn)以SCARA四自由度機(jī)械臂為例研究機(jī)器人的運(yùn)動(dòng)學(xué)問題.機(jī)器人運(yùn)動(dòng)學(xué)問題包括運(yùn)動(dòng)學(xué)方程的表示,,這些是研究機(jī)器人動(dòng)力學(xué)和機(jī)器人控制的重要基礎(chǔ),也是開放式機(jī)器人系統(tǒng)軌跡規(guī)劃的重要基礎(chǔ)。機(jī)械臂桿件鏈的最末端是機(jī)器人工作的末端執(zhí)行器(或者機(jī)械手)空間法和直角坐標(biāo)空間法。關(guān)節(jié)坐標(biāo)空間：節(jié)矢量，關(guān)節(jié)矢量構(gòu)成的空間稱為關(guān)節(jié)坐標(biāo)空間。圖1-1是GRB400機(jī)械臂的關(guān)描述對(duì)于運(yùn)動(dòng)控制是非常直接的。直角坐標(biāo)空間：機(jī)器人末端的位臵和方位也可用所在的直角坐標(biāo)空間的坐標(biāo)及方位角來描（如圖1-2）。正向運(yùn)動(dòng)學(xué)求解（運(yùn)動(dòng)學(xué)正解）問題；反之，當(dāng)末端執(zhí)行器在直角坐標(biāo)系中的坐學(xué)反解問題相對(duì)難度較大，但在機(jī)器人控制中占有重要的地位。機(jī)器人逆運(yùn)動(dòng)學(xué)求解問題包括解的存在性、唯一性及解法三個(gè)問題。端執(zhí)行器位臵在工作空間外，則解不存在。按照最短行程的準(zhǔn)則來選擇最優(yōu)解，盡量使每個(gè)關(guān)節(jié)的移動(dòng)量最小。D-H變化方法求解運(yùn)動(dòng)學(xué)問題。建立坐標(biāo)系如下圖所示連桿坐標(biāo)系{i}相對(duì)于{i1}的變換矩陣可以按照下式計(jì)算出，其中連桿坐標(biāo)系D-H參數(shù)為由表1-1給出。齊坐標(biāo)變換矩陣為：iii描述連桿本身的特征；和描述連桿1與之間的聯(lián)系。其中是關(guān)節(jié)變量，其它三個(gè)參數(shù)不變。表1-1連桿參數(shù)表其中連桿長(zhǎng)l=200mm，l=200mm，機(jī)器人基坐標(biāo)系為O-XYZ。根據(jù)上面的01坐標(biāo)變換公式，就可以確定各個(gè)關(guān)節(jié)的位姿矩陣。200運(yùn)動(dòng)學(xué)模型）為：其中：z軸為手指接近物體的方向，稱接近矢量a（approach）；y軸為（orientationx軸稱法向矢量（normal由右手法則確定，n=o*a。p為手爪坐標(biāo)系原點(diǎn)在基坐標(biāo)系中的位臵矢量。運(yùn)動(dòng)學(xué)逆解：通常可用未知的連桿逆變換右乘上式：令兩式對(duì)應(yīng)元素分別相等即可解出。注意：關(guān)節(jié)運(yùn)動(dòng)范圍：θ：0~180°1θ：0~100°2d:±40mm3θ:±170°4二、實(shí)驗(yàn)?zāi)康?．了解四自由度機(jī)械臂的開鏈結(jié)構(gòu)；2．掌握機(jī)械臂運(yùn)動(dòng)關(guān)節(jié)之間的坐標(biāo)變換原理；3．學(xué)會(huì)機(jī)器人運(yùn)動(dòng)方程的正反解方法。三、實(shí)驗(yàn)系統(tǒng)構(gòu)成計(jì)算機(jī)。PCI運(yùn)動(dòng)控制卡安裝在計(jì)算機(jī)內(nèi)，通過伺服驅(qū)動(dòng)系統(tǒng)對(duì)機(jī)械臂的四個(gè)關(guān)節(jié)的交流伺服電動(dòng)機(jī)驅(qū)動(dòng)控制，實(shí)現(xiàn)所需的關(guān)節(jié)運(yùn)動(dòng)。各部分的邏輯關(guān)系如圖1-5所示。圖四、實(shí)驗(yàn)步驟步驟1．檢查實(shí)驗(yàn)系統(tǒng)各部分的信號(hào)連接線、電源是否插好，完成后打開伺服驅(qū)動(dòng)系統(tǒng)的電源開關(guān)。步驟2．運(yùn)行GRBserver程序，出現(xiàn)以下程序界面。圖步驟3．按下“打開控制器”按鈕，按下“伺服上電”按鈕。步驟4．清理周圍環(huán)境，避免機(jī)械臂運(yùn)動(dòng)時(shí)打到周圍的人或物。檢查末端執(zhí)行器上的電線連接，避免第四個(gè)關(guān)節(jié)運(yùn)動(dòng)時(shí)電線纏繞而被拉斷。步驟5．按下“自動(dòng)回零”按鈕，機(jī)械臂自動(dòng)回零。步驟6快。步驟7．在“示教操作”區(qū)按下相應(yīng)關(guān)節(jié)按鈕，觀察機(jī)械臂的運(yùn)動(dòng)情況。此時(shí)可以按下“記錄”按鈕，以便以后重復(fù)該次運(yùn)動(dòng)。步驟8．重復(fù)步驟7，演示各種運(yùn)動(dòng)及功能。五、實(shí)驗(yàn)報(bào)告1.正解實(shí)驗(yàn)程序：變量初始化程序：%clearsymst1t2t3t4;symsalp1alp2alp3alp4;symsa1a2a3a4;symsd1d2d3d4;各矩陣初始化矩陣：%T010000%T120000%T230000%T340000各參數(shù)賦值程序：%====%11角%22角%3d344角正解計(jì)算主程序：%2.正解實(shí)驗(yàn)結(jié)果：θ2(deg)θ4(deg)參數(shù)值：30正解理論值直角坐標(biāo)X直角坐標(biāo)Y直角坐標(biāo)Z手抓姿態(tài)273.2051273.2051-10.000045.0000正解實(shí)驗(yàn)值直角坐標(biāo)X直角坐標(biāo)Y直角坐標(biāo)Z手抓姿態(tài)1045結(jié)果：273.2000273.2000偏差值0.0019%-10.000045.00000.0019%0.0000%0.0000%θ2(deg)θ4(deg)參數(shù)值：2090正解理論值直角坐標(biāo)X直角坐標(biāo)Y直角坐標(biāo)Z手抓姿態(tài)141.4214341.4214-20.000090.0000正解實(shí)驗(yàn)值直角坐標(biāo)X直角坐標(biāo)Y直角坐標(biāo)Z手抓姿態(tài)結(jié)果：141.4214341.4214偏差值0.0000%-20.000090.00000.0000%0.0000%0.0000%θ2(deg)θ4(deg)參數(shù)值：45正解理論值直角坐標(biāo)X直角坐標(biāo)Y直角坐標(biāo)Z手抓姿態(tài)-141.4214341.4214-20.000090.0000正解實(shí)驗(yàn)值直角坐標(biāo)X直角坐標(biāo)Y直角坐標(biāo)Z手抓姿態(tài)2090結(jié)果：-141.4214341.4214偏差值0.0000%-20.000090.00000.0000%0.0000%0.0000%θ2(deg)θ4(deg)29-100參數(shù)值：正解理論值直角坐標(biāo)X直角坐標(biāo)Y直角坐標(biāo)Z手抓姿態(tài)166.8871256.9836-29.0000-100.0000正解實(shí)驗(yàn)值直角坐標(biāo)X直角坐標(biāo)Y直角坐標(biāo)Z手抓姿態(tài)結(jié)果：166.8874256.9833偏差值0.0001%-28.9997-99.99990.0002%0.0009%0.0001%θ2(deg)θ4(deg)35150參數(shù)值：170正解理論值直角坐標(biāo)X直角坐標(biāo)Y直角坐標(biāo)Z手抓姿態(tài)-231.6912-162.2319-35.0000150.0000正解實(shí)驗(yàn)值直角坐標(biāo)X直角坐標(biāo)Y直角坐標(biāo)Z手抓姿態(tài)結(jié)果：-231.6914-162.2316偏差值0.0002%-34.9999149.99990.0001%0.0003%0.0001%3.反解實(shí)驗(yàn)程序：變量初始化程序：%clearsymst1t2t3t4;symsalp1alp2alp3alp4;symsa1a2a3a4;symsd1d2d3d4;反解賦值程序：%%0010%%%0000=150;X=280;Y=-25;ZT04計(jì)算程序：%反解計(jì)算主程序：%symsnxnynzoxoyozaxayazpxpypz;;;;0001++,++200*sin(t1)=py','t1','t2'4.反解實(shí)驗(yàn)結(jié)果：直角坐標(biāo)X(P)直角坐標(biāo)Y(P)直角坐標(biāo)Z(P)參數(shù)：XYZ141.4214-20.0000變量：理論結(jié)果：實(shí)驗(yàn)結(jié)果：偏差值:θ1(deg)45.000045.00000.0000%θ2(deg)45.000044.99960.0008%d3(mm)20.000020.00000.0000%第一組直角坐標(biāo)X(P)直角坐標(biāo)Y(P)直角坐標(biāo)Z(P)參數(shù)：XYZ-141.4214-20.0000變量：理論結(jié)果：實(shí)驗(yàn)結(jié)果：偏差值:θ1(deg)90.000090.00000.0000%θ2(deg)45.000044.99960.0008%d3(mm)20.000020.00000.0000%第二組直角坐標(biāo)X(P)直角坐標(biāo)Y(P)直角坐標(biāo)Z(P)參數(shù)：XYZ241.6091-30.0000變量：理論結(jié)果：實(shí)驗(yàn)結(jié)果：偏差值:θ1(deg)30.000029.99990.0004%θ2(deg)40.000040.00000.0000%d3(mm)30.000029.99980.0006%第三組第四組第五組直角坐標(biāo)X(P)直角坐標(biāo)Y(P)直角坐標(biāo)Z(P)參數(shù)：XYZ200.0000-15.0000變量：理論結(jié)果：實(shí)驗(yàn)結(jié)果：偏差值:θ1(deg)30.651030.65080.0008%θ2(deg)51.320051.31750.0050%d3(mm)15.000014.