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



ƯԿռе۶ѧ
*
ڡ̷
ժҪƯԿռеϵͳѧϵͳԼ̼ѧƷ̡PontryaginֵԭѰСؼƵ񶯵ĿƹɡֵģЧԡ
ʡռеۡ嶯ѧPontryaginֵԭ
ON THE DYNAMICSVIBRATION 
AND CONTROL OF SPACE MANIPULATOR
Gu Xiaoqin Tan Zhaoyang
(Mechanical Department of Hebei Normal University.Shi Jiazhuang.050031)
AbstractThe dynamics of free-floating space manipulators is discussed,and equations of the non-holonomic constrain and the dynamics are formulated.The control method of mini-torque and depressing elastic vibration is derived with pontryagin's principle.The results of the simulation of this algorithm is presented.
Key wordsSpace manipulator Multibody dynamics Pontryagin's principle
1
빤ҵеȣװںϵĻе۹Χ㣬ڻе۹ϸˣʽṹڶѧƹɵӦԿǡƯΪصĿռеǵ͵ɶϵͳе۵˶λ˵ı仯е۸λƺ͵񶯵໥ϣԼе˶Ķѧϣʹÿռеϵͳ˶ѧѧоʮѡ
ģ1˿ռе۶ѧ·滮⣬صоеۡΧ˶УΪһνƼ㣬ԽṹԱΡYoshikawaȣ2ݶԵԴе/Сеϵͳλ/Ƽֵģʵ֤ԱζԸλӰķ3ݣĽһѰСؼƵ񶯵Ŀƹɣͨ˵
2ϵͳѧ
ϵͳƯĸB1Իе۹Bi(i=2,,n-1)ԼгָԸصץBnɣԵɶ0i(i=2,,n)ṹɶϵͳתΪi(i=1,,n)ȡϵͳ0cΪԭ㽨ϵe0,ri(x)Ϊ΢Ԫdx0cʸת0iΪԭ㣬ظߵΪei1ֲϵei(i=1,,n)ӵԹΪ1iEuler-BernoulliڹƽɺΣei2Ϊui(x,t)xΪõei1ꡣģ̬s(k)i(t)ģ̬(k)i(x)(k=1,,n)ʹԱɢui=Tisi,Цi=ۦ(1)i(x),,(ni)i(x)Tsi=s(1)i,,s(ni)i(t)TBiBi-1ĸϵתǦsiɽµĸתǦi͵ԱתǦi-1(t)=i-1(1i-1)si-1(t)ɡei1e01ļнǼi(i=1,,n)ܶdi(x)ei=e1i,,eniT=diag(s1,,sn)ͨ·ʸ4չͨе۸˱ǰһP涨ijʱ(x)=diji=jʱ(x)=xԷĴbji(x)ΪbjiϵͳĵĶɵ
(1)


΢ݶȣϵͳĵΪ0ʽ(1)ռеϵͳغ㷽̣ʼ״̬Ϊ0=(1,,n)T,s=(sT1,sT2,,sTn)T,õƯϵͳԼ̣
(2)
IȡIsʽ߳ƪԡ

ͼ1Կռеϵͳ
JourdainԭƯ׵Կռеϵͳѧ̣4ݣõʽѧƷ̣
(3)
=(0,2,,n)T,빹ģ̬йصG󡢹MDնȾKϸԡʽ(3)ܷԼ(2)ƶԿռеϵͳλx1c,y1c,ȣsݡ(2)ʽɻIȡIsΪ(t)s(t)ĺԲе۵ĸԴΧ˶λ˳ã弰е۵ĸ˶Ҳ빹Ա໥ϣʵԿռеϵͳ涯ѧԶȹ̶ҵе۸ӡ
3Ż
˫ƯԿռеϵͳǵʱʮֹ⻬ṹֻеͽģ̬𣬱ڼ±һģ̬s2s3Զ׼ģ̬ǣ(3)ʽд״̬̣
(4)


ΪСؼƽṹĵ񶯣ȡָJ
(5)
Qi(i=1,2,3)ΪȨϵtfΪĩʱ̡y1y2İ12
4ƯռеϵͳHamilton

涨PontryaginֵԭõЭ̬̣
(6)
Լ߽
(7)
ɵõƷ̣
(8)
״̬(4)Э̬(6)Ǳ߽(7)ðئ(t)Ʒ(8)ɵõŻƹɡ
4
ȡ˫˿ռеϵͳβ£m1=9000kg,m2=m3=32kg,m4=936kg,J1=12000kg.m2,J4=500kg.m2ʸ˳12=13=8mĿնΪ524.1N.m2,i1=1.875/1i±۹ƵΪ0.1Hzһͺ(i)1(x)=3.0376(cos0.2344x-cosh0.2344x)-2.2296(sin0.2344x-sinh0.2344x)CiOiغ(i=1,4)Ҫϱ۴Ӧ20=200ת20=800100ɣȡõתǱ仯ͼ2ģ̬ͼ3ؿƹͼ4

ͼ2תǱ仯

ͼ3ģ̬

ͼ4ع
5
ռе۸λƺͱ۵񶯵໥ڶѧƹɵӦԿǡϵͳƯصʹûе˶ֶѧϡĵƯռеϵͳԼ̼ϵͳѧ̣Ż۵Ƶ񶯵Сءֵģ˷ЧԡĵĹΪѧƼһоۻ
*ӱʡȻѧĿ(598179)ӱʡʿлĿ
ߵλӱʦѧеϵ.ʯׯ.050031
ο
1Agrawal S K,et al.Free-floating closed-chain planar robots:kinematics and path planning.Nonlinear Dynamics,1996,9(1):119
2Yoshikawa T,et al.Hybrid position/Force Control of Flexible-Macro/Rigid-Micro Manipulator Systems.IEEE Trans.on Robotics and Automation,1996,12(4):633-640
3.Կռе۶ѧ.ռѧѧ199717(4)377381
4.̬ѧ.ҵ磬1995228293
ո:199788,޻:1998313
