謝賢銓 陳志培 陶志成 胥 芳 鮑官軍

(浙江工業(yè)大學(xué)機(jī)械工程學(xué)院 杭州 310023）

0 引言

近年來(lái),多指靈巧手成為機(jī)器人領(lǐng)域熱門的研究方向,穩(wěn)定地抓持物體是多指手的一個(gè)基本功能,對(duì)抓持穩(wěn)定性的分析可以提高靈巧手抓持的成功性[1]。抓持穩(wěn)定性主要概括為物體穩(wěn)定性和接觸穩(wěn)定性兩方面,接觸穩(wěn)定性指物體受到外部擾動(dòng)后仍能保持接觸的能力,物體穩(wěn)定性指物體受到擾動(dòng)而偏離原平衡位姿后回到原平衡位置的能力[2]。本文在抓持系統(tǒng)處于準(zhǔn)靜態(tài)平衡的前提下去分析物體穩(wěn)定性,而物體穩(wěn)定性往往取決于抓持系統(tǒng)的剛度分布。

由于剛性靈巧手存在環(huán)境適應(yīng)性差、交互安全性差等問(wèn)題,目前靈巧手也逐漸由最初的剛性結(jié)構(gòu)逐漸向柔性結(jié)構(gòu)發(fā)展,主要體現(xiàn)在兩方面:一是使用軟材料作為指尖,二是在關(guān)節(jié)處使用彈性材料[3]。從本質(zhì)上看這兩方面都是抓持剛度的問(wèn)題,前者減小了接觸剛度,后者減小了關(guān)節(jié)剛度,從而能減少靈巧手對(duì)被抓持物體造成的損害。但是柔性的結(jié)構(gòu)帶來(lái)了建模的困難,目前對(duì)這類問(wèn)題的分析主要還是在彈性部位布置線性彈簧和扭簧進(jìn)行建模,由于是線性運(yùn)算,故相對(duì)有限差分法和有限元法具有優(yōu)勢(shì)[4]。文獻(xiàn)[5-8]對(duì)軟指尖以及抓持剛度都進(jìn)行了一定研究。文獻(xiàn)[9]在彈性模型中引入了阻尼并用鍵合圖對(duì)軟指尖建模。文獻(xiàn)[10]用微分的思想對(duì)硅膠軟指尖的特性進(jìn)行了分析。文獻(xiàn)[11]設(shè)計(jì)了一種以彈簧為關(guān)節(jié)的機(jī)構(gòu),并分析了抓持剛度。文獻(xiàn)[12]設(shè)計(jì)了一種適合深海探測(cè)的關(guān)節(jié)處加拉簧的機(jī)械手。文獻(xiàn)[13]基于接觸力學(xué)理論建立了抓持剛度模型。

抓持穩(wěn)定性分析的核心是量化的抓持穩(wěn)定性指標(biāo),穩(wěn)定性指標(biāo)在抓持任務(wù)中起著關(guān)鍵作用,如抓持規(guī)劃和抓持操作[14]。其中常被使用的是基于抓持矩陣G的代數(shù)特性幾種指標(biāo),包括力旋量橢球的體積最小值[15]、最小奇異值和各向同性指標(biāo)[16]等?；趲缀侮P(guān)系的穩(wěn)定性指標(biāo)也常被使用,包括抓持多邊形的形狀和面積[17]、接觸多邊形的質(zhì)心與對(duì)象質(zhì)心之間的距離和手指位置的不確定度等。但是這類抓持穩(wěn)定指標(biāo)僅僅是考慮了抓持點(diǎn)的分布以及物體表面的內(nèi)法向量,而最大最小抵抗力[18]則是考慮了抓持力的一種穩(wěn)定性指標(biāo),計(jì)算抓持可以抵抗任意方向上的最大的擾動(dòng)力,并且文獻(xiàn)[19]提出了一種有效的求解方法。還有一類從靈巧手構(gòu)型定義的穩(wěn)定性指標(biāo),如靈巧手構(gòu)型的可操作橢球體積[20],這個(gè)指標(biāo)著重于靈巧手的操作。

但是目前少有文獻(xiàn)對(duì)關(guān)節(jié)剛度和接觸剛度同時(shí)建模并從剛度層面進(jìn)行抓持穩(wěn)定性分析,針對(duì)這種情況,本文采用彈性模型和旋量理論對(duì)抓持剛度進(jìn)行建模,并針對(duì)軟指尖與物體之間的滾動(dòng)提出等效切向剛度對(duì)傳統(tǒng)四維軟指接觸剛度進(jìn)行了擴(kuò)展。在旋量空間中推導(dǎo)了由關(guān)節(jié)剛度和接觸剛度合成的廣義剛度,分析了被抓持物體受小擾動(dòng)力情況下的位姿變化。在廣義剛度的基礎(chǔ)上定義了擾動(dòng)力橢球用以分析抓持穩(wěn)定性,給出了綜合穩(wěn)定性指標(biāo)和面向特定擾動(dòng)力的穩(wěn)定性指標(biāo)的定義。最后設(shè)計(jì)了一個(gè)具備關(guān)節(jié)剛度和接觸剛度的三指靈巧手對(duì)抓持穩(wěn)定性進(jìn)行了驗(yàn)證。

1 抓持建模

傳統(tǒng)的DH(Denavit-Hartenberg)參數(shù)建模在運(yùn)動(dòng)學(xué)分析上有出色的表現(xiàn),但在速度和力的分析上不太直觀。而旋量建模在力和速度的分析上更具優(yōu)勢(shì),但是只有全局坐標(biāo)一個(gè)基坐標(biāo)。目前的靈巧手往往是基于手指的模塊化設(shè)計(jì),這種建模方式對(duì)于不同操作任務(wù)以及不同手指分布的靈巧手,往往面臨著復(fù)雜的重建模過(guò)程。本節(jié)使用了基于旋量的模塊化建模,避免了這種情況,比如全局坐標(biāo)位置發(fā)生變化時(shí),只需改變靈巧手手掌坐標(biāo)到全局坐標(biāo)的映射;當(dāng)靈巧手手掌結(jié)構(gòu)發(fā)生變化而手指結(jié)構(gòu)不變時(shí),只需改變建模過(guò)程的手掌坐標(biāo)到手指坐標(biāo)的映射。這種建模是符合靈巧手的模塊化設(shè)計(jì)[21-23]的。在接觸點(diǎn)以及關(guān)節(jié)處分別建立彈性模型,描述指尖坐標(biāo)系和接觸點(diǎn)坐標(biāo)系的相對(duì)運(yùn)動(dòng)與摩擦力的關(guān)系,之后針對(duì)擾動(dòng)造成的手指物體間滾動(dòng)情況引入了等效切向剛度。

1.1 基于模塊化的運(yùn)動(dòng)學(xué)建模

由于不同文獻(xiàn)中各種旋量的主副部表示不統(tǒng)一,本文所述的速度旋量主部表示旋轉(zhuǎn)運(yùn)動(dòng),副部表示平移運(yùn)動(dòng)。力旋量主部表示作用力,副部表示作用力矩。

多指靈巧手本質(zhì)上是一個(gè)復(fù)雜的多連桿機(jī)構(gòu),本文對(duì)抓持系統(tǒng)進(jìn)行模塊化的坐標(biāo)建立。一個(gè)抓持系統(tǒng)由靈巧手和被抓持物體構(gòu)成,其中靈巧手又由多個(gè)手指組成,手指又包括了各個(gè)關(guān)節(jié)以及指尖,如圖1 所示?；谙到y(tǒng)的這種組合關(guān)系,可以先對(duì)手指建模,將手指通過(guò)齊次變換矩陣連接到手掌組成靈巧手,然后將靈巧手通過(guò)一個(gè)齊次變換矩陣關(guān)聯(lián)到全局坐標(biāo)上。手指上的坐標(biāo)系均以手指坐標(biāo)系為基坐標(biāo)系,靈巧手以手掌坐標(biāo)系為基坐標(biāo)系。這樣,就可以在局部對(duì)系統(tǒng)進(jìn)行分析,并且能將結(jié)果方便轉(zhuǎn)換到全局,各坐標(biāo)系關(guān)系如圖2 所示。系統(tǒng)中還包含了手指關(guān)節(jié)運(yùn)動(dòng)旋量和指尖坐標(biāo)系的信息,其中第i根手指的第j個(gè)關(guān)節(jié)以運(yùn)動(dòng)旋量運(yùn)動(dòng)(相對(duì)手掌坐標(biāo)系),第i根手指上的關(guān)節(jié)數(shù)為mi。第i個(gè)指尖坐標(biāo)系Ofi相對(duì)手掌坐標(biāo)系的齊次變換矩陣如式(1)所示。

圖1 靈巧手坐標(biāo)系模型

圖2 模塊化各坐標(biāo)關(guān)系

在手掌位置固定的情況下,指尖坐標(biāo)系相對(duì)手掌坐標(biāo)系的速度旋量[24]如式(2)所示。

在被抓持物體中建立物體坐標(biāo)系和接觸點(diǎn)坐標(biāo)系,其中接觸點(diǎn)坐標(biāo)系的z軸為物體表面的內(nèi)法線,ω為物體在外力擾動(dòng)下的單位運(yùn)動(dòng)旋量,θobj為旋量大小。則接觸點(diǎn)坐標(biāo)系相對(duì)于全局坐標(biāo)系的速度旋量如式(3)所示,Ad為李群SE(3)的伴隨形式運(yùn)算。

由式(2)、(3)結(jié)合相關(guān)的旋量運(yùn)算可得手指坐標(biāo)系相對(duì)接觸點(diǎn)坐標(biāo)系的速度旋量,如式(4)所示,前一項(xiàng)反映了物體的運(yùn)動(dòng)引起接觸點(diǎn)相對(duì)當(dāng)前時(shí)刻接觸點(diǎn)坐標(biāo)系的速度,后一項(xiàng)反映了關(guān)節(jié)的運(yùn)動(dòng)導(dǎo)致指尖相對(duì)當(dāng)前接觸點(diǎn)坐標(biāo)系的速度。

速度旋量主部表示旋轉(zhuǎn)角速度,副部表示平移速度,指尖在接觸點(diǎn)各摩擦方向上的位移量如式(5)所示,其中δu為指尖相對(duì)物體表面接觸點(diǎn)的位移向量,B為摩擦類型矩陣,取軟指接觸類型,包括平行接觸面的兩個(gè)方向的摩擦力和垂直接觸面的正壓力以及摩擦力矩。Δ為旋量對(duì)偶算子,起交換旋量主副部作用。因?yàn)樗俣刃恐鞑康男D(zhuǎn)角速度會(huì)引起軟指摩擦扭矩方向的位移,副部的平移速度導(dǎo)致摩擦力方向的位移。D為物體的有限位移旋量,在dt→0 時(shí),dt→D。

