王婷
摘要 本文研究了具有冗余肌肉的雙自由度手指三維夾捏運動的運動學分析和動力學建模.拇指和食指均采用單關(guān)節(jié)肌和雙關(guān)節(jié)肌模型,食指-拇指通過對向作用實現(xiàn)夾捏動作.在夾捏運動中,物體可以沿兩個軸旋轉(zhuǎn),從而使物體實現(xiàn)時變的三維夾捏運動.考慮到屈肌和伸肌的共同收縮、非線性約束及重力的影響建立了動力學模型,并通過簡單的控制對所提出的動力學模型的穩(wěn)定性進行了數(shù)值仿真實驗驗證.
關(guān)鍵詞 夾捏運動;單關(guān)節(jié)肌;雙關(guān)節(jié)肌;動力學模型
中圖分類號 R87;G804.6
文獻標志碼 A
0 引言
食指-拇指對向作用在人類發(fā)展史上起著非常重要的作用.基于解剖學、功能學和生理學研究,學者們得出結(jié)論,食指-拇指通過屈肌和伸肌的共同伸/縮模式產(chǎn)生對向作用可以實現(xiàn)精確的夾捏,即從指尖到指尖的夾捏運動[1].進一步的研究表明,除了固有的肌肉外,在夾捏運動過程中,食指和拇指都會用到附著在前臂上的肌肉以完成擠壓動作,即冗余的肌肉會通過產(chǎn)生內(nèi)力來調(diào)節(jié)關(guān)節(jié)空間的阻尼效應[2-3].為實現(xiàn)靈巧手能夠模仿人手指的精確夾捏運動,研究具有冗余肌肉的拇指-食指的動力學模型具有十分重要的意義.
已有的研究大多圍繞多指安全抓握運動的運動規(guī)劃.學者們分析了在滾動接觸中的多指運動學和動力學的相關(guān)問題,提出非完整約束可以通過指端和物體表面之間的滾動接觸產(chǎn)生.為了實現(xiàn)穩(wěn)定的夾捏運動,學者們研究了多指動力學與非完整約束之間的關(guān)系,以實現(xiàn)無摩擦接觸的力/扭矩閉合[4-5].Bicchi[5]首先提出了一個用多自由度機械手指夾捏三維剛體的動力學模型.他設計了一個簡單的finger-thumb opposition,以實現(xiàn)穩(wěn)定的夾捏動作.Arimoto等[6]通過數(shù)值模擬驗證得出了一個三維盲抓的動態(tài)模型.在他們的工作中,物體的瞬時旋轉(zhuǎn)軸固定在二維空間中,而物體可以在三維空間中隨時間變化而旋轉(zhuǎn)[7-8].基于Arimoto等[6]的工作,本文著重考慮重力影響,采用Tahara的2自由度冗余肌肉模型,建立了食指-拇指夾捏三維剛體運動的動力學模型,分析了夾捏運動的穩(wěn)定性,并通過簡單控制進行了數(shù)值模擬仿真加以驗證.
1 關(guān)節(jié)空間的手指運動學分析
人手指肌肉結(jié)構(gòu)如圖1所示,關(guān)節(jié)坐標系下食指-拇指系統(tǒng)如圖2所示.拇指和食指均具有2個自由度,由1塊單關(guān)節(jié)肌和2塊雙關(guān)節(jié)肌組成.i (i=1,2)代表手指序號,j代表肌肉序號 (j=1,2,3).li代表第i塊肌肉的長度,li∈R3.qi代表第i根手指的旋轉(zhuǎn)角度,qi∈R2.它們之間的關(guān)系[2]為
式中,Lij和aik(k=1,…,6)分別代表手指長度和肌肉的插入點.WTi∈R3×2是從關(guān)節(jié)空間到肌肉空間的雅可比矩陣.通過虛功原理,關(guān)節(jié)力矩Ti∈R2與肌肉輸出力Fi∈R3有如下關(guān)系:
Ti=WiFi.〖JY〗(2)
〖PSXX19220.eps,BP#〗
其中〖AKα-〗為肌肉的控制輸入,l0是肌肉的自由長度,c是固有的阻尼參數(shù),c>0,0
采用飽和函數(shù)設計控制輸入〖AKα-〗i和〖AKα-〗i≥0,第i根手指的肌肉動力學方程可寫為
fmi=pi〖AKα-〗i-pi(〖AKα-〗ici+c0i)〖AKl·〗i,〖JY〗(4)
其中〖AKα-〗i是一個半正定對角矩陣,c0,c0i,pi均為半正定矩陣.
2 三維物體夾捏運動的動力學建模
物體的體坐標系如圖3所示,其中物體質(zhì)心的位置用(x,y,z)T表示.假設剛性物體可以以角速度ωz和ωy分別繞Z軸和Y軸旋轉(zhuǎn).由于X軸的旋轉(zhuǎn)運動很少發(fā)生,在此可以忽略[8].物體繞3個軸的瞬時旋轉(zhuǎn)的位置矢量和質(zhì)心的速度可以寫成:
R(t)=(ρx,ρy,ρz),
R(t)∈SO(3),
vt=(vx,vy,vz).
定義一個3×3的斜對稱矩陣:
此外,假定指尖的形狀為半徑ri半球形(圖3所示),不考慮的摩擦力,從物體質(zhì)心到兩個手指接觸點的距離定義為di.半球形指末端的中心位置和接觸點位置坐標分別表示為(x0i,y0i,z0i)和(X0i,Y0i,Z0i),i=1,2.指尖與剛體表面相關(guān)的約束如下:
手指端部與物體表面的接觸點用球坐標φi,ηi,i=1,2表示.滾動約束寫為
用矩陣Hi表示第i根手指的慣性矩陣,物體的質(zhì)量用M表示,g是引力常數(shù).基于哈密爾頓原理,利用動能、勢能構(gòu)建2自由度食指-拇指的拉格朗日方程為
圖4和圖5分別為食指-拇指夾捏運動過程中Y1-Y2和Z1-Z2的值.從仿真結(jié)果看出Y1-Y2→0,Z1-Z2→0,由此可以推論系統(tǒng)是穩(wěn)定的.夾捏過程中的夾捏力fi(i=1,2)與期望的夾捏力fd如圖6和圖7所示,可以看出f1和f2均穩(wěn)定地收斂到期望的夾捏力.夾捏運動過程中的滾動摩擦參數(shù)λY1,λY2,λZ1,λZ2分別如圖8、9、10、11所示.由仿真結(jié)果可知,本文提出的動力學模型是穩(wěn)定的.
4 結(jié)論
本文研究了食指-拇指夾捏物體的三維夾捏動力學模型.剛體可以繞Y軸和Z軸旋轉(zhuǎn),通過三維夾捏的運動分析,基于哈密爾頓原理和拉格朗日函數(shù)構(gòu)建了三維夾捏的手指系統(tǒng)動力學模型和三維物體模型.手指-拇指系統(tǒng)采用一對具有滾動接觸和冗余肌肉的2自由度連桿機構(gòu),在滾動約束和重力影響下分析了夾捏三維物體的運動,每個手指均具有屈肌和伸肌之間的收縮.通過控制信號進行了數(shù)值仿真,驗證了所提出模型的收斂性.結(jié)果表明,本文所提出的動力學模型可以實現(xiàn)穩(wěn)定的夾捏運動.
參考文獻
References
[1] Tahara K,Luo Z W.On dynamic control mechanisms of redundant human musculo-skeletal system[M]∥Tahara K,Luo Z W.eds.Advances in Robot Control.Berlin,Heidelberg:Springer Berlin Heidelberg,2006:217-247.DOI:10.1007/978-3-540-37347-6_11
[2] Tahara K,Luo Z W,Arimoto S,et al.Task-space feedback control for a two-link arm driven by six muscles with variable damping and elastic properties[C]∥Proc IEEE Int Conf Robot Autom,2005:224-229
[3] Mackenzie? C L,Iberall? T.The grasping hand[M].Amsterdam,Netherlands:North-Holland/Elsevier Science Publishers,1994
[4] Shimoga K B.Robot grasp synthesis algorithms:a survey[J].International Journal of Robotics Research,1996,15(2):230-266〖HJ1.6mm〗
[5] Bicchi A.Hands for dexterous manipulation and robust grasping:a difficult road toward simplicity[J].IEEE Transactions on Robotics and Automation,2000,16(6):652-662
[6] Arimoto S,Yoshida M,Ji-Hun B E.Dynamics and stability of blind grasping of a 3-dimensional object under non-holonomic constraints[J].International Journal of Automation and Computing,2006,3(3):263-270
[7] Arimoto S.Intelligent control of multi-fingered hands[J].Annual Reviews in Control,2004,28:75-85
[8] OzawaR,Arimo S,Nakamura S,et al.Control of an object with parallel surfaces by a pair of finger robots without object sensing[J].IEEE Transactions on Robotics,2005,21(5):965-976
Dynamics and stability of pinching movements
by dual fingers with redundant muscles
BHARATI Bimal1 WANG Ting1
1 School of Electrical Engineering and Control Science,Nanjing Tech University,Nanjing 211816
AbstractThis study investigates the dynamics of 3-dimensional pinching movements by dual two degree-of-freedom fingers with redundant muscles.The pinching movements are realized by the finger-thumb opposition.Both the thumb and index finger adopted the model with one monoarticular muscle and two biarticular muscles.During the pinching movements,the object may rotate along two axes so that it may achieve time-varying in 3-dimensional pinching.The dynamics and stability of the pinching movements are analyzed taking into account the co-contraction between the flexor and extensor muscles as well as the nonholonomic constraints.The numerical simulation is performed with a simple control signal to verify the effect of gravity.
Key wordspinching movements;monoarticular muscles;biarticular muscles;dynamic model