前言

隨車吊可以應(yīng)用于導(dǎo)彈武器裝備運(yùn)輸、導(dǎo)彈半自動(dòng)填裝系統(tǒng)、危險(xiǎn)環(huán)境救援和果樹(shù)農(nóng)產(chǎn)品噴灑農(nóng)藥采摘等。在應(yīng)用到導(dǎo)彈武器裝備中時(shí)，導(dǎo)彈武器從生產(chǎn)到作戰(zhàn)訓(xùn)練和戰(zhàn)場(chǎng)運(yùn)用都需要運(yùn)輸手段，運(yùn)輸方式包括船舶運(yùn)輸、車輛運(yùn)輸和人員攜帶等；而裝備可靠性與裝備運(yùn)輸性能的優(yōu)劣有著緊密聯(lián)系，運(yùn)輸環(huán)境影響導(dǎo)彈裝備性能。在應(yīng)用到導(dǎo)彈半自動(dòng)填裝系統(tǒng)中時(shí)，填裝系統(tǒng)的功能是把準(zhǔn)備發(fā)射的導(dǎo)彈填裝到發(fā)射架上，填裝裝置主要是由一臺(tái)能把導(dǎo)彈裝到發(fā)射架或從發(fā)射架卸下來(lái)，為了代替操作手人工把導(dǎo)彈裝到發(fā)射架上并使導(dǎo)彈自動(dòng)進(jìn)入發(fā)射架上的準(zhǔn)確位置，先把要填裝的導(dǎo)彈運(yùn)送到與發(fā)射架相對(duì)應(yīng)的位置上，然后通過(guò)一個(gè)簡(jiǎn)單的旋轉(zhuǎn)動(dòng)作，便可將導(dǎo)彈單個(gè)或同時(shí)裝到相應(yīng)的發(fā)射上。應(yīng)用在救援機(jī)器人方面，面對(duì)越來(lái)越復(fù)雜和危險(xiǎn)的救援對(duì)策和世界范圍內(nèi)頻繁的人為和自然災(zāi)難，機(jī)器人協(xié)助甚至代替人類參與救援工作成為當(dāng)今救援的重要議題與手段。機(jī)器人在農(nóng)業(yè)方面的應(yīng)用，可以大大降低勞動(dòng)程度，提高勞動(dòng)生產(chǎn)率，解決勞動(dòng)力不足的難題，現(xiàn)代的農(nóng)業(yè)機(jī)器人是檢測(cè)技術(shù)、傳感技術(shù)、人工智能技術(shù)、圖形識(shí)別技術(shù)和通訊技術(shù)等多種技術(shù)集合于一身的機(jī)器。

我國(guó)在20世紀(jì)70、80年代才開(kāi)始研究隨車吊系統(tǒng)，由于起步較晚，國(guó)內(nèi)隨車吊機(jī)械臂的研究與發(fā)達(dá)國(guó)家還有較大差距。在王天然院士組織領(lǐng)導(dǎo)下七家合作單位經(jīng)過(guò)不懈努力研究出液壓驅(qū)動(dòng)救援隨車吊機(jī)械臂，這七家合作單位分別是浙江大學(xué)、北京航空航天大學(xué)、大連理工大學(xué)、西北工業(yè)大學(xué)、機(jī)械科學(xué)研究總院等。液壓驅(qū)動(dòng)救援隨車吊機(jī)械臂具有如下特點(diǎn)：一是油、電“雙動(dòng)力”交替驅(qū)動(dòng)，二是雙臂手作業(yè)，輪履復(fù)合行進(jìn)，三是雙臂末端的機(jī)械手可根據(jù)作業(yè)或救援現(xiàn)場(chǎng)需要而快速更換不同作業(yè)功能，這樣可使液壓驅(qū)動(dòng)救援隨車吊機(jī)械臂快速地完成裝卸、拆解、搶險(xiǎn)救援作業(yè)，

隨車吊機(jī)械臂的運(yùn)動(dòng)學(xué)模型是結(jié)構(gòu)分析的基礎(chǔ)，它不僅便于分析機(jī)構(gòu)的速度和加速度，也為研究動(dòng)力學(xué)相關(guān)問(wèn)題提供了便利。常見(jiàn)的方法為D-H參數(shù)表示法和齊次變換矩陣法。該方法的優(yōu)點(diǎn)是利用它便于進(jìn)行雅可比矩陣的計(jì)算和力分析等，但它在技術(shù)上仍存在著根本問(wèn)題是：針對(duì)僅在x和z軸運(yùn)動(dòng)的機(jī)械臂，可以進(jìn)行完整描述，而涉及到關(guān)于y軸的運(yùn)動(dòng)形式就不再適用。然而，隨車吊機(jī)械臂自動(dòng)轉(zhuǎn)載系統(tǒng)的機(jī)械機(jī)構(gòu)比較復(fù)雜，多存在回轉(zhuǎn)、旋轉(zhuǎn)、拉伸等多個(gè)關(guān)節(jié)，這將給D-H參數(shù)法在關(guān)節(jié)坐標(biāo)的設(shè)定帶來(lái)很多麻煩，采用齊次變換旋轉(zhuǎn)矩陣法對(duì)室外作業(yè)的液壓隨車吊機(jī)械臂系統(tǒng)進(jìn)行運(yùn)動(dòng)學(xué)建模，其方法簡(jiǎn)單，且效果直觀。

