馮敦超 王小濤 韓亮亮

1.南京航空航天大學(xué)，南京210016 2.上海市空間飛行器機(jī)構(gòu)重點(diǎn)實(shí)驗(yàn)室，上海 201108

?

基于腱驅(qū)動(dòng)的空間多指靈巧手的位置/腱張力混合控制*

馮敦超1, 2王小濤1韓亮亮2

1.南京航空航天大學(xué)，南京210016 2.上海市空間飛行器機(jī)構(gòu)重點(diǎn)實(shí)驗(yàn)室，上海 201108

現(xiàn)有的腱驅(qū)動(dòng)空間多指靈巧手通過對(duì)每一根腱施加獨(dú)立的張力實(shí)現(xiàn)力控制，忽略了腱繩耦合運(yùn)動(dòng)的影響。針對(duì)“N+1”型腱驅(qū)動(dòng)多指靈巧手系統(tǒng)內(nèi)腱繩運(yùn)動(dòng)和腱張力耦合的問題，采用關(guān)節(jié)轉(zhuǎn)矩到腱張力映射的方式解決，同時(shí)加入位置控制，構(gòu)成位置/腱張力混合控制系統(tǒng)，實(shí)現(xiàn)腱驅(qū)動(dòng)靈巧手的主動(dòng)柔順控制?！癕atlab+ADAMS”聯(lián)合仿真結(jié)果驗(yàn)證了算法的可行性。

空間多指靈巧手；腱驅(qū)動(dòng)；N+1；腱張力；柔順控制

隨著航天技術(shù)的飛速發(fā)展, 空間飛行器的結(jié)構(gòu)和組成日趨復(fù)雜, 性能和技術(shù)水平不斷提高, 在這種情況下, 保證空間飛行器在復(fù)雜的空間環(huán)境中更加持久、穩(wěn)定地在軌運(yùn)行,已成為目前空間技術(shù)領(lǐng)域亟待解決的重要問題。近幾十年來，各國研究機(jī)構(gòu)進(jìn)行了一系列地面、空間論證實(shí)驗(yàn)和應(yīng)用研究, 結(jié)果表明空間在軌服務(wù)不僅在技術(shù)上是可行的, 而且具有巨大的研究、發(fā)展空間[1]。而作為在軌服務(wù)智能末端執(zhí)行器的多指靈巧手技術(shù)在國內(nèi)外也得到了蓬勃的發(fā)展。多指靈巧手具有多個(gè)多關(guān)節(jié)手指，能夠和人手一樣具有很高的靈巧性、通用性和適應(yīng)性，采用多指靈巧手作為末端執(zhí)行器對(duì)機(jī)器人智能化水平和作業(yè)水平的提高具有重要意義。

多指靈巧手的驅(qū)動(dòng)方式分為驅(qū)動(dòng)器內(nèi)置式和外置式2種，國內(nèi)研究的靈巧手均采用驅(qū)動(dòng)內(nèi)置式，代表性的是北航BH985手[2]和哈工大HIT/DLR II手[3]，把驅(qū)動(dòng)器和傳動(dòng)裝置集成在每個(gè)手指內(nèi)部，使得手指體積龐大、笨重，增加了復(fù)雜度，不適宜應(yīng)用在空間在軌服務(wù)領(lǐng)域，同時(shí)對(duì)小體積、大扭矩電機(jī)的設(shè)計(jì)制造提出了嚴(yán)格要求。為了應(yīng)對(duì)空間環(huán)境防護(hù)、降低復(fù)雜性和提高可靠性，空間靈巧手系統(tǒng)越來越多的采用外驅(qū)式的腱驅(qū)動(dòng)形式，典型的有DLR-I Hand[4]，R2手[5-6]，DEXHAND[7]等。外置的驅(qū)動(dòng)器可以減小手指體積和重量，這些特性對(duì)手指的靈巧性至關(guān)重要。由于腱只可以傳遞張力，因此為了獲得完全獨(dú)立的自由度控制，必須要保證驅(qū)動(dòng)器的數(shù)量多于自由度的個(gè)數(shù)，與傳統(tǒng)的“2N”配置方式不同，文獻(xiàn)[8]中提出只需要比自由度的數(shù)量多1個(gè)即可，即“N+1”型腱驅(qū)動(dòng)系統(tǒng)。然而這種方式在減少腱繩數(shù)量的同時(shí)卻引入了關(guān)節(jié)位置和腱繩的耦合問題，文獻(xiàn)[9]提出在力矩空間進(jìn)行力矩分配后再轉(zhuǎn)到關(guān)節(jié)空間的方式，解決了腱和關(guān)節(jié)位置的耦合問題。

