  ѧ 
JOURNAL OF ASTRONAUTICS
19984  19  2ڿƼڿ


Ǳ۸ԵĿռ
涯ѧо
 ϣ ̺׸
(ҵѧо**150001)
ժ  Ҫ   ڿǱ۸Ե£չʽƵռ
˲۵Ķѧ̡õķģͣſ۵Ļ
ϣTreanorϴзо䶯ѧĽⷨ񶯵Ч
⣬ƽ۸˿ռ˲Ϊ涯ѧ
ܺá

  涯ѧ  Ա  

SIMULATION STUDY ON INVERSE DYNAMICS OF
THE SPACE ROBOT WITH FLEXIBLE LINKS
Wang Shuguo Ding Xilun Cai Hegao
(Robot Research Institute of Harbin Institute of Technology
*Harbin*150001)
Abstract  In this paper,the dynamic model of the space robot arm is obtained by the 
formula of Lagrange,under the condition of the links with flexibility.On the base of the 
optimal theory,the problems of inverse dynamics and the vibration control of the arm 
are studied using the methods of Treanor and Shooting on the nonlinear model given 
above.And then the inverse dynamic method is simulated with a two-link planar 
flexible robot arm as an example,the simulation results convinced the method is very 
good.

Key words  Inverse dynamics  Flexible arm  Simulation
1  

ڽռվץȡǵĻһֱ۳ش
ص㣬ˣǱ۸ԵĿռ˶ѧоǷǳ
ҪģѾоߵעĿۣݣۣݡڿ
ԵĿռ˲۵Ķѧģ͵ķԺǿԣʹ涯ѧ
Ƚϸӣ񶯵ĿҲȽѡ涯
ѧоУDong-SookwonWayne J.Book(1990)3һ
ѧƵķܶѧϵͳΪֺͷ֣
һĩ˹켣ء򵥣ڷƾкܺõ
Ч÷ϵͳ͵Ա۵F.XiR.G.Fenton(1993)
ۣһ˳ֵķԱ˶ѧ̣ͨ
ѧʽ۸˱εͬʱصõ˹ؽڵ˶Ѽ
õĹؽ˶ͱ۸˱δ붯ѧ̵óĹؽأ
ʹ涯ѧõķԭϺͼ㷽
ֱ˵ýڹؽ˶нϴòӦҸ÷
ļٶȺԶ̫롣

ſ۵ĻϣTreanorϴз
Ա۵涯ѧ⣬õ˴Ա۵ء
ķǿЧãõЧ
۵񶯡

    
2  ԵĿռ˲۶ѧģ͵Ľ

ȣǼռ˲ΪϸˣߴԶС
ȣʿɺԼбκתЧӦֻԱεӰ졣˶
Уȡ۸Ϊl飬

ѡȡؽڹȣ͸Ա۸˵ģ̬iji1,2
1,2.ΪϵͳĹ꣬շ̽ƵһʽΪ

(2.1)

ʽTVRֱΪϵͳĶܡܺRayleighɢѣΪճ
⣬ӦĹiΪϵͳĹ꣬

ӵƵõķģһԱʾΪʽ


2.2
УMΪԳʱ
FΪ͵ȵģ󣬦ӣΪ


3  涯ѧⷨ
3.1  涯ѧģƵ

    

ʽ(2.1)ã
xӣt3.1
У


оĿռˣһҪƹؽئӣt
tʣۣ0tݣ㣺

a.˶ʱȣ棩ȣ棬ȣΪĹؽתǡ

b.˶ʱ񶯡λΪ㣬pt棩0t棩0

.˶ʱתΪ㣬t棩0

.Ϊӣݣ棩0ˣҪt棩0t棩0

ӦſۣȡϵͳָΪ

ǺF(s)һ㡣Ϊxt棬sF(s)һs
΢ӶNewton-Raphsonȷһֵs0
ʽ(3.7)е㡣
󣨣飫󣨣飩ģƣ󣨣飩ƣ󣨣飩

3.7)
УFΪF棬DFΪFsĵ

ʵֲ£

(1)Treanor㷽(3.5)

(2)(1)Ľ(3.3)*

(3ʽ(3.6)F󣨣飩ֵ֮

(4)жϣFsi<ǷΪҪ󾫶йصС
xtͦ*˶ʽ
(3.7)󣨣飫ز(1)

Ϊ˱֤ʽ(3.5)ʱֵȶȡʱȨ0at
0Bt>0,>0
    
4  о

ƽ˿ռԱΪз(ȡĩ˴м
ıʽΪģ̬Աȡģ̬)ͼ1ʾĶ
ѧģͲμףۣݡ

֪ĩͣ500.00kgԸ˵λѣ0.5kg
նEI200.0*ؽתJ죽1.0kgʣ0.2kg
۸˳ȣ122.0£ȨԽͣĶ
ԪΪ0.00.00500.0壵.400.0壵.0.00.0
2.0売.0売.ݣԣ20売.20売.ݣԡϵͳ
ʼֵΪ000000.0020.0100ݣԣ0
00002.01.01.01.0ݣԣоͼ2ͼ6ʾ


ͼ1 ƽԱϵͳ

ͼ2 ۸2ĩ񶯵Ӧ

ͼ3 ۸1תӦ

ͼ4 ۸2תӦ



ͼ5 ؽ1ʩӵ

ͼ6 õĹؽ2ϵ
5  

ص̽˻۵Ա涯ѧЧⷨͨ
۷;ķоǿԵó½ۣ
(1)ķЧռԱ۵涯ѧ⡣
(2)õЧԱ۵ĩ񶯡
(3)㷨ٶȽϿ죬ҪﵽʵʱĿĻܡô˷Ԥ
߼õԱŵأʵʿʱο⣬÷
ԶԳֵϴӦNewtonоֲԣ
ͨҲԿǲøĽNewtonNewtonȡ
(4)ķԸ˻˲涯ѧ
Ҳͬá


ο
1  Farshad Khorrami,Shihua Zheng.Vibration Control of Flexible-link Manipulators.
Proc.American Control Conf.,1990:175-180
2  W.Yim.End-Point Trajectory Control,Stabilization and Zero Dynamics of a Three-
Link Flexible Manjpulator.Proc.of IEEE Conf.on Robotics and Automation,1993:468-473
3  Dong Soo Kwon and Wayne.J.Book.An Inverse Dynamic Method Yielding Flexible 
Manipulator State Trajectories.Proc.American Control Conf.,1990:186-193
4  F.Xi,R.G.Fenton.A Sequential Integration Method for Inverse Dynamic Analysis of 
Flexible Link Manipulators.Proc of IEEE Conf.on Robotics and Automation,1993:743-748.
5  ϣ.ռԱ۶ѧƵо.ҵѧʿѧλ
ģ1996