1、數(shù)學(xué)模型建立

本文首先要建立一個(gè)坐標(biāo)系，而坐標(biāo)系的建立就應(yīng)用Denavit-HartenBerg法(D-H法），再根據(jù)D-H法所建立的坐標(biāo)系推導(dǎo)機(jī)械臂的運(yùn)動(dòng)方程。D-H法是一種建立相對(duì)位姿的矩陣方法，在1995年Denavit和HartenBerg提出了這種方法并以他們兩人的名字命名為D-H法。D-H法利用齊次變換描述了各個(gè)連桿相對(duì)于固定參考系的空間幾何關(guān)系，相鄰兩連桿的空間關(guān)系用一個(gè)4*4的齊次變換矩陣來(lái)描述的，從而可以推導(dǎo)出末端執(zhí)行器的坐標(biāo)系相對(duì)于基坐標(biāo)系的坐標(biāo)變換矩陣，建立操作臂的運(yùn)動(dòng)方程。

若要求解機(jī)械臂正運(yùn)動(dòng)學(xué)必須要已經(jīng)知道機(jī)械臂各關(guān)節(jié)角度，再根據(jù)機(jī)械臂各關(guān)節(jié)角度求取機(jī)械臂末端執(zhí)行器的期望位姿，機(jī)械臂運(yùn)動(dòng)學(xué)問(wèn)題研究的標(biāo)準(zhǔn)方法是利用D-H法進(jìn)行分析建模，其基本思想是：首先要建立參考坐標(biāo)系，參考坐標(biāo)系要在機(jī)械臂各個(gè)關(guān)節(jié)處建立；其次確定任意2個(gè)相鄰坐標(biāo)系之間的轉(zhuǎn)換矩陣，將得到的矩陣依次相乘；最后得出基座至末端執(zhí)行器的總變換矩陣。

圖1六自由度模塊化機(jī)械臂

可以把機(jī)械臂看作是用關(guān)節(jié)連接起來(lái)的連桿構(gòu)成的，根據(jù)此機(jī)械臂的結(jié)構(gòu)特點(diǎn)，使用D-H法建立基坐標(biāo)系和各個(gè)關(guān)節(jié)坐標(biāo)系，六自由度機(jī)械臂是一種空間機(jī)構(gòu)，這種空間機(jī)構(gòu)具有六個(gè)關(guān)節(jié)。只有在每個(gè)關(guān)節(jié)處建立坐標(biāo)系，才能夠描述機(jī)械臂末端在空間的姿態(tài)和位置。

2、MATLAB簡(jiǎn)介

MATLAB是一種高級(jí)技術(shù)計(jì)算語(yǔ)言，MATLAB在數(shù)據(jù)可視化、算法開(kāi)發(fā)、數(shù)值計(jì)算以及數(shù)據(jù)分析方面發(fā)揮重要作用。MATLAB具有繪制函數(shù)和數(shù)據(jù)圖像、運(yùn)算矩陣、用C語(yǔ)言和C++等編程語(yǔ)言編寫程序、創(chuàng)建用戶界面等功能。MATLAB最大的得色是在數(shù)值計(jì)算方面。Matlab的繪制函數(shù)、矩陣運(yùn)算和創(chuàng)建用戶界面、連接其他編程語(yǔ)言等功能可以完成圖像處理、工程計(jì)算、控制設(shè)計(jì)、信號(hào)檢測(cè)等要求。矩陣是MATLAB的基本數(shù)據(jù)單位，工程、數(shù)學(xué)中所用到的形式與其指令表達(dá)式很相像，正因?yàn)檫@樣，與C和FORTRAN等語(yǔ)言相比用MATLAB來(lái)解決問(wèn)題要簡(jiǎn)單簡(jiǎn)捷得多。MATLAB優(yōu)勢(shì)特點(diǎn)

1)實(shí)現(xiàn)計(jì)算編程和結(jié)果的可視化，具有完備的圖形處理功能；

2）為了方便用戶，建立了像通信工具箱、信號(hào)處理工具箱等豐富的應(yīng)用工具箱；