為了使多指靈巧手能夠可靠穩(wěn)定地抓握物體，靈巧手應(yīng)具有一定的柔順性，目前阻抗控制是主動(dòng)柔順的一種主要方法，其優(yōu)點(diǎn)是把力控制和位置控制納入統(tǒng)一的框架，設(shè)計(jì)簡單，但是難于實(shí)現(xiàn)精確的力跟蹤。相對(duì)于傳統(tǒng)的齒輪傳動(dòng)，腱驅(qū)動(dòng)的難點(diǎn)在于設(shè)計(jì)一個(gè)控制器使其能按照期望的位置運(yùn)動(dòng)，同時(shí)保證腱的張力保持在期望的范圍內(nèi)。由于腱只能傳遞張力，而且有一定的延遲，因此在控制的過程中一定要避免出現(xiàn)腱的松弛，此時(shí)基本的位置加阻抗的控制策略很難實(shí)現(xiàn)。本文在Matlab+ADAMS聯(lián)合仿真平臺(tái)基礎(chǔ)上，研究了位置/腱張力混合控制的方法，目標(biāo)是保證腱張力在期望的范圍內(nèi)的同時(shí)進(jìn)行位置控制，以達(dá)到柔順控制的目的。

1 系統(tǒng)結(jié)構(gòu)

參考NASA Robonaut 2靈巧手，設(shè)計(jì)了多指靈巧手的ProE模型如圖1所示，該靈巧手有18個(gè)活動(dòng)關(guān)節(jié)和12個(gè)獨(dú)立自由度，分布在5個(gè)手指中，整個(gè)手在尺寸上與人手類似。本文主要針對(duì)圖1中加深顯示的食指的柔順控制進(jìn)行深入研究。如圖2所示，該手指由基座、側(cè)擺、近指節(jié)、中指節(jié)和遠(yuǎn)指節(jié)組成，采用“N+1”型腱驅(qū)動(dòng)方式，具有3個(gè)獨(dú)立自由度。

其中，遠(yuǎn)指節(jié)通過一個(gè)連桿機(jī)構(gòu)與中指節(jié)耦合。每個(gè)獨(dú)立關(guān)節(jié)裝有霍爾角度傳感器，每一根腱都裝有張力傳感器，并通過一個(gè)無刷直流電機(jī)驅(qū)動(dòng)，通過滾珠絲杠把旋轉(zhuǎn)運(yùn)動(dòng)轉(zhuǎn)換為直線運(yùn)動(dòng)。

2 位置/腱張力混合控制

具體位置和腱張力混合控制的原理：在自由空間，采用前饋位置PD控制和最小張力混合的控制方法，使關(guān)節(jié)跟蹤期望軌跡并保證腱張力在期望范圍內(nèi)；在接觸物體以后的約束空間，采用前饋位置PD控制和完全張力控制的方法使手指以期望的接觸力與物體接觸，實(shí)現(xiàn)穩(wěn)定的精確抓持。

2.1 位置控制

位置控制器的輸入量為：

θe=θd-θb

(1)

其中，θe代表位置偏差，θd代表規(guī)劃的關(guān)節(jié)位置，θb為手指反饋的關(guān)節(jié)位置。

因該靈巧手采用“N+1”型腱驅(qū)動(dòng)，其位置控制有別于傳統(tǒng)的齒輪傳動(dòng)結(jié)構(gòu)，4根腱的位置對(duì)應(yīng)3個(gè)獨(dú)立關(guān)節(jié)，本文采用幾何建模的方法實(shí)現(xiàn)腱位置到關(guān)節(jié)位置的解算，即在各關(guān)節(jié)處對(duì)腱的運(yùn)動(dòng)路徑做幾何簡化，得到每根腱的位置與關(guān)節(jié)位置的關(guān)系。

圖3 腱繩運(yùn)動(dòng)狀態(tài)簡化圖

