Զѧ
ACTA AUTOMATICA SINICA
1999ꡡ255ڡVol.25 No.5 1999



˶ָĵݽ׿1)
־ǿס
ժҪΪ˶ָЭһݽ׿ϵͳ.һ滮һϵ˶ٶȣȻЭ˶滮˶ٶָ˶ٶȺץȡ̬仯ͬʱץȡ滮Ϊƽϵݵǰץȡ̬ɸָץȡϵͳָ˶ٶΪʵץȡɵ˳ӦٶȺϲָͨſɱתΪָؽ˶ٶȺָĹؽڼ˶ʵָ˶ץȡĿ.ÿƷѳɹӦۿƼѧ(HKUST)ֿϵͳĿ.ʵ֤÷켣ĸٿ񣬶ԻƺٶȵĻϿ.

ؼʡ˶ָ֣ݽ׿ƣ˶滮ץȡŻ.
HIERARCHICAL CONTROL OF ROBOT MULTI
FINGERED MANIPULATION
QIN Zhiqiang XIONG Youlun
(School of Mech. Eng., Huazhong University of Science and Technology, Wuhan430074)
LI Zexiang
(Dept. of EEE, Hong Kong University of Science and Technology, Hong Kong)
AbstractThis paper presents a hierarchical control system for robot multifingered coordinate manipulation. Given a manipulation,the task planner generates a sequence of object's motion velocities at first,and then generates for coordinate motion the desired velocities of finger's motion and desired orientation change of the grasped object according to the desired velocities of object's motion.At the same time,the force planner generates the grasp forces on the fingers in order to resist the external forces on the object,according to the grasp posture.Finally,the system generates a result compliance velocity from both the desired finger's velocities and desired grasp forces,and transfers it into joint velocites through the finger's inverse Jacobian.Then the controller of joint motion implements the control of both forces and velocities for the fingers.The approach has been applied to the development of control system HKUST dexterous hand successfully.Experiment results show that it is not only possible to trail and control the object's track,but also possible to realize force control and the hybrid control of both forces and velocities through this method.
Key wordsRobot multifingered hand, hierarchical control, motion planning, optimization of grasping forces.
1
˶ָץȡͲоѾΪƼһҪо.ʮоڶֵָơץȡۺϡָ˶ѧ֪ƵѾȡչ.ȣָеѾƳΪоָץȡͲṩǿʵϵͳ1ݣڷץȡԡƽ⡢ȶԺͶ̬Եۺ㷨Ѿҵ2.ָ˶ѧף3,4н꾡оӾҲѿڸ֪ӴλúͽӴץȡŻ㷨Ѿҵ4,5ݣǹ̶ӴǹӴָֺͶ˵Эƺ˳Ӧ㷨ѵõо69.
ܶԶָ˴оĿǰڶָץȡͲоȻȱɿĶָеʵϵͳĲ.һҪԭ£1)ȱ֪رǾȷɿظָ֪ץȡĽӴ2)оھ̬ץȡץȡ̬仯3)ȱͳһıʵʱʵֵĶָֿϵͳṹ4)ʵֶָĶĿָ꣬˶켣뱣ʵץȡ̬άץȡ5)ʵ.
Ϊָһݽ׿ϵͳܣHKUSTָʵƽ̨ĿصоָʵʱЭ˶ɺץȡŻ㷨Ӧúʵʵ.
2ָĵݽ׿ϵͳṹ
ͨڲͬʵĴϢϵͳͬʱﵽؿЧ1)ȷٱץȡ˶켣2)ϸ΢ץȡ3)ŻָץȡάֽӴԼƽ.ÿƿܾпŵģ黯ĽṹΪһ͵ĵݽ׿ϵͳͼ1ʾڼʵֲͬģвм.ҪģĹ£



ͼ1ָݽ׿ϵͳṹ
1) 滮 ڲλ˺Ϣ㱻ץȡ˶ٶȺƽĹ
2) Э˶滮 ϸ΢˶ʱ,ù滮˶ٶȺʹϢΪ룬Ϊÿָָ˶ٶȣͬʱŻץȡָꣻ
3) ץȡ滮 Ϊ룬Ϊÿָŵץȡ
4) ָ˳Ӧ˶滮 Ȳ˳Ӧ˶򣬽ϢΪָץȡתΪָָλƣȻЭ˶滮ɵָ˶ٶȽյָ˶ٶȣ˶ѧģ齫ٶתΪָؽڵ˶.ָؽڵ˶ɹؽڼ.
3Э˶
Pʾϵ, Oʾϵ, Fiʾָi ָ˹ϵ.ΪָĽӴڽӴ㴦ϵָiָϵLfiĽӴϵLoi.ָiĽӴæ=(f,o,).æiʾָiĹؽλÿӴΪɶȵؽڣqi=(i,i)ΪָiĹؽ.ץȡϵλ˺ٶȷֱΪ
gpo=gpfi(i)gfio(i),i=1,N(1)
(2)
ӷ(2)ԿٶȡӴٶȺָٶǻκ飬һ.
(3)
ڲֻǸӴԼӴԼõ3,õ
(4)
BiR6mӴģͶӦmiΪָiͨӴõ϶ĦӴmi=3ָӴʱmi=4.
ָϵͳÿָΪһλÿ豸ˣʱָ˶ٶȾָ˶ϵͳ.˶ٶȣֻʽ4ÿָ˶ý޷֤ץȡ.Ϊ¿ʽ3ڹӴ£ӴٶȽɹٶȾٶֿɸݽӴ˶ѧϽӴ仯ٶȷ
(5)