3)符號(hào)計(jì)算及數(shù)值計(jì)算功能強(qiáng)大，能夠避免繁雜的數(shù)學(xué)運(yùn)算分析；

4)數(shù)學(xué)表達(dá)式及用戶界面的自然化語(yǔ)言，更方便學(xué)習(xí)和掌握。

可以說(shuō)MATLAB是一個(gè)集合，這些集合可以讓用戶所需要的計(jì)算功能全部都實(shí)現(xiàn)，集合包含超過(guò)六百個(gè)工程和科研中所要用到的計(jì)算算法。在計(jì)算要求一樣的情形下，用其它方法編程比MATLAB的編程的工作量會(huì)增加很多。MATLAB所擁有的這些函數(shù)集（例如特征向量、矩陣的復(fù)雜函數(shù)、傅立葉變換）能夠解決工程中很多計(jì)算問(wèn)題（例如工程中的優(yōu)化問(wèn)題、微分方程及偏微分方程的組的求解、傅立葉變換和數(shù)據(jù)的統(tǒng)計(jì)分析等）。

在圖形處理方面，MATLAB有了很大的進(jìn)步和發(fā)展，MATLAB不但對(duì)二維曲線和三維曲面的處理和繪制等一般軟件都具有的功能有所補(bǔ)充，而且對(duì)于圖形的色度處理、四維數(shù)據(jù)以及光照處理的這些其他軟件所沒(méi)有的功能表現(xiàn)出了出色的處理能力。MATLAB還具有數(shù)據(jù)可視化功能，這項(xiàng)從開(kāi)發(fā)時(shí)就擁有的功能可以方便用戶使用，數(shù)據(jù)可視化功能能夠以圖形的形式將矩陣和向量表達(dá)出來(lái)。高層次的作圖包括二維和三維的圖象處理、可視化、表達(dá)式和動(dòng)畫作圖可用于工程繪圖和科學(xué)計(jì)算，MATLAB也針對(duì)不同層次的用戶對(duì)類似圖形對(duì)話等特殊要求設(shè)計(jì)出來(lái)相應(yīng)的功能函數(shù)。

3、運(yùn)動(dòng)學(xué)仿真

對(duì)機(jī)械臂進(jìn)行運(yùn)動(dòng)學(xué)仿真，為了使機(jī)械臂運(yùn)動(dòng)的狀況能夠更立體直觀可以用圖形的方式把機(jī)械臂仿真結(jié)果表示出來(lái)，即機(jī)械臂能否滿足空間操作要求，動(dòng)作是否連貫和有無(wú)干涉現(xiàn)象。用數(shù)據(jù)曲線或數(shù)據(jù)本身與用圖形的方式進(jìn)行仿真相比，用圖形的方式可以分析出大量的重要信息，而用數(shù)據(jù)曲線或數(shù)據(jù)本身仿真則無(wú)法看出機(jī)器人的運(yùn)動(dòng)規(guī)律。

3.1正運(yùn)動(dòng)學(xué)的驗(yàn)證

圖3第八組機(jī)械臂的末端位姿

3.3差值規(guī)劃結(jié)果

以下是用插值法規(guī)劃的垂直抓取軌跡，本論文對(duì)空間曲線軌跡、速度和加速度都做了仿真，如圖4、圖5、圖6

圖4各坐標(biāo)軸曲線

圖5空間曲線軌跡

圖6關(guān)節(jié)速度曲線

4、結(jié)論

運(yùn)用D-H法建立坐標(biāo)系進(jìn)行隨車吊正運(yùn)動(dòng)學(xué)分析，求解機(jī)械臂的D-H參數(shù)；根據(jù)隨車吊機(jī)械臂末端的坐標(biāo)位置和隨車吊機(jī)械臂的運(yùn)動(dòng)學(xué)正解可以推得16組運(yùn)動(dòng)學(xué)逆解；本論文還運(yùn)用插值法對(duì)隨車吊機(jī)械臂的軌跡進(jìn)行規(guī)劃，用笛卡爾空間軌跡規(guī)劃法把運(yùn)動(dòng)學(xué)分為七個(gè)階段，對(duì)勻速階段和變加速階段分別進(jìn)行求解；本論文最后對(duì)正、逆運(yùn)動(dòng)學(xué)進(jìn)行仿真，設(shè)定桿的長(zhǎng)度、假定關(guān)節(jié)度數(shù)從而得出八組解，將這八組解與原定的數(shù)據(jù)相比較發(fā)現(xiàn)兩者數(shù)組相近，這充分證明了逆運(yùn)動(dòng)學(xué)的求解是正確的。

更多資訊請(qǐng)關(guān)注工業(yè)機(jī)器人頻道