圖3所示的連桿由虛線位置轉(zhuǎn)到實(shí)線位置，關(guān)節(jié)轉(zhuǎn)動(dòng)Δθ角，腱繩x3由虛線位置運(yùn)動(dòng)到實(shí)線位置，關(guān)節(jié)處對(duì)應(yīng)的腱繩長度由l1變?yōu)閘2，根據(jù)余弦定理可知：

(2)

則,Δx3′=Δl=l2-l1。

同理，得到4根腱的位置到關(guān)節(jié)位置的轉(zhuǎn)換方程：

(3)

得到腱位移的Δx(Δθ)后，為了改善位置控制的調(diào)節(jié)時(shí)間，增加系統(tǒng)阻尼，減少超調(diào)量，引入1個(gè)PD控制器，根據(jù)式(2)和(3)最終得到位置控制系統(tǒng)表達(dá)式如下：

(4)

2.2 腱張力控制器

在腱驅(qū)動(dòng)靈巧手系統(tǒng)中，腱之間存在耦合，為了避免解耦的麻煩，在關(guān)節(jié)空間規(guī)劃期望的關(guān)節(jié)力矩，然后轉(zhuǎn)換成腱空間的張力。

根據(jù)手指靜力學(xué)特性，事先規(guī)劃出指尖接觸力Fd，即可通過雅克比矩陣J反解出使手指指尖在接觸到物體并保持靜態(tài)平衡時(shí)所需的關(guān)節(jié)力矩τd。如公式所示：

τd=JTFd

(5)

由于腱只傳遞張力，為了避免腱在運(yùn)動(dòng)過程中出現(xiàn)松弛，引入腱張力控制器確保腱張力的正定性。腱張力控制器算法的基礎(chǔ)是n個(gè)關(guān)節(jié)力矩τ和n+1個(gè)腱張力f之間的關(guān)系，如式(6)所示：

(6)

其中，t表示腱的內(nèi)部張力；L∈R3×3是由3個(gè)獨(dú)立關(guān)節(jié)的半徑組成的對(duì)角陣；B表示腱的結(jié)構(gòu)矩陣[10]；WT正交于LB的行空間且正定。

系統(tǒng)中腱張力可控的充要條件為P可逆，要求LB行滿秩[11]。根據(jù)式(6)得到：

(7)

令P-1=[Aa]，則

(8)

設(shè)定腱張力取值范圍[fmin,fmax]，fmin保證腱始終處于繃緊的狀態(tài)，fmax保護(hù)腱不超負(fù)荷。令A(yù)i和ai分別代表A的行向量和a向量的元素。首先根據(jù)fmin確定內(nèi)部張力t的取值，則有：

fi=Aiτ+ait≥fmin(其中，i=1,2,3,4)

(9)

式(9)經(jīng)過變換得到式(10)，計(jì)算得出t的4個(gè)值：

(10)

因此，內(nèi)部張力t取式(10)的最大值即可，如式(11)所示：

t=max(ti) (其中，i=1,2,3,4)

(11)

其次，確保腱張力fi≤fmax，如果出現(xiàn)fi>fmax，則采用比例縮放的方式減小力矩τ分量：

(12)

其中，α為比例縮放因子，且α≤1。

綜合式(5)～(12)，可得腱張力分配算法表達(dá)如下：

(13)

最終得到腱張力控制器系統(tǒng)表達(dá)式如下：

(14)

2.3 單手指位置/腱張力混合控制

因?yàn)殡熘荒軅鬟f張力，因此單獨(dú)的位置控制很難保證腱張力時(shí)刻大于0，而且腱本身有一定的柔韌性，對(duì)力的傳遞有遲滯性。而腱張力控制器則解決了這一問題，腱張力控制器可以保證腱張力在[fmin,fmax]范圍內(nèi)，在初始時(shí)刻時(shí)，給腱繩施加力fi≥fmin，保證腱在初始時(shí)刻有預(yù)張緊，從而可以忽略腱繩的彈性，使腱繩等效為剛體。

首先根據(jù)圖2中所示腱的排列可以得出結(jié)構(gòu)矩陣B，進(jìn)而得到腱映射矩陣P，如下所示：

同時(shí),根據(jù)任務(wù)要求及腱的性能設(shè)置腱張力范圍fmin=8N，fmax=200N。

式(4)和(13)相加得到位置/腱張力混合控制系統(tǒng)方程(15)：

(15)

最終完整的控制系統(tǒng)框圖如圖4所示。