(Mf,Kf,Tf),(Mo,Ko,To)ֱΪָļ״ڸԽӴϵе.Ȼ5ʽұߵһʵֱ˶ڶЭָ˶Żץȡ.
fR2NR(o1,oN)=o(o)
ΪӴռϵʵֵһץȡf(o)ȡֵСֵʱץȡ.ôΪʹץȡ̬仯ʽ5Ӵı仯ٶȿм򵥶ֱ۵ķ
(6)
СΪf(o)ڱoiݶ,i(0,1).СֵӦڶֵָץȡʽ6ǰһż.
4ץȡļ
ָץȡŻ⣬ŵץȡx=(x1,,xN)TRmĶfdR6Ҳ̣ⷽ10
Gx=fd.7
ѧ߶ĦӴָӴо㷨.д㷨ȽԵĦԼԻȻԹ滮ķƽ.BussHashimotoMooreһ·ȷ5.
Nָץȡ壬нӴĦԼȼڿԽǾP=Blockdiag(P1PN)İԣPi=PTiĦӴָӴֱΪ
(8)
ԽPṹеԼдη
A1vec(P)=0,(9)
ΪһΪ,PRnn,P0,l=n2,ΪԵʽԼĸ.
Ϊϲfd ָĽӴxRmƽԼ(7)ԼҲдԼ
A2vec(P)=fd(10)
ʽA2R6lӴĺ.ʽ910ϵһ, õ
Avec(P)=q,(11)

P(n)ʾn׶Գļϣ弫СĿ꺯
P(n)RP(P)=tr(WpP+WiP-1),(12)
Wp,WiRnnΪȨӣtr(.)ʾļ.Լ11õʽ12ݶϵõԼݶ
vec()=Qvec(P-1WiP-1-Wp),(13)
Q=(I-A+A)ΪͶӰӣA+=AT(AAT)-1ΪAĹ.
Ϊڼʵ֣Լݶɢõ
vec(Pk+1)=vec(Pk)+kQvec(P-1kWiP-1k-Wp),(14)
ЦkΪѡȷÿ㶼ʹĿ꺯С.΢ַ̣16ĳʼֵԼ11ʱʽ13ĽָٶΨһСֵ.
ڹӴ¶ֲָʵʱץȡУһҪͶӰQ ʵʱ㣬Ϊаиάļ.磬ָһ壬QR6464.ʹһľ㷨;˷33MHzMC68040ƬϼһQʱ3ӣȻ޷ʵʱƵҪ.Ϊ˿˷һѣʽ11۲쵽Aɣ
Ϊһ󣬶һϡA2R6lӴĺץȡ̬ı仯仯Ҳһϡ.
(15)
÷ֿõ
16
Ц=A22AT12A-111A12R66,E=A-111A12,F=AT12A-111.ȻA11ǳϵôA-111Ϳ߼㣬ʵʱУֻ66󦤵.⣬ڼеľϡ˾ĳ˷ϡĳ˷㣬⽫Լļʱ.ʩͬļԴ£ʵʱһQʱɼٵ50msңʵʱҪ.
5ָ˳Ӧ
Э˶滮ģɵĸָ˶ٶһʵ˶ٶȣһʹץȡָߣץȡ滮ģɵĸָץȡڸĦ׶ԼΧڣƽϵ˶Ĺ.ļÿָλÿ豸˳ӦָץȡfdiʵʲõָfmiƫתΪָ΢λƣȻ˳Ӧ΢λƺЭ˶ģɵ΢λʸӣõ
(17)
KciR66˳Ӧϵ󣬶ȷ˳ӦϵûͳһۿԲοĿǰҪʵ;ȷĳһʵϵͳ˳Ӧ󣬵һ˳ӦǶԳ.ʵʵץȡץȡʱκָ˶ֶָ.
󣬴΢λƾָ˶ѧתΪָؽλƣɹؽڼָ˳Ӧ˶.
6Ӧʵ
ĿϵͳܽṹѳɹۿƼѧHKUSTָɻеֿϵͳĿ.HKUSTֵָӲʵʱĽṹʵ.
6.1HKUSTָϵͳ
ͼ2ΪۿƼѧӹϵʵҽHKUSTɻе֣ÿָһɶMotoman K3Sҵ.ʵʹʱɽָĲֹؽʹָĻɶ.ָָⲿֿӦʵҪ.ÿָװ̺6ά/شڸָ֪ÿؽڵľȷλúָץȡ.


