Զѧ
ACTA AUTOMATICA SINICA
2000Vol.26No.1P.7-15



ڷ˶滮Ķָɲ
ǿ
ժ Ҫ ɲǶֲָһҪ棬̽ʵֲĴ.ôķԣз˶·滮Ȼݹ滮Ӧöֲָ˶ѧȷָ˶.Ϊָɲʵṩһ;.
ؼ ָ֣˶ѧɲ˶滮.
DEXTEROUS MANIPULATION OF MULTIFINGERED HAND BASED ON NONHOLONOMIC MOTION PLANNING
GUAN Yisheng HE Yongqiang ZHANG Qixian
(Robotics Research Institute,Beijing University of Aeronautics and Astronautics,Beijing 100083)
Abstract Dexterous manipulation is an important topic of multifingered study. Dexterous manipulation with rolling contacts is addressed in this paper. Based on the nonholonomy of rolling, a nearoptimal planning method of nonholonomic motion is given by Ritz approximation, with the shortest length of contact trajectory on the fingertip face as cost function. With the planning results, according to the proposed multifingered kinematics equation, the motion of finger is generated to realize the desired dexterous manipulation.
Key words Multifingered hand, kinematics, dexterous manipualtion, rolling contact, nonholonomic motion planning .
1 
ֵָһҪŵжץ֣ҿʵץ֮ı仯һץλιɵһץλ.Ҳ˵ָͨ˶ıָץ״ (Ӵλ)ɲڲоش壺һΪȶɿץ壬ʼĻеץλβʱҪһõץλΣָڲ˶λáָ֮佫иӴ㽫ԽЧĽӴʱҪָĽӴ״̬.ʵɲж;ָ̬滮(finger gaiting)ʹ.дķԼ򵥡ڲбȽױ֤ɿץֶоԱĹע.
һַԼ˶ڽӴٶԼĲɻ.÷˶滮ķӦ÷Կۼʵɲ.LiCannyִ΢ּεоӴ֮Ĺ1ݣλοռ·Ĵԣһ·滮ķ˷ֻ״(Բƽ)·仯󡢲⻬.MurraySastryչҺϵͳĹ滮ʽƶ·滮ϣ2ݣģ3о״ָ˵ָʱӴλε⣬ָ˺ͱץ֮תΪ룬ٶԼתΪʽϵͳ㷨Ҫ׶ΣȽϸ.ое㷨ŵģûпݹ滮Ľָ˶.
ϵͳ̽ôжָɲķ.Ȼڴķ˶ԣýӴλеֲʱ仯ΪЧķԿϵͳ룬ԽӴָ߹·Ϊָ꣬Դ·滮.Ȼݹ滮ĽӦöֲָ˶ѧָ̲˶Ӷʵֵֶָɲ.
2 ķ
ͼ1ʾnָĶָ֣˶ѧΪ8

ͼ 1 ָּϵ趨
(1)

vpoΪٶȣϵAdgΪӦλgİ任4ݣٶȴһϵ任һϵΪָiſɱȣMKֱӴĶ.Ϊ滮˶ֻ쵥ָ.µĹʽУָ±i.ôķʵָĽӴһλεһλεı仯ԴڴķԣȻڽӴλεٶԼڽӴλԼ.ִ΢ּεйضͷԿϵͳĿɿ˵4.
ɽӴ˶ѧ5ݿɵôнӴٶԼ
(2)
(2)ʽߵǰһдΪ
ʽдΪPfaffianԼı׼ʽ
ʽɵ
(3)
һԿϵͳ̣ɿ봿PfaffianԼ(2)ķ(ɻ)ǵȼ۵.ԿϵͳĿɿԿChow˵.Ϊϵͳʸgi(q)ʸųɷֲжά()ֲάϵͳ״̬ռάϵͳǿɿص.

ͼ2 ָ˺ľֲϵ趨
ƽָ˵˫ֲָ뾶ΪoΪ.ͼ2ʾľֲϵ󣬿ɵָ˵ļβ(KMʽT)Ϊ

ļβ

Ǵ(3)ʽõ

ʸg1g2

ɼھֲĶڣʸg1,,g5
ģųɵķֲά5״̬ռά.
״ָָȫ.״ָ˲壬ǵİ뾶ʱôķҲʵֽӴλοռе仯1.
3 ·Ź滮
·滮ָʼĺֹλΣѰһʵϵͳ뼴ʵ·ʹϵͳӳʼλ˶ֹλ.ɲУϣӴڱ߹·ֿ̣ǳ㣺1) ·ʱӴ㲻׳Խָ˺ͱץϵЧĽӴ2) ̵·ʹָ˺ͱץ˶Χָﵽ乤ռ߽磻3)·Խ̣ЧԽ.·滮.
ӴʱΣ0,Tڣڱ߹·ȿΪ8

MΪĶ.
УӴӴ߹·.ֻ迼ǽӴһϵ·ȣȻѡȡϼ򵥵ı.ΪѧϵĴĿ꺯Ϊ

Կϵͳ(3)У뼴Ϊʽе·滮תΪ˵̶Ż
(4)
ϵͳɿʱŻu*L20,TݣL20,Tɶ0,Tڵ
ĿɶʸɵHilbertռ.
ƽ֮ĹΪ˵ĽŽ.ƽϣMΪ22λĿ꺯ΪʱΪT=2УΪL20,TϵһôuL20,TݿɱʾΪΪϵʽ
бйɵHilbertռ.Ŀ꺯Ϊ

Ѱuͳϵa.ȻaάģãӦRitzƽȡάĽƽ6.ȡǰN

