基于力反饋器的模塊化機(jī)器人控制建模與仿真

基于力反饋器的模塊化機(jī)器人控制建模與仿真

　　摘 要：建立了一個(gè)基于力反饋器直觀控制模塊化機(jī)器人的模型，通過(guò)對(duì)模塊化機(jī)器人和力反饋器進(jìn)行獨(dú)立建模，然后對(duì)模型中的參數(shù)分別進(jìn)行對(duì)應(yīng)，使得模塊化機(jī)器人末端位置和姿態(tài)與力反饋器的位置和姿態(tài)一一對(duì)應(yīng)，從而達(dá)到直觀控制效果，經(jīng)仿真實(shí)驗(yàn)證明本模型的有效性。
　　關(guān)鍵詞：力反饋器；模塊化；控制；DH 參數(shù)1 引言計(jì)算機(jī)技術(shù)、電子技術(shù)、人工智能等的快速發(fā)展促進(jìn)了機(jī)器人技術(shù)的發(fā)展。除了工業(yè)機(jī)器人水平不斷提高之外,各種水下、空間、核工業(yè)等遙操作機(jī)器人成為研究熱點(diǎn),也取得了很大的進(jìn)步,大大延伸了人的活動(dòng)范圍。盡管如此,在深海、太空以及核輻射等危險(xiǎn)的、人不適合或不可達(dá)領(lǐng)域,完全依靠機(jī)器人自主的完成各種作業(yè)任務(wù)目前還不現(xiàn)實(shí)。工作在交互方式下的機(jī)器人遙操作系統(tǒng)是在復(fù)雜或非確定環(huán)境下完成作業(yè)任務(wù)的一種實(shí)用手段,虛擬機(jī)器人是遙操作系統(tǒng)基本框架中不可或缺的一部分,是解決信號(hào)傳輸中的大時(shí)延、實(shí)現(xiàn)預(yù)測(cè)顯示技術(shù)的關(guān)鍵之一,本文針對(duì)模塊機(jī)器人的特性，采用PHANToM Desktop 作為虛擬環(huán)境系統(tǒng)交互設(shè)備，并通過(guò)建立一個(gè)直觀控制模型來(lái)操縱模塊化機(jī)器人進(jìn)行抓取物體。
　　2 DH 模型機(jī)器人本體由一串用轉(zhuǎn)動(dòng)或平移關(guān)節(jié)連接的剛體（桿件）組成。每一對(duì)關(guān)節(jié)-桿件構(gòu)成一個(gè)自由度。六自由度機(jī)器人也就有六對(duì)關(guān)節(jié)-桿件。桿件的編號(hào)有手臂的固定基座開(kāi)始，將基座編號(hào)為0，接著基座的第一個(gè)運(yùn)動(dòng)體是桿件1，依次類(lèi)推。為描述相鄰桿件間平移和轉(zhuǎn)動(dòng)的關(guān)系，以下采用D-H 表示法來(lái)推導(dǎo)。D-H 方法是對(duì)機(jī)器人連桿和關(guān)節(jié)進(jìn)行建模的一種非常有效的方法，可用于任何機(jī)器人結(jié)構(gòu)，而不管機(jī)器人的結(jié)構(gòu)順序和復(fù)雜程度；D-H 方法是為每個(gè)關(guān)節(jié)處的桿件坐標(biāo)系建立4×4 齊次變換矩陣，表示它與前一桿件坐標(biāo)系的關(guān)系。
　　3 模塊化機(jī)器人建模
　　模塊化機(jī)器人是由一套各種功能的模塊組成的，通過(guò)選擇不同的模塊組合就可裝配成不同模塊化的機(jī)器人，模塊化機(jī)器人構(gòu)形設(shè)計(jì)的目的就是如何找到一個(gè)最優(yōu)的裝配構(gòu)形來(lái)完成給定的工作，所以模塊化機(jī)器人的DH 參數(shù)模型是根據(jù)不同的組裝而發(fā)生變化的，是本實(shí)驗(yàn)室組裝的模塊化機(jī)器人，該機(jī)器人有6 個(gè)關(guān)節(jié)和1 個(gè)手抓，其中全部關(guān)節(jié)都是旋轉(zhuǎn)關(guān)節(jié)，而手抓是平動(dòng)手抓。在DH 建模時(shí)，手抓的參數(shù)先不用考慮，本文只考慮前6 個(gè)關(guān)節(jié)的動(dòng)作對(duì)手抓的位置和姿態(tài)的影響。
　　對(duì)于非模塊化機(jī)器人在出廠時(shí)都有一個(gè)DH 參數(shù)表，表示該機(jī)器人的尺寸和構(gòu)型，而由于模塊化機(jī)器人是自行組裝的，所以出廠時(shí)只有部件的尺寸表，沒(méi)有DH 參數(shù)表，DH 參數(shù)根據(jù)自行組裝的構(gòu)型進(jìn)行定義因此，需要給每個(gè)關(guān)節(jié)指定一個(gè)參考坐標(biāo)系，然后，確定從一個(gè)關(guān)節(jié)到下一個(gè)關(guān)節(jié)（一個(gè)坐標(biāo)系到下一個(gè)坐標(biāo)系）來(lái)進(jìn)行變換的步驟。如果將從基座到第一個(gè)關(guān)節(jié)，再?gòu)牡谝粋�(gè)關(guān)節(jié)到第二個(gè)關(guān)節(jié)直至到最后一個(gè)關(guān)節(jié)的所有變換結(jié)合起來(lái)，就得到了機(jī)器人的總變換矩陣。
　　模型機(jī)器人本體由一串用轉(zhuǎn)動(dòng)或平移關(guān)節(jié)連接的剛體（桿件）組成。每一對(duì)關(guān)節(jié)-桿件構(gòu)成一個(gè)自由度。六自由度機(jī)器人也就有六對(duì)關(guān)節(jié)-桿件。桿件的編號(hào)有手臂的固定基座開(kāi)始，將基座編號(hào)為0，接著基座的第一個(gè)運(yùn)動(dòng)體是桿件1，依次類(lèi)推。為描述相鄰桿件間平移和轉(zhuǎn)動(dòng)的關(guān)系，以下采用D-H 表示法來(lái)推導(dǎo)。D-H 方法是對(duì)機(jī)器人連桿和關(guān)節(jié)進(jìn)行建模的一種非常有效的方法，可用于任何機(jī)器人結(jié)構(gòu)，而不管機(jī)器人的結(jié)構(gòu)順序和復(fù)雜程度；D-H 方法是為每個(gè)關(guān)節(jié)處的桿件坐標(biāo)系建立4×4 齊次變換矩陣，表示它與前一桿件坐標(biāo)系的關(guān)系。
　　因此，需要給每個(gè)關(guān)節(jié)指定一個(gè)參考坐標(biāo)系，然后，確定從一個(gè)關(guān)節(jié)到下一個(gè)關(guān)節(jié)（一個(gè)坐標(biāo)系到下一個(gè)坐標(biāo)系）來(lái)進(jìn)行變換的步驟。如果將從基座到第一個(gè)關(guān)節(jié)，再?gòu)牡谝粋�(gè)關(guān)節(jié)到第二個(gè)關(guān)節(jié)直至到最后一個(gè)關(guān)節(jié)的所有變換結(jié)合起來(lái)，就得到了機(jī)器人的總變換矩陣。
　　4 力反饋器建模系列的力覺(jué)/觸覺(jué)反饋設(shè)備是上世紀(jì)90 年代初由美國(guó)麻省理工大學(xué)設(shè)計(jì)的，它共有。耐Omni，Desktop 和Premium 三種型號(hào)， PHANToM Desktop 型產(chǎn)品的結(jié)構(gòu)。它有6 個(gè)自由度的位姿輸入和3 個(gè)自由度的力反饋，其結(jié)構(gòu)類(lèi)似于6 自由度關(guān)節(jié)型機(jī)械手臂。
　　當(dāng)操作者移動(dòng)PHANToM 末端的手柄時(shí)，PHANToM 各個(gè)關(guān)節(jié)和手臂隨末端手柄一起協(xié)同運(yùn)動(dòng)。
　　型(以下簡(jiǎn)稱(chēng)PHANToM)力覺(jué)/觸覺(jué)反饋設(shè)備具有兩個(gè)基本功能:位姿輸入和力覺(jué)/觸覺(jué)反饋。這兩個(gè)基本功能是由6 個(gè)關(guān)節(jié)機(jī)構(gòu)實(shí)現(xiàn)的，其中1、2、3 關(guān)節(jié)中的每個(gè)關(guān)節(jié)上有一個(gè)直流電機(jī)和一個(gè)編碼器，這三個(gè)直流電機(jī)協(xié)調(diào)工作決定了反饋力的大小和方向。計(jì)算機(jī)通過(guò)讀取關(guān)節(jié)1、2、3 上的編碼器數(shù)值和PHANToM 臂A、B、C 的固定長(zhǎng)度計(jì)算出HIP 在PHANToM 坐標(biāo)系的位置。4、5、6 關(guān)節(jié)組成了一個(gè)萬(wàn)向節(jié)，決定了HIP 的姿態(tài)(即旋轉(zhuǎn)量)，同樣4、5、6 關(guān)節(jié)的每個(gè)關(guān)節(jié)上也有一個(gè)編碼器，計(jì)算機(jī)通過(guò)讀取編碼器的數(shù)值，獲得HIP 在PHANToM 坐標(biāo)系的姿態(tài)。
　　第三個(gè)部件的末端，由于四，五，六關(guān)節(jié)是決定力反饋器的姿態(tài)，而且這三個(gè)關(guān)節(jié)等效于一個(gè)球關(guān)節(jié)，所以這三個(gè)關(guān)節(jié)的坐標(biāo)系放在一起表示姿態(tài)坐標(biāo)系，在操作的時(shí)候，這三個(gè)坐標(biāo)系的原點(diǎn)是始終重合的。
　　5 控制模型建立為了能利用力反饋器控制模塊化機(jī)器人，需要對(duì)兩個(gè)DH 模型進(jìn)行對(duì)應(yīng)，從上面的建�？梢钥闯�，兩個(gè)模型是不一致的，力反饋器DH 模型是標(biāo)準(zhǔn)的DH 模型，前三個(gè)關(guān)節(jié)控制位置，后三個(gè)關(guān)節(jié)控制姿態(tài)，位置與姿態(tài)是解藕的，互不相關(guān)，而模塊化機(jī)器人的DH 模型中，位置與姿態(tài)是不能解藕的，六個(gè)關(guān)節(jié)都會(huì)對(duì)位置和姿態(tài)有影響，所以如果單純的利用力反饋器前三個(gè)關(guān)節(jié)對(duì)應(yīng)模塊化前三個(gè)關(guān)節(jié)進(jìn)行位置控制，利用力反饋器后三個(gè)關(guān)節(jié)對(duì)應(yīng)模塊化后三個(gè)關(guān)節(jié)進(jìn)行姿態(tài)控制是不可取的。
　　在模塊化機(jī)器人的DH 模型中，由于六個(gè)關(guān)節(jié)對(duì)位置和姿態(tài)都有影響，那么本文利用六個(gè)關(guān)節(jié)同時(shí)控制模塊化機(jī)器人的位置和姿態(tài)，而不是把位置和姿態(tài)的關(guān)節(jié)分開(kāi)，對(duì)于力反饋器，利用前三個(gè)關(guān)節(jié)控制位置，利用后三個(gè)關(guān)節(jié)控制姿態(tài)，這樣就得到了兩個(gè)方程組。
　　通過(guò)求解方程組（10），就可以得到模塊機(jī)器人的位置和姿態(tài)，而且模塊機(jī)器人的位置和姿態(tài)與力反饋器的位置和姿態(tài)是對(duì)應(yīng)的。公式（10）左右兩邊看上去相似，但意義是不一樣的，左邊可以整合成一個(gè)4×4 矩陣是因?yàn)榱鶄�(gè)關(guān)節(jié)對(duì)姿態(tài)和位置都有影響，所以位置和姿態(tài)的計(jì)算需要用到六個(gè)變換矩陣，而右邊可以整合成一個(gè)4×4 矩陣是因?yàn)樵跇?biāo)準(zhǔn)DH 模型里位置矩陣不影響姿態(tài)矩陣，姿態(tài)矩陣不影響位置矩陣。
　　模型求解對(duì)應(yīng)公式（10）的非線性方程組，用代數(shù)法是非常難求解出來(lái)的，為了便于編程方便，本文采用牛頓法進(jìn)行求解。關(guān)于牛頓法求解非線性方程組可以參考文獻(xiàn)[5]。在力反饋器的操作過(guò)程中，動(dòng)作是連貫的，而且力反饋器的每個(gè)關(guān)節(jié)在三維空間上劃過(guò)的痕跡是連續(xù)的，考慮到時(shí)空的相關(guān)性，本算法在用牛頓法求解非線性方程組中，初值取模塊化機(jī)器人當(dāng)前關(guān)節(jié)的角度，這樣可以非常快的迭代到最優(yōu)解，從而大大節(jié)省求解時(shí)間。
　　實(shí)驗(yàn)結(jié)果為了驗(yàn)證上述模型的有效性，本實(shí)驗(yàn)基于matlab 進(jìn)行了控制仿真實(shí)驗(yàn)，本實(shí)驗(yàn)采用模塊化機(jī)器人作為操作對(duì)象，并利用力反饋器進(jìn)行操作，利用力反饋器進(jìn)行模塊化機(jī)器人的操縱是非常容易直觀的，手抓的位置跟著力反饋器的第三個(gè)姿態(tài)末端運(yùn)動(dòng)，手抓的姿態(tài)與力反饋器最后部件的姿態(tài)是一致的，所以利用本算法進(jìn)行建�？梢苑浅Ｖ庇^的控制模塊化機(jī)器人。
　　8 總結(jié)與展望
　　本文提出了一種直觀控制模塊化機(jī)器人的模型，該模型克服了模塊化機(jī)器人在位置和姿態(tài)不能解藕的難點(diǎn)，在位置和姿態(tài)上，模塊化機(jī)器人基本模仿力反饋器的動(dòng)作，從而達(dá)到直觀控制的效果，本算法在虛擬平臺(tái)上被證明是有效可行的。

【基于力反饋器的模塊化機(jī)器人控制建模與仿真】相關(guān)文章：

基于PLC的斷路器型式試驗(yàn)系統(tǒng)設(shè)計(jì)03-10

基于Gene8310的嵌入式家庭服務(wù)機(jī)器人05-11

基于電話網(wǎng)絡(luò)的熱網(wǎng)遠(yuǎn)程控制系統(tǒng)設(shè)計(jì)05-11

模塊化開(kāi)題報(bào)告范文10-24

基于主成分分析及二次回歸分析的城市生活垃圾熱值建模08-06

基于dsp三相變流器滑模變結(jié)構(gòu)控制（c）06-03

基于工業(yè)機(jī)器人的自動(dòng)化生產(chǎn)技術(shù)研究論文04-14

適應(yīng)實(shí)時(shí)多任務(wù)的微控制器高效指令支持05-29

數(shù)學(xué)建模論文模板07-22

數(shù)學(xué)建模論文模板07-22