1.2 接觸剛度及關(guān)節(jié)剛度建模

接觸點(diǎn)以及關(guān)節(jié)處用彈性模型建模,將一個(gè)穩(wěn)定的抓持系統(tǒng)等效為彈簧和扭簧的作用。本文考慮軟指接觸情況,軟指與物體的接觸屬于面接觸,進(jìn)一步假設(shè)軟指與物體的這個(gè)面是平面且物體是剛性的,由于接觸面各處的摩擦力分布不均,會(huì)產(chǎn)生垂直接觸面的摩擦力矩。如圖3 所示,對(duì)一個(gè)軟指接觸抓持系統(tǒng),將關(guān)節(jié)剛度等效為扭簧,接觸剛度等效為3 個(gè)彈簧和1 個(gè)扭簧,δ為預(yù)緊位移向量(圖中只表示了法向的分量),保證了接觸點(diǎn)處的摩擦力。

圖3 彈性模型

彈性模型中,假設(shè)所有的接觸力都是由虛擬的線性彈簧和扭簧發(fā)生形變產(chǎn)生的,則物體受到指尖的接觸力如式(6)所示。基于這個(gè)模型,一個(gè)穩(wěn)定的抓持系統(tǒng)在擾動(dòng)力的作用下從初始穩(wěn)態(tài)到另一個(gè)穩(wěn)態(tài)實(shí)際是各虛擬彈簧發(fā)生形變使彈性系統(tǒng)再平衡的過(guò)程。彈簧模型的優(yōu)點(diǎn)是可以線性化抓持問(wèn)題,大大降低分析的復(fù)雜程度,但是結(jié)果只具有系統(tǒng)局部特征。

