ѧ
JOURNAL OF ASTRONAUTICS
1999 20 3 vol.20 No.3 1999



ȷռеϵͳ
Ӧ³Ͽ*
¡
ժҪλ̬ܿƵɸռеϵͳĿ⡣еغɲȷʱɸռе׷ٹԿռ켣Ӧ³ϿƷͨ㣬֤ʵ˷Чԡ
ʡɸռеϵͳϵͳѧӦ³Ͽ
THE SCHEME OF COMBINING ADAPTATION WITH 
ROBUSTNESS CONTROL FOR SPACE MANIPULATOR 
SYSTEM WITH UNCERTAIN PARAMETERS
Chen Li
(Department of Mechanical Engineering,Fuzhou University.Fuzhou.350002)
Liu Yanzhu
(Department of Engineering,Shanghai Jiao Tong University.Shaihai.200030)
AbstractIn this paper,the control of free-floating space manipulator is discussed.with the augmented state-feedback control model,The scheme of combining adaptation with robustness control is proposed for a free-floating space manipulator whose papameters is uncertainty to track the desired trajectory of workspace.It is demonstrated by the simulation that the control scheme is efficient.
Key wordsFree-floating space manipulator Multibody dynamics Combining adaptation with robustness control
1
켼ķչʹռе۵Ҫڿռ۵ɸλú̬ϵͳڻе۲ڼ䳣ڹر״̬е۵˶˶˿ռеϵͳĶѧͿԶϵ̶е۸ӣΪоȵ1267ݡڸԭʵʿռϵͳĲ(ȵ)ԾȷȷġĿϵͳЩʹֶȶʵֹԿռ켣ռе۵ɸλá̬ܿƣϵͳܵͶغĶѧԼֶ˲ռԽ¿ռJacobiǹԲԺ˵۵ĿƷֱӦڿռϵͳWalkerȣ4λ޿أ̬ܿ¿ռ۵Ӧ⡣Guȣ5ݶλú̬޿ΣֶʹѧеĹԲԹɡĸĽԻеغɲڲȷԵ׷ٹԿռ켣Ӧ³ϿƷLyapunovֱӷ֤˿ϵͳ㽥ȶƷЧԡ
2ѧ
ͼ(1)ʾƽ˶ɸ˿ռеϵͳΪϵͳѧ̿ö嶯ѧκһֽģRobersen-Wittenburg8ݣxc,ycYתǦ1Լ˵תǦ23ɹq


ͼ1ƽɸռеϵͳ
гʽϵͳѧ̣
(1)
D(q,)Ϊ55h(q,)Ϊ5󣬦=(23)TΪؽڽ¿ئ2,3ɵ2Ҷzh5,Dhڹϵ3ݣ
(2)
ԳƵD(q,)дֿʽ򷽳(1)ɷֽΪ
(3)
DbbDrrΪ3322ԳӾDbr=DTrbΪ32Ӿʽ˵һʽĻֱʾɸռеϵͳĶͶغϵ
3
еۿϵͳҪеץ̶ֹغʵعԿռԤ켣˶غԹԲοϵΪY=(xpyp)T,YɱʾΪqĺYqJacobiΪ
Ϊ֤ϵͳѧеĲʽ֣YqrʹqbYµX=qTbYTTɵٶٶ֮Ĺϵ
(4)
IΪ3׵λJr죬Ja棬ӷ(4)ɽ
(5)
XD=qTbYTDT,YDΪغɵ˶켣e1=YD-YΪʵʹ켣켣֮XXD֮eΪe=XD-X=0TeT1T
ʵeϵͳĲοٶ:
(6)
K1ΪѡĶԳֵ󡣽ʵʽٶοٶ֮
(7)
(5)(7)ʽeĶ壬õϵ
(8)
(6)ʽʱt󵼣õ