圖4 單指靈巧手位置/腱張力混合控制框圖

3 仿真驗(yàn)證

為了確定上述位置/腱張力混合控制方法的有效性，在“Matlab+ADAMS”平臺(tái)進(jìn)行了仿真驗(yàn)證，把單指靈巧手PROE模型文件導(dǎo)入ADAMS里，利用ADAMS/Control組件把Matlab/Simulink和ADAMS模型連接在一起，構(gòu)成完全非線性的物理模型[12]。

使用圖5所示的階躍信號(hào)[0° 45° 90°]作為控制器的關(guān)節(jié)角度測(cè)試信號(hào)，設(shè)定接觸力的期望值為[10N 0N 0N]，根據(jù)腱張力分配方法計(jì)算出期望的腱張力如圖6所示。

設(shè)置仿真時(shí)間為3s，得到圖7～9所示的關(guān)節(jié)位置誤差、腱張力誤差和接觸力大小曲線，從圖中可以看出,0～0.7s單手指在自由空間運(yùn)動(dòng)，腱張力從0N逐漸增加到設(shè)定的最小張力fmin=8N，同時(shí)關(guān)節(jié)位置保持不變，這一階段稱為腱繩的預(yù)張緊；0.7s開始向關(guān)節(jié)位置輸入階躍信號(hào)，從接觸力曲線可以看出在0.8s時(shí)手指被障礙物阻擋，進(jìn)入約束空間，關(guān)節(jié)位置誤差不再改變，經(jīng)過0.5s的調(diào)節(jié)時(shí)間，指尖接觸力達(dá)到期望值，腱張力誤差也趨于穩(wěn)定，系統(tǒng)處于穩(wěn)定狀態(tài)；在1.7s時(shí)再次向關(guān)節(jié)位置輸入階躍信號(hào)，使手指原路返回到初始關(guān)節(jié)位置，經(jīng)過0.5s的調(diào)節(jié)時(shí)間，手指關(guān)節(jié)角度達(dá)到0°，腱張力恒定為fmin。

圖5 期望關(guān)節(jié)角

圖6 期望腱張力

圖7 關(guān)節(jié)位置誤差

圖8 腱張力誤差

圖9 指尖接觸力

4 結(jié)論

為了使基于腱驅(qū)動(dòng)的空間仿人多指靈巧手能夠可靠精確的抓握物體，實(shí)現(xiàn)空間在軌操作，本文提出了一種新的關(guān)節(jié)位置/腱張力控制方法：前饋PD位置控制和腱張力混合控制的方法。較好的實(shí)現(xiàn)了單手指關(guān)節(jié)位置跟蹤和腱張力控制，運(yùn)用腱張力控制器解決了腱張力到指尖接觸力的轉(zhuǎn)換，實(shí)現(xiàn)靈巧手的柔順控制。同時(shí)利用“Matlab+ADAMS”聯(lián)合仿真驗(yàn)證了該方法的可行性，得到了期望的結(jié)果。

[1] 崔乃剛,王平,郭繼峰,等.空間在軌服務(wù)技術(shù)發(fā)展宗述[J].宇航學(xué)報(bào),2007,28(4):805- 811.(CUI Naigang,WANG Ping,GUO Jifeng,et al.A Review of On- Orbit Servicing[J].Journal of Astronautics,2007, 28(4):805- 811.)

[2] 李久振,劉博,張玉茹.北航 BH- 985 靈巧手結(jié)構(gòu)設(shè)計(jì)[C].全國印刷, 包裝機(jī)械凸輪, 連桿機(jī)構(gòu)學(xué)術(shù)研討會(huì) (第 6 屆全國凸輪機(jī)構(gòu)學(xué)術(shù)年會(huì))論文集, 2005: 140- 142. (LI Jiuzhen, LIU Bo, ZHANG Yu- ru. Structure Design of BH- 985 Dexterous Hand[C]. National Printing, Packaging Machinery Cam Linkage Symposium (6th Annual Conference of the National Cam) Proceedings, 2005:140- 142.)

[3] 劉伊威,金明河,樊紹巍,等.五指仿人機(jī)器人靈巧手 DLR/HIT Hand Ⅱ[J].機(jī)械工程學(xué)報(bào), 2009， (11):10- 17.(LIU Yiwei,JIN Minghe,FAN Shaowei,et al.Five- finger Dextrous Robot Hand DLR/HIT Hand II[J].Chinese Journal of Mechanical Engineering,2009,(11):10- 17.)