實(shí)際在擾動(dòng)力作用下系統(tǒng)從一個(gè)穩(wěn)態(tài)到達(dá)另一個(gè)穩(wěn)態(tài)的過(guò)程中,軟指與物體之間往往是伴隨著相對(duì)滾動(dòng)的,目前對(duì)滾動(dòng)接觸還沒(méi)有十分簡(jiǎn)便的建模。針對(duì)滾動(dòng)接觸情況,當(dāng)擾動(dòng)力不大的情況下,接觸點(diǎn)位置的變化相對(duì)于物體可以忽略。在彈性模型的基礎(chǔ)上通過(guò)在軟指接觸處引入平行接觸面的線性扭簧來(lái)平衡擾動(dòng)力矩,可以達(dá)到等效的瞬時(shí)滾動(dòng)效果。在這些假設(shè)前提下,可以線性化地分析系統(tǒng)的局部特性。圖4 所示為二維情況下物體與軟指存在的相對(duì)滾動(dòng)現(xiàn)象,以及為了考慮這種情況引入的虛擬扭簧。在三維情況下將軟指剛度從四維擴(kuò)展到六維,擴(kuò)展軟指接觸中缺失的二維,B取單位矩陣I6×6。

圖4 二維情況中指尖與物體的滾動(dòng)情況