uǽƵģСĿ꺯ʱӦɴɵq.ΪˣĿ꺯Ϊ
(5)
Уã0ΪӣΪȨΪڷŷռжʸqġС.Ӵλοռ䲻Ƕռ䣬Ϊaf,ao,׵ٲͬ.ΪϵͳΪʼTʱ̵״̬.ȻaRNĺ.q(T)=f(a)Ŀ꺯(5) 
(6)
֤N,áʱάĽŽάŻ6.
(6)ʽļֵţٷ
(7)
ʽƵJ(a)Taylorչfi(a)Hessians.Ϊf(a)Jacobian=1/,0̣1Ϊ.f(a)Jacobian Aɰз㣺
ôu=aʽ(3)Ϊ
ȻAΪt=TʱֵY(t)΢ֿɵ

ÿһt=0t=T΢ַˢa
(8)
f(ak)=q(T), A=Y(T).ϵ󼴵ϵͳ룬Ӷõϵͳ״̬Ĺ켣.
4·滮
Բƽָ˵ָ뾶Ϊ90mmСΪ(μͼ2)ϽڵĴ˶滮з֤.
ٶָĳʼӴλΪq0==(10,6,0,0,0.3)Բָ˵ĳʼӴ㲻ģֹӴλΪqf=(0,0,0,0,0).Ҫ1ڴӳʼӴλιɵֹӴλ.ȡҶǰʮN =10

ϽڵĵϵͳΪ
u1(t)=-0.0002-0.9320sin2t+1.6534cos2t+0.8853sin4t-0.4084cos4t
u2(t)=0.0002+2.1396sin2t-0.2472cos2t-0.1686sin4t-0.4063cos4t.
Ӵָϵ·ͼ3(a)ʾӵ(10,6)˶(0,0).ͼ3(b)ΪӴ켣(0,0)(0,0)һյ·.Ӵʱı仯ͼ3(c)3(d).Ӵλδ(10,6,0,0,0.3)ܺõعɵ(0,0,0,0,0).

ͼ3 ·滮
һǽӴλȡֵ.ٶʼӴ궼Ϊ㣬q0==(10,6,0.2, -0.1, 0.3)Ҫ1sڹɵqf=(0, 0, 0, 0, 0).ͬɵõķģ8.
5 ɲ㷨
ֱϽֻ滮ָ뱻ץ˶켣Ӧָ˶.ݷ˶滮ýӴʱ仯ʣٸݱץ˶ָ˶ѧָ˶.㷨(ͼ4).

ͼ4㷨̿ͼ
ɲ㷨
֪1)ָ˶ѧģͣ
2)ָ˺ļģ.
룺1) ʼץλΦ(0)(0)
2)ץ˶켣g(t)
3)ĽӴλΦ(T)
4)ʱT.
ָĹؽڹ켣(k).
̣1)ɢN,k=0
2)÷滮·(t)
3)ɢٶvpo(k)
ͽӴٶ
4)(1)ʽ
5)ؽڽǦ(k+1)=(k)+
ظ3)5)ֱk=N.
ǰֲָСΪ.ָɶ(HKUST HandָɶȵMotoman K3S).ָ1 (ͼ2ߵF1)ĳʼӴλΪ(10, 6, 0, 0, 0.3)ʱָؽڽΪ (0.0184, -0.3307, -0.6082, -0.0322, 0.6084,-0.2736)ָ˵ϵ(ָм)еΪ (-89.9838, 8.6849, 482.1695)Ϊ (0, 0, 490).Ҫ1sϾ50mmͬʱӴλε (0,0, 0, 0, 0).ǰڵĹ滮㷨ָָ˹켣ķͼ5ʾ.ӷָ˵䵽 (-90.0383, 0.0744, 539.9227)̬R(0)仯R(1)ȷ.ͬһָ˶.



ͼ5 ָ˹켣
6 
ָɲһʤѶȵ⣬ȻʵɲмǱڵ;Ŀǰûнϼ򵥿еķ.˴ķԣԽӴڱ߹·Ϊָ꣬Ritzƽ˴ķ˶·滮ĽŽ⣬ֹ滮Ч.·滮Ľֲָ˶ѧָ˶Ӷʹɲõ˾ʵ.ӦָָɶȽʱԸݹ滮Ľָľȷ˶.Щ£ҪǸѶȵָ̬滮򻬶.
л ĲֹۿƼѧɣõ沩ʿָԴ˵һл.
ȻѧĿ(69785001).
 1966ʿ.Ҫо򣺻˲.
ǿ 1966ʿҪо򣺻ֿ
 1925ԺԺʿ.Ҫо򣺻ѧѧ.
(պѧо  100083)
ǿ(պѧо  100083)
(պѧо  100083)
ο
1Li ZCanny J. Motion of two rigid bodies with rolling constraint. IEEE Transactions on Robotics and Automation, 1990, 6(1)6271
2Murray R MSastry S S. Nonholonomic motion planning: steering using sinusoids. IEEE Transactions on Automatic Control,1993385700716
3Murray R MSastry S S. Grasping and manipulation using multifingered robothand.InProc. of Symposium in Applied Mathematics, 1990, 429312938
4Murray R M, Li Z, Sastry S S. A Mathematical Introduction to Robotic Manipulation. CRC Press, 1994
5Montana D J. The kinematics of contact and grasp. The International Journal of Robotics Research, 19887(3)1732
6Fernandes C, Gurvits L. Nearoptimal nonholonomic motion planning for a system of coupled rigid bodied. IEEE Transactions on Auotmatic Control, 1989393450463
7,. ֲָ˶ѧ㷨ʵ. ˣ1998205321327
8. ֲָۡ㷨ʵ۲ʿѧλģ.պѧ1998
ո 1998-06-23 ޸ĸ 1999-03-25
