Զѧ
ACTA AUTOMATICA SINICA
1998 24 1  Vol.24  No.1 1998



ɷпռϵͳЭ˶
롡ΰ
ժҪͻеɵĿռϵͳЭ⣬һµЭƲ.òü򵥵ıṹԿ˶ƻеۿԱֶ֤˾ȷ˶켣.ӦøòԷֱֶ˶˶ӦĿƽռϵͳ˷棬֤ʵ˿ƲԵЧ.
ؼʡռˣЭ˶ƣ˶ƣṹ.
COORDINATED MOTION CONTROL OF FREE-
FLYING SPACE ROBOT SYSTEM
MA BAOLIHUO WEI
(The Seventh Research Division, Beijing University of Aeronautics and Astronautics, Beijing100083)
AbstractThe coordinated motion control of manipulator/spacecraft system is investigated in this paper. A new coordinated control scheme is proposed, in which the motion of the spacecraft is controlled using a simple variable structure control scheme and the manipulator is controlled to track the desired end-effector trajectory. The proposed scheme is applied to the controller design of free-motion and constrained motion of the manipulators end-effector. A two-link planar space robot system is simulated to verify the effectiveness of the control scheme.
Key wordsSpace robot, coordinated motion control, constrained motion control, variable structure control.
1
ͻеɵɷпռϵͳ(free-flying space robot system),屾λú̬ϵͳ˽ͨ˶Ϳʹеֶ̬ⷽ˶.ȻЯĿȼޣۼߣ˶岻ӿƵɸռϵͳ(free-floating space robot system)˴о12.ȻɸռϵͳɲĿȼϣ乤ռȴΪޣһ㹤Ҫ.⣬еֶ뻷Ӵʱ粻ʩӿƣϵͳڻ£ܿﵽ㲢뻷Ӵ޷ɸ.бҪͻе۵ĿƽЭֶ˹ͬʱʡȼ.
Spoffordһ˶ѧлЭƷ4ݣ˼ǵе۹йصָ꺯(е۵ָ)ĳһֵʱͻе۾ʩӿƣָСڸ÷ֵʱʩӿƣԽʡȼ.÷ȱûпϵͳĶѧϵͳָѡҲһ.
EgelandSagliһֶѧЭƲԣ3ݣòȸֶ켣滮˶켣Ȼֶλú̬ΪչϵͳĶѧչʾӦüط˶ѧ̽ΪϵͳȻֶ˵˶òͬλõļ㣬ʹֶ˵˶ܿٸֶ˶켣˶Եظ˶켣.ȿʹе۱ѹ͸ֿʹĿȼĽ.ȻƲȱ㣺(1)չϵͳѧ̵άϸ(λ˺ֶά֮). (2)ȼԽ϶࣬ΪʹĸΪ㣬ҪϵͳоȷԻһȼ.
Ϊ˷ȱ㣬һµЭƲԣ˼ɸ£
(1) ֶ켣滮˶켣ʹеܱѹ.
(2) ˶ƿԶϵͳе۶ΪŶ.ü򵥵ķɢṹƲԿ˶ԴԸ˶켣.Ϊ˽ʡڱ߽ڻ߽˶ʱʩӿ.
Ȼ˼ƵĿϺõĿ˷ģ3пƲԵȱ.ǽֶ˶˶ֱλúλ/Ͽƽռϵͳķ.
2˶
ڿɷпռϵͳ뻷Ӵʱ˶.ϵͳ˶ѧͶѧȻֱͻе۵Ŀ.
1) ˶ѧͶѧ
q=qT0, qTrT, q0=q01,q02,,qomTRmΪλú̬qr=qr1,qr2,,qrnTRnΪе۵Ĺؽڽ. x=x1,x2,,xnTRnΪֶ=ۦT0,TrT, 0=ۦ01, 020mTRmΪϵĿأ r=ۦr1, r2,,rnTRnΪе۵Ĺؽڿ.ٶռϵͳܵԺԲƣϵͳĶѧ̿дΪ
(2.1)
ʽ M(q)R(n+m)(n+m)ΪϵͳĹԾΪ͸.
ֶxRnΪqķԺ伸ιϵΪ
x=f(q).(2.2)
ʽ΢
(2.3)
(2.4)
ʽJΪϵͳſɱ.
2) 
ٶֶ˵˶켣Ϊxd(t)е۵˶Ϊqmg.Ϊʹе۱ѹͣ˶켣qd0=qd01,qd02,,qd0mTf(qd0, qmg)=xd.
е۶ؿŶƱṹ
(2.5)
ʽ
ԿĿҿЧؽʡĿȼ.
3) еۿ
ȷе۹ؽڿئrʹֶλx(t)˶켣xd(t).
(2.1)ʽɽΪ
(2.6)
(2.6)(2.4)ʽɵ
(2.7)
Ir, I0IrֱΪmmnnλ.
Nr棬(2.7)ʽõе۵ĿΪ
(2.8)
ʽоΪԳ.
(2.8)ʽ(2.7)ʽɵ
(2.9)
ʵѡKdxKpxʹõtʱ
3λ/Ͽ
1) ˶
УٶԼΪԹ⻬䷽֪⻹ٶеֶԼĽӴΪӴ.ϼ֪еֶܵԼԼķ߷.
˶ѧϵΪ(2.2)(2.4)ʽ.ֶ˵˶ԼΪ
c1(x)=0,(3.1)
(3.2)
(3.3)
ʽc1(x)=0ΪԼķ̣
޿ռϵͳĶѧ̿дΪ
(3.4)
ʽfcΪʴϵ()леֶԼ.
(3.4)ʽɽΪ
(3.5)
(3.5)(2.4)õ
(3.6)
ʴӿռٶ
(3.7)
ʽ Jc=AT(x), BT(x), T, B(x)A(x) . (3.7)֪Jc˴ֶϵʴϵ任. cf=AΪԼ淨߷ٶΪԼ߷ٶ.
΢(3.7)
(3.8)
(3.6)(3.8)(3.7)ɵõ
(3.9)
Լ(3.2)(3.7)֪ (3.9)ʽдΪ
(3.10)
ʽ
2) λ/Ͽ
Ŀɦv(2.5)ʽNr죬(3.10)ƻе۹ؽڿɦrΪ
(3.11)
ucpucfΪµĿƱ.
(3.11)(3.10)Jc=AT, BTTɵõ
0=AJM-1JTAT(-ucf+fc),(3.12)
(3.13)
AJΪAJM-1JTATΪԳ(3.12)ɵõ
fc=ucf,(3.14)
(3.14)(3.13)֪
(3.15)
ǾͿƸŷucfucpʹfcxcpĹ켣fdcxdcpucfucpΪ
(3.16)
ucf=frc,(3.17)
frcϵͳ.
(3.18)
ʽ ecp=xdcp-xcp; Kcpd, Kcpp, Kfd, KfpΪԳ.ȻʵѡKcpd, Kcpp, Kfp, KfdԱ֤tʱ 
4о
ɵƽռϵͳǷֱֶ˶˶ַ棬ƪޣڴֻ˶µķ.
û˵ļβԲ£
b0=3m, b1=3m, b2=3m, a1=3m, a2=3m, 
a3=3m, m0=30kg, m1=10kg, m2=10kg, m3=10kg.
ֶ˹켣Ϊ xd1(t)=3.0+0.5t+sin(t), (m), xd2(t)=2.0+0.5t+cos(t) (m).
е۵ѹΪ 
˶켣Ϊ
qdv1(t)=0.5t+sin(t)(m), qdv2(t)=0.5t-1+cos(t)(m), qdv3(t)=0(rad).
˼ؽڽǵĳʼֵΪ