2 穩(wěn)定性分析

本節(jié)基于上節(jié)提出的抓持建模,建立了抓持系統(tǒng)中的接觸力平衡方程和關(guān)節(jié)力矩平衡方程,定義了抓持系統(tǒng)的廣義剛度。根據(jù)廣義剛度定義了擾動(dòng)力橢圓,并提出了綜合穩(wěn)定性指標(biāo)以及針對(duì)特定方向力的穩(wěn)定性指標(biāo)。

2.1 廣義剛度

假設(shè)物體在受微小外力擾動(dòng)后接觸力向量變化為δf,第i個(gè)指尖對(duì)物體的接觸力旋量變化量δω可以表示為式(7)。第i根手指第j個(gè)關(guān)節(jié)的力平衡方程如式(8)所示,其中為第i根手指第j個(gè)關(guān)節(jié)對(duì)第j個(gè)指節(jié)的作用力旋量變化量(基于該關(guān)節(jié)坐標(biāo)系)。根據(jù)彈性模型的假設(shè),關(guān)節(jié)處僅存在運(yùn)動(dòng)方向上的剛度,即關(guān)節(jié)坐標(biāo)z軸方向的扭轉(zhuǎn)剛度,這個(gè)方向上的擾動(dòng)由虛擬扭簧的形變平衡,表示為式(9)。

由式(8)、(9)可推出第i根手指上接觸力的變化與關(guān)節(jié)剛度以及關(guān)節(jié)角度之間的關(guān)系如式(10)所示,其中Ki為第i根手指上的關(guān)節(jié)剛度矩陣,矩陣Ci將接觸力旋量空間映射到關(guān)節(jié)力旋量空間。

由式(5)～(7)及式(10)可得外力擾動(dòng)作用下單根手指上關(guān)節(jié)角變化與物體位姿變化之間的關(guān)系,如式(11)所示,其中Kci為第i個(gè)接觸點(diǎn)的接觸剛度矩陣。由物體受到外力旋量與所有指尖對(duì)其產(chǎn)生的力旋量相平衡還可得出物體所受外力旋量與物體有限位移旋量之間的關(guān)系,如式(12)所示。

為簡(jiǎn)化表達(dá),將式(11)、(12)中有限位移旋量D的系數(shù)分別記作Mi、P,δθf(wàn)i的系數(shù)分別記作Ni、Qi,如式(13)～(16)所示。聯(lián)立得到抓持平衡下微小外力對(duì)物體位姿的擾動(dòng)方程如式(17)所示。將物體有限位移D的系數(shù)矩陣定義為廣義剛度Ktotal,Ktotal反映了抓持系統(tǒng)在六維旋量空間中各方向的剛度情況。