(9)
(7)ʽɽϵͳѧ(1)
(10)
4Ӧ³Ͽ
¿ƹɣ
(11)
СΪοģӦDhK2ΪѡĶԳֵK3sgn()Ϊ2K3ԪK3iΪϵ(11)ʽ˶Ϊʽ
(11)ʽȷĿشϵͳѧ(10)õ
(12)
WΪ,,ЦΡֱΪʵģDhοģзĴƲֵͿɵĲֵWΪqĲƲĺ
ʵʵĿռеϵͳУϵͳʱǶδ֪ģץȡغɵĲδ֪ģйػе۵ĲȫȷֻԾȷȷеزʵֵֵ֮ΧԤȹƣ
(13)
Ϊ㷨ʱعϵͳȫδֻ֪ҪʹⲿֲĲȷԾ³ԾͿˡӶ򻯿Ľṹʹ֮ʵʱơ
Ϊˣɽ(12)ʽеľWд
(14)
,,EֱΪеزʵֵֵRֱΪغزĴֵɵֵ(13)ʽõ
(15)
1ƹ(11)Ͳڹ
(16)
֤
֤e=0=0Ϊ˶(8)(12)(16)ʽΪ˶̣ѡΪ׼LyapunovV
(17)
Vͨѧ̹ɵȫ,÷(8)(12)(16)͹ϵʽ(2)õ

K=diag(IK2)ʽǰΪe,ĶͣJaн磬򵱲ѡ㹻ʱɱ֤ǵĺС㣬ʽһд
(18)
罫K31K32ѡΪ
(19)
Ц12ΪWEijΪWEԪأУ
(20)
֪㹻Ұ(19)ʽѡȡK31K32ʱǸģLyapunov˶e=0,=0Ϊȶģ(8)ʽ֤ϡ
5
Ŀռеϵͳͼ(1)ʾռеֶڹԿռ켣ΪԲxD=4.2-0.6.cos(1.5t)yD=4.0+0.6.sin(1.5t)Ŀƹ(11)(16)(19)ֵ档
ϵͳغɲδ֪е۵ĲΪȷȷϵͳĴƲΪ
E=(m1 m2 m3 m1R21 m2R22 m3R23 m2a2 m3a3),R=(mp Ip)
УᵽĿϵͳԦE³ԣԦRȡڡ
ռеϵͳʵʲֵΪE=(402.02.034.176.06.03.03.0)R=(3.01.5)ʱEĹֵΪ=(38.01.51.530.05.05.02.02.0)֪ʵֵֵΧΪc1=3.0,c2=1.0c3=1.0,c4=5.0,c5=2.0c6=2.0,c7=2.0,c8=2.0R=(mpIp)δ֪(16)ʽĵڹɣٶRиĳʼֵΪ1ͼ(2)Ϊƹɵõֶʵʹ켣켣ıȽϡͼ(3)Ϊ̬Ǽе۹ؽڽǱ仯ߡͼ(4)ΪRĵڹɡ

ͼ2ֶʵʹ켣켣

ͼ3̬Ǻͻе۹ؽڽǱ仯

ͼ4mp,IpӦ
֤ˣӦ³ϿƹɵЧԡ
*ȻѧĿ(19872032)ջѡĿ
ߵλ¡ݴѧеϵ..350002
Ϻͨѧѧϵ.Ϻ.200030
ο
1Papadopoulos E G,Dubwsky S.On the Nature of Control Algorithms for Free-Floating Space Manipulators.IEEE Transactions on Robotics and Automation,1991,7(6):750-758
2Vava Z,Dubowsky S.On the Dynamics of Space Manipulators Using the Virtual Manipulator,with Applications to Path Planning.Journal of the Astronautical Science,1990,38(4):441-472
3Slotin J E,Li W P.On the Adaptive Control of Robot Manipulators.Journal of the Robotics Reserach,1987,6(3):49-59
4Michael W,Walker.Adaptive Control of Space-Based Robot Manipulators.IEEE Transactions on Robotics and Automation,1992,7(6):828-835
5Gu Y L,Xu Y S.A Normal Form Augmentation Approach to Adaptive Control of Space Robot Systems.Journal of the Dynamics and Control,1995,5:275-294
6.ռе涯ѧLyapunov.ѧѧ199628(6)
7.ɸռеϵͳ˶滮ſƷ.ȫ߽ռ估˶Ƽѧļ199647-51
8.ϵͳѧ.ߵȽ磬1989
ո:1997818,޻:1998730