ͼ1-3ʾ.Կֶ˵ĸ㣬е۵ĹؽڽҲѹθ.⣬ΪڱȽϣӦģ3еĿƷ˷棬ַĵȼϽ˱Ƚϣͼ4ʾ.ȻñĿƷĵȼϽ.


ͼ1ֶ켣ʵʹ켣(x1)


ͼ2ֶ켣ʵʹ켣(x2)


ͼ3е۹ؽڽǱ仯켣


ͼ4ȼıȽ
5
ķֱɷпռϵͳֶ˶˶ʱͻе۵ЭƲԣòԼԱ֤еֶɸ񣬲ʹе۹ѹ͸ͬʱԽʡĿ.ƽռϵͳ˷о֤ʵЭƲԵЧ.
1)ȻѧĿ.
߼飺롡19651984ҵҵѧӹϵ1990ҵѧԶרҵ˶ʿѧλ1995񱱾պѧӦרҵʿѧλΪպѧʿҪоΪ˶ѧ.
ΰ19943.
ߵλպѧС100083
ο
1ݡVafa, Dubowsky. On the nature of control algorithms for free-floating space manipulator. IEEE Trans. on Robotics and Automat, 1991, 7(6):750-758.
2ݡYoshihiko Nakamura, Mukherjee. Bi-directional approch for nonholonoimc path planning of space robots. In: Proc. Fifth International Symposium of Robotics Research, 405-416.
3ݡOlav Egeland, Jan Richard Sigli. Kinematics and control of a space manipulator using the macro-micro manipulator concept. In:proc. IEEE Int. Conf. Robotics Automation, 1990, 3,3096-3100.
4ݡSpoford J R, Akin D L. Redundancy Control of free-flying telerobot. In:Proc. AIAA Guidance, Navigation and Control Conf., 1990, 347-357.
ոڡ1996-01-03