2.2 穩(wěn)定性指標(biāo)

目前抓持穩(wěn)定性指標(biāo)沒(méi)有統(tǒng)一的標(biāo)準(zhǔn),大量的學(xué)者也提出了各種形式的穩(wěn)定性指標(biāo)[25-27]。接觸穩(wěn)定性分為物體穩(wěn)定性和接觸穩(wěn)定性兩個(gè)方面。物體穩(wěn)定性指物體受到擾動(dòng)偏離原平衡姿態(tài)后能回到原平衡位姿的能力;接觸穩(wěn)定性指物體受到外部擾動(dòng)后仍能始終保持接觸的能力。本文分析了物體穩(wěn)定性,將其定義為外力對(duì)物體位姿的擾動(dòng)。

令DTPD=1,其中權(quán)重矩陣P為六維對(duì)角矩陣,對(duì)角元素為有限位移旋量D各分量的權(quán)重,是為了平衡D主副部單位不同以及物體坐標(biāo)位置不同產(chǎn)生的影響,同時(shí)反映了物體各偏移量在穩(wěn)定性中所占權(quán)重。則ω滿足式(19)的擾動(dòng)力橢球方程,二次型矩陣的特征向量為該橢圓的軸方向,對(duì)應(yīng)特征值開方的倒數(shù)為橢圓半軸長(zhǎng)。特征值越小,對(duì)應(yīng)軸的長(zhǎng)度越長(zhǎng),說(shuō)明物體在該方向上穩(wěn)定性越強(qiáng),于是可將抓持的綜合穩(wěn)定性指標(biāo)S定義為各特征值的乘積的絕對(duì)值,如式(20)所示。另一方面,對(duì)于給定的擾動(dòng)力ω造成的物體有限位移旋量D,定義為ω的擾動(dòng)半徑,ω位于擾動(dòng)半徑為的擾動(dòng)力橢圓上,抓持對(duì)擾動(dòng)力ω的穩(wěn)定指標(biāo)定義為ω?cái)_動(dòng)半徑的倒數(shù)Sω,如式(21)所示。

特殊地,取P前3 項(xiàng)為0,后3 項(xiàng)為1 時(shí),表示Sω只考慮物體的位移,且各向位移所占權(quán)重一致,而不考慮物體的角度偏移,此時(shí)擾動(dòng)力橢球表現(xiàn)為位移擾動(dòng)力橢球,表示造成物體單位位移的力旋量集合。P前3 項(xiàng)取值為1,后3 項(xiàng)取0 時(shí),表示Sω只考慮物體的角度偏移,且各向角度偏移所占權(quán)重一致,而不考慮物體的位移,此時(shí)擾動(dòng)力橢球表現(xiàn)為角度擾動(dòng)力橢球,表示造成物體單位角度偏移量的力旋量集合。

整體的分析流程如圖5 所示。對(duì)一個(gè)抓持進(jìn)行穩(wěn)定性分析,首先是對(duì)抓持系統(tǒng)中的各模塊基于其上一層的依賴模塊進(jìn)行坐標(biāo)建立。然后在關(guān)節(jié)處以及接觸處應(yīng)用彈性模型,在關(guān)節(jié)坐標(biāo)上分析關(guān)節(jié)剛度,在接觸點(diǎn)坐標(biāo)上分析指尖坐標(biāo)與其相對(duì)運(yùn)動(dòng)的關(guān)系并對(duì)接觸剛度進(jìn)行分析。分別在各關(guān)節(jié)處和接觸點(diǎn)處建立全局坐標(biāo)上的力平衡方程,得出抓持系統(tǒng)在旋量空間中的廣義剛度。最后通過(guò)廣義剛度構(gòu)建相應(yīng)的擾動(dòng)力橢圓,進(jìn)行抓持穩(wěn)定性分析。

圖5 分析流程

3 實(shí)驗(yàn)與結(jié)果分析

3.1 實(shí)驗(yàn)平臺(tái)

