潘 健，郭忠峰，王赫瑩(沈陽工業(yè)大學遼寧省智能制造與工業(yè)機器人重點實驗室，遼寧 沈陽 110870)

0 引言

機器人已廣泛地應(yīng)用于各個領(lǐng)域，傳統(tǒng)串并聯(lián)機器人由于尺寸和靈活性限制難以適用于復雜狹窄的作業(yè)環(huán)境，超冗余機械臂因其具有良好的環(huán)境適應(yīng)性和避障能力[1]，逐漸成為機器人領(lǐng)域研究的熱點。

國外對超冗余機械臂的研究起步較早，1991年，Chikjian和Burdick最先提出“超冗余”一詞[2]，后續(xù)許多團隊設(shè)計了不同的機械結(jié)構(gòu)。Walker及其團隊[3-5]開發(fā)了一種線驅(qū)動機械臂，并建立了運動學模型，英國OC Robotics公司[6-7]先后研發(fā)了多款超冗余機器人，用于飛機零部件組裝、狹小空間焊接切割等。國內(nèi)對超冗余機械臂的研究比國外晚，主要的研究單位有哈爾濱工業(yè)大學、沈陽自動化研究所、北京航天航空大學[8-10]等。超冗余機械臂因其自由度數(shù)多，所以逆運動學求解困難，傳統(tǒng)的廣義逆法求解超冗余機械臂運動學存在計算量巨大甚至無法求解的問題[11]，針對這一問題，Chikjian和Burdick于1994年提出了基于脊線的逆運動學求解算法并應(yīng)用于超冗余機械臂的逆運動學求解[12]，但是該方法將機械臂關(guān)節(jié)盡可能的擬合在脊線上，導致機械臂喪失了許多自由度。

本文針對傳統(tǒng)機器人尺寸大、靈活性不足的缺點，設(shè)計了一款基于新型球形關(guān)節(jié)串聯(lián)而成的超冗余機器臂，以其為基礎(chǔ)，提出一種基于改進脊線法的超冗余機械臂逆運動學求解算法，用于新型超冗余機械臂操作空間和關(guān)節(jié)空間之間的逆運動學求解，利用Matlab對空間脊線及機械臂逆運動學進行數(shù)值仿真。

1 新型超冗余機器臂結(jié)構(gòu)設(shè)計

1.1 整體結(jié)構(gòu)設(shè)計

新型超冗余機器臂整體機械結(jié)構(gòu)如圖1所示，整個機械系統(tǒng)由機械臂模塊和驅(qū)動模塊組成。

圖1 超冗余機器人機械系統(tǒng)原理圖

機械臂模塊由10個模塊化單關(guān)節(jié)串聯(lián)而成，每個模塊化單關(guān)節(jié)具有兩個自由度，機械臂的末端可以安裝機械抓手和攝像頭。驅(qū)動模塊采用箱體式結(jié)構(gòu)，內(nèi)置30個電機采用分層布置方式，每一層6個電機，分為5層，機械臂通過法蘭與驅(qū)動模塊箱體連接。

1.2 驅(qū)動部分結(jié)構(gòu)設(shè)計

驅(qū)動模塊的單層驅(qū)動結(jié)構(gòu)示意圖如圖2所示，底座上等間距安裝6個電機，電機輸出端通過聯(lián)軸器與絲杠連接，機械臂關(guān)節(jié)的驅(qū)動繩索通過雙U形槽輪導線裝置與絲杠螺母上的壓線裝置連接，通過絲杠螺母的直線運動可以實現(xiàn)驅(qū)動繩索的拉緊和放松。

圖2 單層驅(qū)動模塊結(jié)構(gòu)示意圖

1.3 球形關(guān)節(jié)結(jié)構(gòu)設(shè)計

新型超冗余機械臂由10個新型球型關(guān)節(jié)串聯(lián)而成，新型球型關(guān)節(jié)的結(jié)構(gòu)如圖3所示。

圖3 新型球形結(jié)構(gòu)示意圖

