姜柏森,楊永勝,胡士強(qiáng)
(上海交通大學(xué),上海 200240)
變幾何桁架機(jī)器人是超冗余度機(jī)器人的一種,相比于同樣體積和重量的傳統(tǒng)機(jī)器人而言,變幾何桁架機(jī)器人的具有良好的優(yōu)點:靈活性、模塊化、剛度大和柔性。因為這些優(yōu)點,變幾何桁架機(jī)器人在宇宙空間,工業(yè)自動化和開發(fā)新的機(jī)器人機(jī)構(gòu)方面具有廣闊的應(yīng)用前景。
最近,有很多文章都對變幾何桁架機(jī)器人做出了深入的研究,例如有多篇文章介紹了基于神經(jīng)網(wǎng)絡(luò)方法的八面體變幾何桁架機(jī)器人的運(yùn)動學(xué)研究[1~3]。也有一些文章基于粒子群算法對八面體變幾何桁架機(jī)器人的運(yùn)動學(xué)進(jìn)行了研究[4]。但是這些方法都有一些共同的缺點,就是無法用代數(shù)方法對其精確的求解,這導(dǎo)致了這些方法會出現(xiàn)計算速度慢,計算得不到最優(yōu)解等特點。本文基于以上方法的缺點,結(jié)合變幾何桁架機(jī)器人自身的特點提出了一種變幾何桁架機(jī)器人結(jié)構(gòu),該結(jié)構(gòu)不僅能夠解決以上文章中出現(xiàn)的無法求得代數(shù)解的問題,同時使機(jī)器人運(yùn)動學(xué)的運(yùn)算具有很高的精度。
為了解釋運(yùn)動學(xué)問題,首先,我們需要介紹一下單模塊變幾何桁架機(jī)器人的結(jié)構(gòu)。
正如圖1所示,一個單模塊變幾何桁架機(jī)器人是由兩個對稱的八面體桁架結(jié)構(gòu)組合而成,其中兩個八面體桁架有一個共同的平面M。這個聯(lián)接平面同樣被叫做執(zhí)行平面,因為單模塊變幾何桁架機(jī)器人的三個可改變長度的控制器是這個平面的三條邊。兩個八面體桁架是關(guān)于鏈接平面M對稱的,而其中每個八面體中與平面M相對的平面我們分別定義為底面B與頂面P。為了方便下面的計算,我們用符號表達(dá)這三個控制器的長度。在實際情況下,由于考慮到機(jī)械的實際操作上的困難,執(zhí)行器平面實際上是有一定厚度的,這個厚度我們用符號來表示。這樣,其執(zhí)行器平面就分為上中下三個平面,三個可改變長度的控制器位于中間平面,其中我們用符號來表達(dá)低執(zhí)行器平面的三個節(jié)點。對于桁架結(jié)構(gòu)的其他桿,我們設(shè)計時均使其為固定長度,對于桁架模型底面與頂面的桿,其長度我們用表示,而其余側(cè)平面的桿的長度,我們用來表示。
圖1 單模塊變幾何桁架機(jī)器人的物理結(jié)構(gòu)
同樣的為了更為清楚的說明運(yùn)動學(xué)問題,我們需要引入其他的符號。如圖2所示,我們用和來表示底面中心點坐標(biāo)與頂面中心點坐標(biāo)。而與則被用來表示底面與頂面的法向量。用來表示從底面中心點到頂面中心點的單位向量,同時,考慮模型的對稱性,它也是執(zhí)行平面的法向量。最后我們用r來表示從沿著向量到達(dá)中心執(zhí)行平面的長度。
圖2 運(yùn)動學(xué)模型所需參數(shù)
圖3 中間參數(shù)
所以,通過上面所提到的符號和單模塊運(yùn)動學(xué)機(jī)器人模型的對稱性,我們將會在接下來介紹雙八面體變幾何桁架機(jī)器人運(yùn)動學(xué)問題。
單模塊變幾何桁架機(jī)器人運(yùn)動學(xué)問題包括正向運(yùn)動學(xué)問題和逆向運(yùn)動學(xué)問題。下面我們將一一介紹。
對于單模塊變幾何桁架機(jī)器人的正向運(yùn)動學(xué)問題,我們需要通過三個控制器的長度 來計算出末端平面中心點的坐標(biāo)點位置,所以正向運(yùn)動學(xué)的輸入變量即為而輸出變量即為首先,我們應(yīng)明確坐標(biāo)系的定義,其坐標(biāo)系定義如圖4所示。
圖4 機(jī)器人坐標(biāo)系示意圖
圖5 側(cè)平面三角形幾何關(guān)系圖
對于方程(4)來說,實際上可以求得多組不同的解,但是在實際情況下,我們可以通過不同的環(huán)境與限制條件選擇一組合理的解作為最終的由于我們求得則由式(4)我們可以求得進(jìn)而我們可以求得如下:
則正向運(yùn)動學(xué)問題即可通過方程式(1)~式(6)最終求得。
對于單模塊變幾何桁架機(jī)器人的正向運(yùn)動學(xué),我們需要通過末端平面中心點的坐標(biāo)點位置來計算出三個可控制器長度所以正向運(yùn)動學(xué)的輸入變量即為而輸出變量即為同樣,作為中間變量二面角是必不可少的??紤]圖2所示的幾何關(guān)系,我們可以得到和r如下所示。
其中:
式(8)同樣存在多組解,同正向運(yùn)動學(xué)一樣,在實際情況下,我們可以通過不同的環(huán)境與限制條件選擇一組合理的解作為最終的求得后,通過式(2),我們便可以求得最終即可由式(3)求得,單模塊變幾何桁架機(jī)器人的逆向運(yùn)動學(xué)也隨之求解。
為了進(jìn)行機(jī)器人運(yùn)動學(xué)計算,首先我們需要給定機(jī)器人固定參數(shù),我們假則我們給定5組控制桿長度可以得到目標(biāo)點位置如表1所示。
表1 正向運(yùn)動學(xué)示例
表2 逆向運(yùn)動學(xué)示例
由表1與表2可知,該方法精確的解決了八面體變幾何桁架機(jī)器人的運(yùn)動學(xué)問題,并且其正逆向運(yùn)動學(xué)能得到良好的匹配結(jié)果。
本文在變幾何桁架概念的基礎(chǔ)上設(shè)計了一種對稱雙八面體變幾何桁架機(jī)器人,并利用該機(jī)器人機(jī)構(gòu)解決了其他八面體變幾何桁架機(jī)器人無法使用代數(shù)運(yùn)算求解運(yùn)動學(xué)精確解的問題。并且,只要給出合理的初始參數(shù),該方法基本可以消除正逆向運(yùn)動學(xué)運(yùn)算所帶來的誤差,使得該方法具有很好的準(zhǔn)確性。
[1]羅佑新.八面體變幾何桁架機(jī)構(gòu)綜合的神經(jīng)網(wǎng)絡(luò)超混沌牛頓迭代法研究[J].機(jī)械設(shè)計,2008,25(11).
[2]雷勇,徐禮鉅,吳江.基于模糊神經(jīng)網(wǎng)絡(luò)的冗余度變幾何桁架機(jī)器人位置控制[J].電工技術(shù)學(xué)報,2002,17(4):40-44.
[3]吳江,徐禮鉅,雷勇.基于神經(jīng)網(wǎng)絡(luò)的冗余度二重八面體變幾何桁架機(jī)器人運(yùn)動學(xué)求解[J].四川大學(xué)學(xué)報(工程科學(xué)版),2000,32(2):90-94.
[4]易建,車林仙,陳長憶.基于粒子群算法的八面體變幾何桁架機(jī)器人位置正解[J].機(jī)械工程師,2006,(7):34-36.