[4] Hirzinger G,Fischer M,Brunner B,et al. Advances in Robotics: the DLR Experience[J].The International Journal of Robotics Research,1999,18(11):1064- 1087.

[5] Diftler M A,Mehling J S,Abdallah M E, et al.Robonaut 2- the First Humanoid Robot in Space[C].Robotics and Automation (ICRA), 2011 IEEE International Conference on. IEEE, Shanghai, 2011: 2178- 2183.

[6] Bridgwater L B, Ihrke C A,Diftler M A,et al. The Robonaut 2 Hand- Designed to Do Work with Tools[C]. Robotics and Automation (ICRA), 2012 IEEE International Conference on IEEE,Saint Paul,MN, 2012: 3425- 3430.

[7] Chalon M,Wedler A,Baumann A,et al.Dexhand: a Space Qualified Multi- fingered Robotic Hand[C]. Robotics and Automation (ICRA), 2011 IEEE International Conference on IEEE, Shanghai, 2011: 2204- 2210.

[8] Murray R M, Li Z, Sastry S S, et al. A Mathematical Introduction to Robotic Manipulation[M]. Boca Raton, FL: CRC press, 1994: 229- 233.

[9] Abdallah M E, Platt R, Wampler C W.Decoupled Torque Control of Tendon- driven Fingers with Tension Management[J].The International Journal of Robotics Research,2013,32(2): 247- 258.

[10] Lee J J, Tsai L W. The Structural Synthesis of Tendon- Driven Manipulators Having Pseudo- Triangular Matrix [J].The International Journal of Robotics Research, 1991,10(3):255- 262.

[11] Abdallah M E,Platt R,Wampler C W, et al.Applied Joint- space Torque and Stiffness Control of Tendon- driven Fingers[C].Humanoid Robots (Humanoids), 2010 10th IEEE- RAS International Conference on.IEEE, Nashville,TN,USA, 2010: 74- 79.

[12] 范成建, 熊光明, 周明飛.虛擬樣機(jī)軟件 MSC. ADAMS 應(yīng)用與提高[M].機(jī)械工業(yè)出版社, 2006: 214- 243.

PositionandTendon-TensionHybridControlofTendon-DrivenBasedonSpaceMulti-FingeredDexterousHand

FENG Dunchao1,2WANG Xiaotao1HAN Liangliang2
1.College of Astronautics，Nanjing University of Aeronautics and Astronautics，Nanjing 210016，China 2.Shanghai Key Laboratory of Spacecraft Mechanism，Shanghai 201108，China

Theforcecontrolisappliedtoexistingtendon-drivenspacemulti-fingereddexteroushandbyusingindependenttensiononeachtendon,ignoringtheeffectsoftendonropecouplingmovement.Duetothecouplingproblembetweentendondisplacementsandtendontensioninthetendon-drivenmulti-fingereddexteroushandsystem,itcanbesolvedbythemappingofjointtorquetothetendontension,simultaneouslyaddingthepositioncontrol,tomaketheposition/tendontensioncontrolsystemwhichrealizestheactivecompliancecontroloftendon-drivendexteroushand.ThefeasibilityofthealgorithmisverifiedbytheunitedsimulationofMatlab+ADAMS.

Spacemulti-fingereddexteroushand；Tendon-driven；N+1；Tendontension；Compliancecontrol

*上海航天科技創(chuàng)新基金資助項(xiàng)目(SAST201318)；上海市空間飛行器機(jī)構(gòu)重點(diǎn)實(shí)驗(yàn)室資助項(xiàng)目(06DZ22105)

2014- 05- 05

馮敦超(1989-)，男，江蘇徐州人，碩士研究生，主要研究方向?yàn)殡祢?qū)動(dòng)空間多指靈巧手控制技術(shù)；王小濤(1976-)，男，山東濰坊人，博士，副教授，主要研究方向?yàn)楹教鞕C(jī)構(gòu)驅(qū)動(dòng)控制、機(jī)器視覺算法及其高速并行實(shí)現(xiàn)；韓亮亮(1987-)，男，甘肅莊浪人，碩士，工程師，主要研究方向?yàn)榭臻g機(jī)器人技術(shù)。

TH13;TP24

： A

1006- 3242(2014)06- 0057- 06