實(shí)驗(yàn)平臺(tái)如圖6 所示,實(shí)驗(yàn)采用了腱繩驅(qū)動(dòng)的三指手對(duì)物體進(jìn)行抓持。為了保證實(shí)驗(yàn)過(guò)程中指尖與物體不發(fā)生滑動(dòng),采用了黑膠帶包裹的泡沫六面體作為被抓持物體,泡沫物體質(zhì)量小,黑膠帶能增大手指與物體之間的摩擦。在腱繩中間加裝拉簧模擬關(guān)節(jié)處的剛度,三指手的位姿由關(guān)節(jié)處的角度傳感器測(cè)得,物體的位姿由Nokov 光學(xué)三維動(dòng)作捕捉系統(tǒng)進(jìn)行測(cè)量,整體的硬件連接如圖7 所示。該實(shí)驗(yàn)平臺(tái)可以研究在某一剛度下、不同大小方向的擾動(dòng)力對(duì)物體位姿的影響。

圖6 實(shí)驗(yàn)平臺(tái)

圖7 硬件連接圖

將實(shí)驗(yàn)裝置放置在捕捉系統(tǒng)的合適位置,標(biāo)定靈巧手相對(duì)視捕系統(tǒng)全局坐標(biāo)系的位置。在未抓取物體時(shí)記錄三指手初始的關(guān)節(jié)角度。拉動(dòng)腱繩使物體處于穩(wěn)定抓持狀態(tài),記錄關(guān)節(jié)角度以及物體的初始位姿。分別放置100 g 的砝碼于定位盤的1～12號(hào)位上,記錄各手指關(guān)節(jié)角度的變化以及物體的位姿變化。更換砝碼重量重復(fù)上述過(guò)程。

3.2 實(shí)驗(yàn)結(jié)果分析

200 g 和100 g 砝碼擾動(dòng)實(shí)驗(yàn)數(shù)據(jù)如圖8 所示,可以看出兩組實(shí)驗(yàn)的數(shù)據(jù)如式(17)所示滿足一定的線性關(guān)系,表明在小擾動(dòng)力范圍內(nèi),物體的姿態(tài)變化量與擾動(dòng)力大小成正比。實(shí)驗(yàn)中,為了測(cè)量數(shù)據(jù)的精準(zhǔn),將物體坐標(biāo)系直接建在靠近7 號(hào)砝碼位的Mark 點(diǎn)處,從圖8(b)可以看出,將砝碼放在7 號(hào)砝碼位時(shí),物體在重力方向(-z軸)上產(chǎn)生的位移最大。同理在砝碼逐漸遠(yuǎn)離該Mark 點(diǎn)時(shí),物體在重力方向上的位移也逐漸變小,呈一個(gè)“V”形分布。1號(hào)和12 號(hào)砝碼位由于離Mark 點(diǎn)更遠(yuǎn),物體在重力方向產(chǎn)生的位移最小,意味著物體在重力方向上對(duì)1 號(hào)和12 號(hào)砝碼產(chǎn)生的力有著更好的位移穩(wěn)定性。但是距離產(chǎn)生了更大的力矩使得物體在各方向上的角度偏移量相對(duì)其他位置更大,意味著物體在這些方向上對(duì)這兩個(gè)力的角度穩(wěn)定性較差。

圖8 100 g 和200 g 砝碼進(jìn)行實(shí)驗(yàn)的數(shù)據(jù)對(duì)比

兩組實(shí)驗(yàn)的物體位姿變化與理論對(duì)比分別如圖9和圖10 所示,在200 g 砝碼擾動(dòng)的實(shí)驗(yàn)中,各向角度偏移的平均誤差為0.95 °,各向位移平均誤差在0.8 mm。在100 g 砝碼擾動(dòng)的實(shí)驗(yàn)中,各向角度偏移的平均誤差在0.65 °,各向位移平均偏差在0.6 mm。圖11 為兩組實(shí)驗(yàn)物體角度總偏移及總位移與理論的對(duì)比,200 g 實(shí)驗(yàn)中,角度總偏移平均誤差為1.18°,總位移平均偏差在1.0 mm。100 g 實(shí)驗(yàn)中,角度總偏移平均誤差為0.78 °,位移總偏差為0.82 mm。總偏差由對(duì)應(yīng)的各分量的平方和開方計(jì)算得到,誤差是各分量的累積,對(duì)總偏差跟蹤的效果不如各分量的跟蹤效果,但總體的趨勢(shì)是一致的。實(shí)驗(yàn)表明,在關(guān)節(jié)剛度和接觸剛度存在的小擾動(dòng)力情況,本文理論能較準(zhǔn)確地預(yù)測(cè)物體的位姿變化,從而判斷該擾動(dòng)力下的穩(wěn)定性。

