Զѧ
ACTA AUTOMATICA SINICA
1997 23 5 Vol.23 No.5 1997



һֶе(ָ)ӦЭ
ĵ㷨1)
ĺꡡϯԣ׿
ժҪһֶе(ָ)ӦЭƵ㷨.ԭϵͳĿתΪϵͳĿ.ϵͳ֮Ķ̬Lyapunov±ʾΪڸֽ㴦ġ鹦.еָĵӴ⴦ɱؽڵĿ.ԭϵͳĽȶLyapunovϵõ֤.ַ֤۽.
ؼʡ˿ƣӦƣLyapunovȶ.
A RECURSIVE ALGORITHM FOR ADAPTIVE CONTROL OF
COORDINATED MULTIPLE MANIPULATORS/FINGERS
ZHU WENHONGXI YUGENG
(Department of Automation,Shanghai Jiaotong University,Shanghai 200030)
JIANG ZHUOJUN
(Ningbo Port Office,Ningbo,315200)
AbstractThis paper presents a recursive algorithm for adaptive control of coordinated multiple manipulators/fingers.The control problem of the complete system is converted into the control problem of each subsystem.In the sense of Lyapunov,the dynamic interactions between the subsystems are completely represented as virtual power flows(VPFs) at their cutting points.Finger tip is considered as a passive joint.Lyapunov asymptotic stability of the complete system is guaranteed.Computer simulation is conducted to verify the validity of the proposed approach.
Key wordsRobot control,adaptive control,multi-robot control,Lyapunov stability.
1
꣬еЭѳΪ˿Ʒһȵ19.еЭƲ˶ƣҰ.ף4LagrangianģͶԶеӦƣҪٶȲ⣬LagrangiunģĿʹʵʱƽΪ.ף5ݸ˻Newton-Euler̵ĿɣҪȷĻеֲ.
ָĿ㷨˷㷨ȱ.ȽԭϵͳĿתΪϵͳĿ⣬ϵͳ֮Ķ̬ʾΪʮּ򵥵ġ鹦ʽ.ͬʱԶָϵͳо.
2˶ѧ
ʧһԣٶm6ؽڻеָԵץסһ壬ϵͳв˶ѧ.ϵ£ϵO뱻ץϵSԭλڱץ뻷ĽӴϣԼķ߼ƽغϣϵCi,i=1,2,,mڵiеֵĩˣϵLij,Tij,j=1,2,,6ڵiеֵĵj˺͵j-1ϣǵzjؽڵغ.
ÿһϵһ6άٶȣx=ۦvT,(wTT=(RI.v)T(RI.w)TTʽvաR3wաR3ϵյ/ٶڹϵеıʾ.RIR33һת任һڹϵIбʾ31תϵбʾ.ÿһؽٶȿԱʾΪ

(1)
ʽдiеֵjؽڵĹؽٶȣڻؽzij=001000Tתؽڴ/ر任󣬦r¡R3һϵԭָϵԭ㲢ϵбʾ.cross.
ϵͳٶȶΪ

ʽ
еָץΪ

(2)
ʽJiR66iеִӹؽٶϵOٶȵJacobian.ץ뻷ĽӴʹ

(3)
ʽxR6-rٶȣrΪԼռά.ʽ(1)(3)X=.x,(4)
ʽ

ٶΪ
xr=xd+.,
(5)
ʽЦˣ0xdΪֵ.Ŵλ/λŵѡȡʽ

(6)
ʽr*0K(t)Ϊһ.
ڶͬһϵͦ£dx=UT.x.еĶ壬H0=sUT0.Tp,ʽTpR6(6-r)ΪϵS˶ӿռĻ6-rλ.ѡ
֤(6)ʽǳ.
(4)(5)ʽϵͳٶΪ
Xr=.xr.
(7)
3ϵͳѧ
ڹϵеĸ嶯ѧдɣ89

(8)
ʽpøԲy*ӦRegressor.MC(w)бԳGΪ.ER6ϳ/ضΪ

(9)
ʽ

ϵвʾĹ/.ΪһԽԽԪΪ1ʱӦ˶ӿռ䣬Ϊ0ʱӦԼӿռ.
iеֵjؽڿѧµĶѧͨʽд

(10)
ʽIijΪؽڵЧתfij(+)Ϊؽ᷽ϵŶ/Ħ/صȣijΪ/.ؽڣ(10)ʽΪ.
(8)ʽϳΪ

(11)
ʽСΪ.ӦΪ

(12)
ʽЦR(t)Ϊ.

Ϊ΢ֲӣaΪһ˲ʱ䳣.(9)ʽ/Ϊ
(13a)
(13b)
(13c)
ʽд.(10)ʽؽڵĿΪ

(14)
ʽΪ.
(10)(14)ʽչԴָץ.ʧһ.ٶָ뱻ץĽӴΪӴҲڻ.ָԴһάιؽڣ˶̱ʾΪ

(15)
ʽдñؽڵתٶ.ڸùؽ뱻ؽڣ(10)ʽͬ(14)ʽ

(16)
ʽKiR33Ϊ.(13a)(16)ʽ

(17)
ʽΪ֪.
(17)ʽȫӳָԼȷ˦r3mάӿռ.rʣ6(m-1)-3mάּȿΪĿģҲΪŻĿ.
4ȶԺ
ϵڵķֽ㴦鹦Ϊ

(18)
wٶڻϵв.
1.(8)(9)ʽıץ͸ˣڿ(11)(13)ʽ£ѡ·Ǹ麯

(19)


(20)
ʽСWTi1=Wci.
֤.
2.(10)ʽĹؽڿ(14)ʽ£ѡ·Ǹ麯

(21)


(22)
1.(15)ʽָԼ(16)ʽ£ѡǸ麯Vi=0,

(23)
(20)(23)ʽ˵ϵͳ֮Ķ̬ͨڸֽ㴦ġ鹦ȫӳ.ѡϵͳLyapunovΪϵͳǸ麯ܺ

(24)
Ӷ֤ԭϵͳȫֽȶԣ

(25)
Ϊеġ鹦еõ໥.
(8)(11)(10)(14)ʽ

(26)
ʽС

(Xr-X)T(Fr-F)=0,(4)(7)ʽЦT(Fr-F)=0.æT(26)ʽ

(27)
(27)ʽ(26)ʽ

(28)
ʽһ棬(9)(13)ʽ

(29)
ʽΪ

ͬʱ(9)(13a)ʽ

(30)
ʽдϵͳ.(28)(30)ʽ

(31)
.(1)(4)(8)(10)(15)ʽĶе(ָ)ץϵͳڿ(5)(7)(11)(14)(16)ʽ£ѡ(24)ʽLyapunovʱʵ(25)(31)ʽϵͳȫȶ.
5
Puma560еЭץﲢһΪһ׵άռеֱ߶Ƶ.ģ͵ĲͨʵPumaеֽвʶõ.ѡΪ5ms,a=5,=20.ǵԼϵһԣûаԼ.
ʾͼ1.ٶץδ֪mm.zأֵΪʼֵΪʾλ/λ㣬ͲҲõ˺ܺõ.




ͼ1
6
ĵĽΪЭе(ָ)ץϵͳġģ黯Ӧƺ͡ģ黯ȶԷṩ˿.ϳ/صļ㻹ǲӦɾԸϵͳֱؽ.ģ֮ٵͨѶ磺ͦFrΪмṩ˻.Լ򵥵ϵͳѧʹӦǸ麯ѡȡҲü.˿˵ڼ򻯿ƵͬʱҲϵͳȶԷ.
1)õȻѧ͹ҡ߿ƼĿ.
߼飺
ĺꡡ1963Ͼ.1984ҵҵѧԶϵ1987ڸϵ˶ʿѧλ1991ͨѧϢƹϵʿѧλ.ϺͨѧԶϵ²ʿо1993걻Ϊ.ĿǰڱʱKULeuvenʿо.о򣺶˿ƣ˶ѧӦƣ˵.
ϯԣ211.
׿19711993ҵϺͨѧԶϵ㽭ֹ.
ߵλĺꡡϯԣ(ϺͨѧԶϵϺ200030)
׿(֡㽭315200)
ο
1ݡLuh J Y S,Zheng Y F.Constrained relations between two coordinated industrial robots for motion control.Int.J.Robotics Research,,1987,6(3):6070.
2ݡUnseren M A.A rigid body model and decoupled control architecture for two manipulators holding a complex object.Robotics and Autonomous Systems,1992,10:115131.
3ݡYoshikawa T,Zheng X Z.Coordinated dynamic hybrid position/Force control for multiple robot manipulators handling one constrained object.Int.J.Robotics Research,1993,12(3):219230.
4ݡHu Y R,Goldenberg A A.An adaptive approach to motion and force control of multiple coordinated robots.ASME.J.Dynamic systems,Measurement,and control,1993,115(1):6069.
5ݡWalker M W,Kim D,Dionise J.Adaptive coordinated motion control of two manipulator arms,In:Proc.IEEE Int.Conf.Robotics Automation,1989,10841090.
6ݡUchiyama M,Dauchez P.A symmetric hybrid position/force control scheme for the coordination of two robots.In:Proc.IEEE Int.Conf.Robotics Automation,1988,350356.
7ݡWen J T,Delgado K K.Motion and force control of multiple robotic manipulators.Automatica,1992,28(4):729743.
8ݡZhu W H,Xi Y G,Zhang Z J.Virtual decomposition based coordinated control of multiple arms containing inner closed loops.In:Proc.First Asian Control Conference,Tokyo,1994,2:145148.
9ݡZhu W H,Xi Y G,Zhang Z J.Hierarchical adaptive control of multiple manipulators by using contact force measurements.In:Proc.of 31st IEEE CDC,1992,18641865.
10ݡZhu W H,Xi Y G,Zhang Z J,Bien Z,De Schutter J.Virtual decomposition based control for generalized high dimensional robotic systems with complicated structure.Accepted for publication in IEEE Trans.Robotics and Automation as a Regular Paper.
ոڡ1995-08-21