一個新型球型關(guān)節(jié)包括中間球體及兩端與之配合的導繩盤，中間球體上均勻設(shè)置4個半球形軌道，導繩盤上與中間球體配合的內(nèi)球面上兩側(cè)分別設(shè)置兩個半球形孔用于安裝滾珠，實現(xiàn)導繩盤在中間球體軌道上的滾動，可以減小關(guān)節(jié)運動時的摩擦損耗，提高關(guān)節(jié)使用壽命，導繩盤兩側(cè)的側(cè)耳上設(shè)置螺紋孔，用于擋塊和導繩盤側(cè)耳的連接。關(guān)節(jié)與關(guān)節(jié)之間用法蘭連桿連接，單關(guān)節(jié)長度為150 mm，新型球型關(guān)節(jié)的單自由度旋轉(zhuǎn)角度范圍為[-30°，30°]。新型超冗余機械臂直徑為50 mm，中間球體、導繩盤、連桿中心軸線方向均采用空心結(jié)構(gòu)，減輕了整個機械臂的重量，同時電纜可由機械臂中心穿過，實現(xiàn)末端電子設(shè)備的供電和信號傳輸。機械臂采用電機外置三線驅(qū)動方式，三根繩索呈120°布置，每個導繩盤上均勻布置導繩孔，驅(qū)動繩索直徑為1.2 mm。

2 基于改進脊線法的超冗余機械臂逆運動學求解

2.1 空間脊線模型

圖4 空間脊線示意圖

空間脊線是一條可以描述超冗余機械臂空間形態(tài)的曲線[13]，其示意圖如圖4所示。

空間脊線的數(shù)學表達式[14-16]可描述為：

(1)

式中：s為歸一化脊線長度的參數(shù)；X(0)為脊線的起點位置；X(1)為脊線的終點位置；L為脊線的實際長度；u(σ)為脊線在點σ處的脊線切線向量。

空間脊線的切線向量u(σ)可以表示成：

(2)

其中，ψ(σ)為空間線段Oσ與其在XOY平面上投影之間的夾角，φ(σ)為空間線段Oσ在XOY平面上投影與Y軸之間的夾角。

2.2 空間脊線運動學

脊線的運動學是研究脊線參數(shù)與脊線末端點之間的關(guān)系，而到達空間一點不止一條脊線，因此需要對脊線形狀進行限制，令{si(s)}為對應(yīng)的脊線形狀約束方程：

(3)

式中：Nsi為模態(tài)子方程的個數(shù)；aij(t)為模態(tài)協(xié)同參數(shù)；φij(s)為模態(tài)子方程。

由于空間脊線方程表達式比較復雜，協(xié)同參數(shù)一般無法由顯示方程求解，因此采用數(shù)值方法求解空間脊線協(xié)同參數(shù)，下面簡述脊線協(xié)同參數(shù)的求解過程。

脊線方程對時間t求導得：

(4)

式中：J(a)為脊線的模態(tài)雅克比矩陣，是脊線協(xié)同參數(shù)的函數(shù)。

(4)式用來求解t時刻脊線協(xié)同參數(shù)集合a。

上述脊線協(xié)同參數(shù)求解可能會使脊線末端位姿產(chǎn)生較大的誤差，因此需要對協(xié)同參數(shù)進行修正，下面采用迭代法進行參數(shù)修正。

ak+1=ak+α·J-1(ak)·[XD-X(ak)]

(5)

式中：J-1(ak)為模態(tài)雅克比矩陣的逆矩；ak為第k次迭代a的計算值；XD為脊線的末端點位置；X(ak)為當ak為脊線協(xié)同參數(shù)時計算出的脊線末端位置；α為常數(shù)，控制迭代收斂速度。

脊線運動學描述：正運動學是已知脊線的模態(tài)協(xié)同參數(shù)求解脊線的末端位置；脊線的逆運動學是已知脊線的末端位置求解脊線的模態(tài)協(xié)同參數(shù)。

2.3 超冗余機械臂關(guān)節(jié)位置擬合

本文提出基于障礙物位置的機械臂關(guān)節(jié)擬合方法，關(guān)節(jié)擬合示意圖如圖5所示，擬合過程主要包含三個步驟：末端關(guān)節(jié)擬合；剩余關(guān)節(jié)預擬合；局部關(guān)節(jié)位置調(diào)整。

圖5 機械臂關(guān)節(jié)擬合示意圖

2.3.1 末端關(guān)節(jié)擬合

為使脊線末端指向與機械臂末端執(zhí)行器指向相匹配，假定機械臂末端執(zhí)行器指向方向的單位向量為kn，末端位置坐標為Xe=[xeyeze]T，機械臂總長度為l，關(guān)節(jié)數(shù)為n，則機械臂末端關(guān)節(jié)的位置坐標為：