ͼ2HKUST˶ָ
ϵͳϲMotorola˾MVME166Ƭɣֱ˶滮ץȡŻDSP ɱ̿PMACŷƣAVME9135 A/DźŴĽӿ.һ̨SUN SPARC-10վ̫ͨʹӣӦóĿû.һϵжִеĳɣVxWorksΪHKUSTָֿϵͳĲϵͳںwindṩ˻Ķִл㷨.
6.2ʵ
ȲԲָһС򣬳ʼץȡһץȡ.ݶŻ㷨ѡץȡָ꺯, ʹڱ, ͬʱﵽŵץȡ̬˶Ϊz᷽ƽ˶ѡ˳ӦϵKci=0.02ԪΪ0Э˶滮ѡ=0.1ʵͼ3,45ʾ.Ȼץȡָ̬ٶץȡ̬ץȡ̬õŻָץȡҲŻ.


ͼ3ָʱӴı仯


ͼ4ָץȡı仯


ͼ5ʵʱõָץȡ
βԲָһ壬ʼӴΪ0,170,80,0,00,-50,180,0,0ͣ0,20,180,0,0Ҳץȡ.ѡץȡָ꺯Ӧ˳Ӧϵ˶˶ͬʵͼ67.ȻõʵָץȡĽһ.


ͼ6ָӴ仯


ͼ7ָָץȡ
ץȡ价ӴãôҪָֿϵͳܿĴС.װձ.ͨѡʵָ˳Ӧϵ HKUSTָϵͳɴ.
7ᡡ
Ϊ˶ָһݽ׿ϵͳṹ.˶ٶȣЭ˶ģʵָٶȣ˶ͬʱŻץȡָ꣬ͬʱץȡ滮ģݵǰץȡ̬ŵץȡԱֽӴԼץȡƽ.ͨHKUSTֲָʵÿϵͳṹЧɸ.
1) Ȼѧ(69775021)شĿ(59990470)ʿר(96048727)ۿƼѧ685/95EĿ.
߼飺ǿ1998ڻѧеѧԺùѧʿѧλϺͨѧʿо.19961997ۿƼѧко.Ҫо򣺻˶ָץȡ˶滮̺߱ʵʱ.
סѧڣпԺԺʿ.ҪоȽ켼˹滮߱.
桡ʿۿƼѧӹϵԶоΣ.Ҫо򣺻ץȡϵѧѰλ.
ߵλ־ǿסѧеѧԺ人430074
桡ۿƼѧӹϵ
ο
1Mason M T, Salisbury J K. Robot Hands and the Mechanics of Manipulation.Cambridge Mass:MIT Press, 1985.78-87
2Shimoga K B. Robot grasp synthesis algorithms: a survey. Int J. on Robot. Res., 1996,15(3): 230-266.
3Montana D J. The kinematics of multifingered manipulation. IEEE Tran. on Robot. and Automat., 1995, 11 (4):491-503.
4Kerr J, Roth B. Analysis of multifingered hands.Int J. on Robot. Res.,1986,4(4):3-17
5Buss M, Hashimoto H, Moore J. Dexterous hand grasping force optimization. IEEE Tran. on Robot. and Automat., 1996,12(3):406-418
6Bonitz R, Hsia T. Internal forcebased impedance control for cooperating manipulators. IEEE Tran. on Robot. and Automat., 1996, 12(1):78-89
7Deo A, Walker I. Dynamics and control of multiple cooperating manipulators with rolling contacts.J. of Robotic Systems, 1996,13(10):619-648
8Hu Y R, Goldenberg A A, Zhou C. Motion and force control of coordinated robots during constrained motion tasks. Int J. on Robot. Res., 1995,14(4):351-365
9Li Z, Hsu P, Sastry S. Grasping and coordinated manipulation by a multifingered robot hand. Int J. on Robot. Res., 1989, 8(4):33-50
10Murray R M, Li Z, Sastry S S. A Mathematical Introduction to Robotic Manipulation.Boca Raton:CRC Press, 1994.211256
ոڣ1997-10-28
޸ڣ1999-04-02