圖9 200 g 擾動(dòng)實(shí)驗(yàn)物體位姿變化對(duì)比

圖10 100 g 擾動(dòng)實(shí)驗(yàn)物體位姿變化對(duì)比

圖11 總角度/位移變化量對(duì)比

由于每組實(shí)驗(yàn)砝碼提供的擾動(dòng)力方向大小一致,均為恒定的砝碼重力,對(duì)物體坐標(biāo)系產(chǎn)生的力矩維度為2(不產(chǎn)生重力方向的力矩)。固定擾動(dòng)力旋量的主部為砝碼的重力,取力矩平面的2 個(gè)單位正交向量為坐標(biāo)軸可以將砝碼所施加的一系列六維擾動(dòng)力壓縮到二維平面,并將穩(wěn)定性指標(biāo)以等高線形式繪制。根據(jù)之前分析,擾動(dòng)力橢圓半徑與穩(wěn)定性成負(fù)相關(guān)關(guān)系,通過(guò)對(duì)比各砝碼位力的穩(wěn)定性指標(biāo),可判斷該抓持位形下各點(diǎn)所表現(xiàn)的物體穩(wěn)定性。圖12所示為2 組實(shí)驗(yàn)不同權(quán)重下的擾動(dòng)力橢圓,不同擾動(dòng)力橢圓的權(quán)重矩陣P取值如表1 所示。從角度擾動(dòng)云圖預(yù)測(cè)出物體上的9 號(hào)砝碼位有更好的角度穩(wěn)定性,而12 號(hào)位的角度穩(wěn)定性最差。對(duì)比圖11的角度偏移實(shí)驗(yàn)數(shù)據(jù),無(wú)論是100 g 還是200 g砝碼的實(shí)驗(yàn),可以看到9 號(hào)砝碼對(duì)物體產(chǎn)生的角度偏移最小,12 號(hào)砝碼能產(chǎn)生更大的角度位移。從位移云圖預(yù)測(cè)出3 號(hào)位有更好的位移穩(wěn)定性,7 號(hào)位的位移穩(wěn)定性最差,對(duì)比圖11 的位移偏移實(shí)驗(yàn)數(shù)據(jù),兩組實(shí)驗(yàn)均表現(xiàn)出一致的實(shí)驗(yàn)結(jié)果,其余位置除個(gè)別點(diǎn)因誤差累計(jì)過(guò)大偏離了預(yù)測(cè)的橢圓,預(yù)測(cè)結(jié)果與實(shí)驗(yàn)數(shù)據(jù)基本上是一致的。

圖12 200 g/100 g 實(shí)驗(yàn)擾動(dòng)力橢圓

表1 各擾動(dòng)力橢圓P 取值

4 結(jié)論

本文以關(guān)節(jié)剛度和接觸剛度同時(shí)存在的抓持作為研究對(duì)象,通過(guò)旋量理論建立了小擾動(dòng)力作用下物體位姿變化模型。針對(duì)受擾動(dòng)作用時(shí)物體與指尖的相對(duì)滾動(dòng)情況,引入了二維虛擬扭簧將傳統(tǒng)的軟指建模由四維擴(kuò)展成六維。在旋量空間中分析了廣義剛度,基于廣義剛度提出了擾動(dòng)力橢球的概念,并闡述了擾動(dòng)力橢球與物體穩(wěn)定性之間的關(guān)系。此外,進(jìn)行了三指抓持的實(shí)驗(yàn)驗(yàn)證,表明本文提出的理論模型與實(shí)際情況吻合良好,利用該模型能準(zhǔn)確判斷抓持物體在各點(diǎn)上表現(xiàn)出的物體穩(wěn)定性。