Xn=[xnynzn]T=Xe-kn·l/n

(6)

2.3.2 剩余關(guān)節(jié)位置預擬合

為使剩余關(guān)節(jié)盡可能地落在或者接近脊線，對剩余關(guān)節(jié)位置進行預擬合，由于靠近機械臂始端的關(guān)節(jié)位置由后一關(guān)節(jié)的位置和關(guān)節(jié)長度決定，所以在剩余關(guān)節(jié)擬合時由機械臂末端關(guān)節(jié)向機械臂始端關(guān)節(jié)開始擬合，假設(shè)機械臂任意關(guān)節(jié)i的位置坐標為Xi=[xiyizi]T，其中i∈[3，n-1]，以點ji+1為球心，以l/n為半徑作球體，與脊線相交于一點ji，以點ji為關(guān)節(jié)i的擬合點，以點ji到點ji+1之間的脊線的內(nèi)接弦向量li作為關(guān)節(jié)i的擬合量，則關(guān)節(jié)i的位置向量可以表示為：

Xi=Xi+1-li

(7)

由(7)式可以推導i≥3關(guān)節(jié)的位置向量，為了保證i≥3關(guān)節(jié)都擬合在脊線上，取各段脊線的內(nèi)接弦作為擬合量，當k=2時，剩余脊線的長度會小于2L/n，導致關(guān)節(jié)2無法擬合到脊線上，取點j2、j1分別為關(guān)節(jié)1、2的擬合點，其中關(guān)節(jié)1為原點。

圖6 關(guān)節(jié)2擬合 示意圖

如圖6所示，分別以點j1、j3為球心，以l/n為半徑作球體，兩個球體的交線為空間圓，在該圓上求解一點j2，使得j2到脊線的距離最短。以j2為關(guān)節(jié)2的擬合點，點j2到點j3之間的線段作l2為關(guān)節(jié)2的擬合量，點j2到點j1之間的線段l1作為關(guān)節(jié)1的擬合量，關(guān)節(jié)2的位置向量可以表示為：

X2=X3-l2

(8)

2.3.3 局部關(guān)節(jié)位置調(diào)整

在預擬合過程中，機械臂所有的關(guān)節(jié)接近或落在脊線上，對于無障礙路徑，這種擬合求解方法可以減少計算量，但是對于有障礙路徑，這種擬合求解方法由于犧牲了大量自由度而導致機械臂喪失靈活性，故本文提出基于障礙物位置的關(guān)節(jié)擬合算法，即引入障礙物參數(shù)(包括障礙物位置參數(shù)和尺寸參數(shù))，對局部關(guān)節(jié)位置進行調(diào)整。

圖7 障礙物模型示意圖

如圖7所示，首先對障礙物進行建模，為了便于描述機械臂關(guān)節(jié)與障礙物之間的位置關(guān)系，將障礙物的外接球面視為機械臂所能到達的極限位置，稱之為危險邊界，其半徑為Rw，同時，為了保證機械臂運動過程中的絕對安全，在危險邊界周圍設(shè)置預警區(qū)域，預警區(qū)域的外圍邊界是機械臂的安全運動邊界，其半徑為Ra。在一般工況下，要求機械臂絕對安全運行，所以機械臂關(guān)節(jié)要始終處于安全邊界之外。

假設(shè)機械臂第i個關(guān)節(jié)ji處于安全邊界范圍之內(nèi)，為了使機械臂安全運行，需要對機械臂關(guān)節(jié)ji的位置進行調(diào)整，調(diào)整后的關(guān)節(jié)需要滿足以下邊界條件：

(9)

根據(jù)上述條件限制，求解得到一系列滿足條件的關(guān)節(jié)空間位置坐標后，為了使調(diào)整后的關(guān)節(jié)更好地與脊線吻合，在上述邊界條件的解集中確定調(diào)整后關(guān)節(jié)的位置，使其滿足到預擬合確定的關(guān)節(jié)ji位置的歐氏距離最小，將該位置作為調(diào)節(jié)后的關(guān)節(jié)位置，即滿足下列公式：

(10)

同樣地，對于復雜工況環(huán)境，若同時出現(xiàn)多個關(guān)節(jié)在安全邊界以內(nèi)，則可以引入多組障礙物參數(shù)，應(yīng)用同樣的方法對多個關(guān)節(jié)位置進行調(diào)整。

2.4 超冗余機械臂關(guān)節(jié)變量求解

求得各個關(guān)節(jié)擬合后的位置坐標后，下面求解關(guān)節(jié)k的旋轉(zhuǎn)角度θk、θ2k，結(jié)合常用的D-H坐標系法進行關(guān)節(jié)變量求解，以本文設(shè)計的新型超冗余機械臂為例，建立機械臂的D-H坐標系如圖8所示，得到各個關(guān)節(jié)的D-H參數(shù)如表1所示。

圖8 新型超冗余機械臂D-H坐標系

表1 新型超冗余機械臂關(guān)節(jié)D-H參數(shù)

(11)

式中，c*是cosθ*的簡寫，s*是sinθ*的簡寫。

對于1關(guān)節(jié)，可以通過下式求解旋轉(zhuǎn)角度θ1、θ2。

(12)

X1=0P2

(13)

(14)

Xk=0P2k

(15)

在上述關(guān)節(jié)旋轉(zhuǎn)角度求解過程中，因為末端關(guān)節(jié)求解時用到前面關(guān)節(jié)的旋轉(zhuǎn)角度變量，所以求解時需要從首端關(guān)節(jié)到末端關(guān)節(jié)依次求解。

3 空間脊線與機械臂逆運動學仿真

3.1 空間脊線仿真

根據(jù)超冗余機械臂的結(jié)構(gòu)特點，本文選取模式函數(shù)為：

(16)

脊線約束方程為：

(17)

任意給定脊線的末端位置，在上述約束方程的約束下可以求解出空間唯一一條脊線與之對應(yīng)，假設(shè)給定脊線的末端位置為空間圓，其方程為：

根據(jù)給定的脊線末端點位置，本文通過數(shù)值方法(newton法)求解脊線的協(xié)同參數(shù)，得到空間脊線方程，在matlab中繪制空間脊線的三維圖形(圖9)及XY平面投影(圖10)，脊線較光滑，沒有曲率較小的脊線段，因此超冗余機械臂可以與脊線很好的擬合。

圖9 空間脊線三維圖 圖10 空間脊線YZ平面投影圖

3.2 機械臂逆運動學仿真

為了驗證本文提出的基于改進脊線法的超冗余機械臂逆運動學算法的有效性，本文用matlab進行仿真計算。設(shè)置機械臂參數(shù)：機械臂的末端位置為X=[600，450，900]T，歸一化后對應(yīng)脊線的末端為：

Xd=[0.4，0.3，0.6]T

設(shè)置障礙物參數(shù)：障礙物模型1的位置為[290，550，255]T，半徑為30 mm，障礙物模型2的位置為[485，550，480]T，半徑為30 mm。歸一化后對應(yīng)的障礙物參數(shù)為：

Xa1=[0.193，0.367，0.170]TRa1=0.02

Xa2=[0.323，0.367，0.320]TRa2=0.02

根據(jù)本文所提出的改進脊線逆運動學求解算法和空間超冗余機械臂擬合算法進行超冗余機械臂逆運動學求解并通過matlab仿真，結(jié)果如圖11所示，圖中實線曲線表示空間脊線，虛線折線表示機械臂中心線的擬合，每個折線段表示機械臂連桿的位置，圓圈表示超冗余機械臂關(guān)節(jié)。

圖11 基于改進脊線法逆運動學仿真結(jié)果

根據(jù)本文所提出的機械臂關(guān)節(jié)自由度求解算法，通過matlab求解各個關(guān)節(jié)的自由度變量，運用matlab機器人工具箱函數(shù)robot.plot()繪制超冗余機械臂空間構(gòu)型，如圖12所示。

圖12 新型超冗余機械臂空間構(gòu)型圖

4 結(jié)論

本文設(shè)計了一款基于新型球形關(guān)節(jié)串聯(lián)而成的超冗余機械臂，提出了一種基于改進脊線法的超冗余機械臂逆運動學求解算法，并且結(jié)合D-H坐標系法，完成了各個關(guān)節(jié)變量的求解及仿真，為進一步對超冗余機械臂運動學及動力學分析奠定了基礎(chǔ)。