о뷢չ
JOURNAL OF COMPUTER RESEARCH AND DEVELOPMENT
1999 36 9 Vol.36 No.9 1999



ɷпռ˵Ĺؽص㷨
ҡۡػ
ժҪڿռе΢ǱĲ̶еֺǱ֮˶ѧͶѧãԵļؽصNewton-Euler͵˵ĿƲԲֱӦɷпռ(FFSR)о.ȷFFSRٶȺͼٶȹϵڴ˻Ͻ˼FFSRеָ˵ٶȺͼٶȵĵƹʽλеԵNewton-Eulerѧ㷨FFSRĹؽصĵ㷨ü֤Ĺؽ㷨Ч.
ؼʡɷпռˣ ѧ 㷨 ؽأ 
ͼšTP39TP242.3
RECURSIVE ALGORITHM OF JOINT DRIVING TORQUE
AND ITS SIMULATION FOR FREE FLYING SPACE ROBOTS
LI Hua-Zhong, HONG Bing-Rong, and He Huai-Qing
Department of Computer Science & Engineering, Harbin Institute of Technology, Harbin 150001
AbstractBecause there are special micro-gravity environments in the space and the barycenter of the satellite main body isn't fixed, the Newton-Euler method to calculate the joint torque proposed by Luh's group and the conventional control strategy for the ground-fixed robots can't be directly applied to free-flying space robots(FFSR). First, the velocity and acceleration for FFSR are analyzed, and the recursive formula for calculating the velocity and acceleration of the links of FFSR are established. Then, based on the Newton-Euler dynamics method for the ground-fixed robots proposed by Luh et al, a recursive algorithm of joint driving torque for FFSR is developed. Finally, the computer simulation verifies the effectiveness of the proposed joint torque algorithm.
Key wordsfree flying space robots, dynamics, recursive algorithm, joint driving torque, computer simulation
1
δռԴĿУռ˽ԽԽص.ɷпռ(free flying space robot, FFSR)һ͵ͿռˣǱʹϵĻе.бɷбҵԱ¸ֲռҵΪռ˵Ҫо֮һ.
ڿռе΢Ǳδ̶е˶Ǳ˶֮໥ãFFSRȣص˶ѧͶѧԣΪоռ˵Ҫ֮һ.FFSR˶ѧƷдԵĹǣף1(VM)ĸFFSRϵͳ˶ѧ㣬ף2˻ڹſɱȾ(GJM)ķֽ˶ٶȿ(RMRC)Щûпǵ̬ƣе˶ǵ̬.ѧģLagrangeNewton-Euler(N-E)KaneЩоɹֻ΢ûпǱĸ˶FFSR.⣬ף3ݿ˻ڶغFFSR涯ѧЧ㷽ø÷ؽصȱҪɴٶȺͼٶ.ף4ݡ5Ҳطо.
˸ؽصЧ㷽ڶԻ˻еṹͿʱڽлصʵʱʱʮҪ.رأؿƵĽǶΪȷƵʵʱԡɿԺȶԣҪЧؼ㷨.Luhⷽ˴оԵĵN-E6ݣѧ̡ţٷ̺ŷΪ㣬ϻеֵٶȺͼٶȷóһЧĻеֶѧ㷨.÷ɹ̶ǰƣĩ˵ƣ˵ĽٶȡǼٶȺļٶȣĩ˵ĩؽһؽ()ƣӶؽڵأFFSRǱ岻̶÷ڿռˣLuhĵN-Eƹ㵽ռ˵ĹؼЧǱٶȺͼٶ.ΪлLuhԵN-EFFSR֮Ļ˶ѧͶѧϵΪ㣬еָ˵˶ֽ֣һǱ˶йأһǱ˶޹أɵ㷨ǿռϵͳе˶ԡغ㶨ɺƽⷨһڼFFSRؽصЧ㷨.Ϊ֤ؽ㷨Чԣ˼.
2FFSRģ
FFSRģͼ1ʾ.Ǳ̬z-y-xŷǦºͦãΪ0˵ϵDenavi-HartenbergԼ.ʹõķԼ£

ͼ1FFSRģ
I ̶ϵͳĵĹϵi ̶ڹؽiϵjRiR33Ϊϵijı任RiϵiIı任kiؽķ릲iϵz᷽һ£nеɶȣmi liiͳȣ mcFFSRmc=ni=0miIi iĵĹriiĵλʸaiӹؽi-1ָiĵλʸpiؽiλʸbiӹؽiָiλʸi˹ؽiأiiiؽiĽǶȡٶȺͽǼٶȣjijiϵjiĵٶȺͼٶȣjijiϵjйؽiٶȺͼٶȣjijiϵjiĽٶȺͽǼٶ;jfijniϵjiĵأʸri=rix,riz,riyTiµбԳƾ

FFSRеָٶȡٶȼؽйعʽ.
3FFSRٶȺͼٶȷ
ΪFFSRؽڵأҪȽFFSR˵ٶȺͼٶȷ.
3.1FFSRٶȷ
FFSRٶȷָݸĻейؽڵĽǶȺͽٶFFSRĸ˵ٶȺͽٶ.Ӧø˶ѧͼ1֮˶ѧϵ˵ĽٶȡؽٶȺٶȿɱʾµʽǽٶȺٶϵɱʾɣ
ii=iRi-1(iki+i-1i-1)
(1)
ii=iii-1li+iRi-1i-1i-1
(2)
ii=iiibi+ii
(3)
ǽٶȺٶϵ0ɱʾɣ
00=RT00
(4)
0=RT0(00p0)
(5)
ʽ(1)ʽ(4)˽ٶiiֽ֣һǵĽٶȦ0йأһǵĽٶȦ0޹ضõ㷨ãùɿԵõ¼FFSR˽ٶȵļ򵥵ʽ
ii=ii+RTi0
(6)
iiĵƹϵ
000ii=iRi-1(iki+i-1i-1)
(7)
ƣʽ(2)ɽ˹ؽٶiiֽ֣һǵĽٶȦ0ٶȦ0йأһֿõ㷨ãiiɼ򻯳ĵʽ
ii=ii+RTi(00p0)
(8)

00=0ii=iii-1liiRi-1i-1i-1
(9)
ͬãʽ(3)ٶiiɱʾ¼򵥵ʽ
ii=ii+RTi(00vi)
(10)

ii=iiibi+ii
(11)
ϵٶȺͽٶȷֻ֪ҪǱٶȺͽٶȣõƷFFSRеָ˵ٶȺͽٶ.
3.2FFSRļٶȷ
FFSRļٶȷָݸĻейؽڵĽǶȡٶȺͽǼٶFFSRĸ˵ĽǼٶȺͼٶ.ٶʽ(1)(2)(3)󵼣תϵiͦi+1ĵϵʽɵø˵ĽǼٶȡؽڼٶȺļٶȵĵƹϵʽ
ii=iRi-1(iki+i-1i-1iki+i-1i-1)
(12)
ii=iii-1li+iiiii-1li+iRi-1i-1i-1
(13)
ii=iiibi+iiiiibi+ii
(14)
ǱļٶȺͽǼٶڹϵIʾΪ0ͦ0Ƶأɽ˵ĽǼٶȷֽ֣һǱĽǼٶȦ0йأһǱĽǼٶ޹ضõ㷨ãʽ(12)ɵø˽Ǽٶȵĵʽ
ii=ii=ii+RTi0
(15)

00=0ii=iRi-1(iki+i+1i-1iki+i-1i-1)
(16)
ͬأʽ(13)ɵø˹ؽڵļٶȵĵʽ
ii=ii=ii+RTi(00pi)
(17)


(18)
Ӧעǣϵ0۲쵽ǱļٶȵڴӹϵI۲쵽ǱٶϼٶȺļٶȵʸ.
ʽ(14)ɵøĵļٶȵʽ
ici=ii=ici+RTi(00ri)
(19)


(20)
ϵĽǼٶȺͼٶȷֻ֪ҪǱĽǼٶȺͼٶȣõƷFFSRеָ˵ĽǼٶȡؽڵļٶȺĵļٶ.
4FFSRؽؼ㹫ʽ
ţٶɺŷǶ̿ɻiϵأ
ifi=miici,ini=iIiii+iiiIiii
(21)
ʽ(15)(17)(19)ʽ(21)ɵã
ifi=ii+miRTi(00ri),ini=ii+IiRTi0
(22)

ii=miici,ii=Iiii+iiIiii
(23)
N-EĦӰʱڸϵĹؽؿã
f,i=iRi+1f,i+1+ifi
(24)
n,i=iRi+1n,i+1+i-1liiRi+1f,i+1+(i-1li+ibi)ifi+ini
(25)
i=n,iiRi-1ki
(26)
ϸ˵ٶȡٶȺؼ㹫ʽһǱٶȡٶȡٶȺͽǼٶȣɻFFSRؽڵأ˽LuhĵN-E6ƹ㵽ռ˵ĹؼЧǱٶȺͼٶ.FFSRڲ£ϵͳ㶯ͽǶغ㶨ɣٶʼͽǶΪɵã
mii=0,(IiiimiiriIi)=0
(27)
ƽԭɵã
Ifi=0,(Ini+riIfi)=0
(28)
˵ٶȺͽٶȵʽ(27)ʽɼǱٶȦ0ٶȦ0
0=M11Lԣ0M12L
(29)

M1diag(mc,mc,mc),M2=(RiIiRTi-miTii)
(30)
L=-Rimiii,L=-RiIiii+ri(Rimii*i)
(31)
õǱٶȺͽٶȣʽ(6)(7)(8)ɻFFSRĸ˵ٶȺͽٶ.
ʽ(22)ʽ(28)ǱļٶȦ0ͽǼٶȦ0
0=M11F0M12F
(32)
оM1M2ʽ(30)ͬ
FRiiiF=-Riii+riRiii
(33)
N-EɽFFSRĹؽص㷨ʾ֣(1) ٶȡٶȺ͹ǰƣ(2) Լ͹ؽغ.㷨㲽£
1. ԤȸFFSR˼κ,˳limiIiͱֵFFSRеָؽڵĦiii(i=1,,n);߼mc=miֵ
2. ȷеָ֮ı任R00R1i-1Rin-1RnùʽjRi=jRj+1j+1Rj+2i-1RiRi
3. ʽ(7)(9)(11)iiiiii
4. ʽ(30)(31)M1M2LԺLأ
5. ʽ(29)ǱٶȦ0ͽٶȦ0
6. ʽ(6)(8)(10)еָ˽ٶiiٶiiٶii
7. ʽ(16)(18)(20)мֵiiiiici
8. ʽ(33)FFã
9. ʽ(32)ǱļٶȦ0ͽǼٶȦ0
10. ʽ(15)(17)(19)˽Ǽٶiiٶiiļٶici
11. ʽ(22)(23)ڸϵifiini
12. ʽ(24)(26)ؽڵئi.
5
Ϊ֤FFSRص㷨Чԣʧһ,DOFFFSRɲ׽ռĿSGI/OS2վƽ̨Ͻ˼.IRIS PerformerӻԿ.ĻΪFFSRνģʵģ˶ѧģص㷨ʵʱ.˶ѧûGJMRMRCģ.12FFSRģ͵D-H˶ѧȶѧ.FFSRĿ겶׽ʱйط£ͼ2FFSR׽Ŀάͼη.ͼ3Ǳ̬Ǻλñ仯ʱ̣ͼ4Ǹؽڽǵʱ̣ͼ5Ǹ㷨õĸؽ.㷨ļΪO(n),Ҳؽɶ.
1FFSRģ͵D-H˶ѧ
ؽi123456
ŤǦi-1(rad)0-/20-/2/2-/2
˳li-1(m)0.31.22.00.80.250.2
ƫdi(m)0.000.3-0.30.00.0
ؽڽǦi (rad)123456

2FFSRѧ

˺(i)0123456
mi(kg)250.015.012.010.05.02.52.0
bi(m)(x)0.00.0-0.120.00.00.00.0
(y)0.00.070.00.00.050.00.0
(z)-0.20.00.00.070.00.05-0.04

iIi
(kg.m2)(1,1)12.50.1580.0250.0950.0250.010.007
(2,1)4.00.00.00.00.00.00.0
(3,1)8.00.00.00.00.00.00.0
(2,2)12.50.0920.2250.0950.0160.010.007
(3,2)5.00.00.00.00.00.00.0
(3,3)12.50.1580.2250.0410.0250.0040.005


ͼ2FFSR׽Ŀάͼη

ͼ3Ǳ̬Ǻλñ仯ʱ

ͼ4FFSRеֹؽڽǵʱ

ͼ5FFSRеֹؽڵ
6
ͨFFSR˼ٶȺͼٶȹϵFFSRе˶ѧͶѧԣһڼFFSRؽصĵ㷨.֤㷨Ч.㷨Luhˣ6Ե㷨ıڵƼٶȡٶȺ͹ؽʱ˿ռе΢FFSR߶ͽǶԼ.
ע:õƹί塱Ŀ(Ŀ863-2-4-1-4).
߼:ңУ19639ʿоҪоΪռˡ˹ܡʵ.
ۣУ19398ڣʿʦҪоΪ˹ܡռˡʵ.
ߵλ:ҵѧѧ빤ϵ150001
ο
1Vafa Z, Dubowsky S. The kinematics and dynamics of space manipulators: The virtual manipulator approach. The International Journal of Robotics Research, 1990, 19(4): 321
2Umetani Y, Yoshida K. Continuous path control of space manipulators mounted on OMV. Acta Astronaut ,1987, 15(12): 981986
3Yamada K, Ysuchiya K. Efficient computation algorithms for manipulator control of a space robot. Trans of the Society of Instrument and Control Engineers, Japan, 1990, 26(7): 3138
4Mukherjee R, Nakamura Y. Formulation and efficient computation of inverse dynamics of space robots. IEEE Trans on Robots and Automation, 1992, 8(3):400406
5Nagashima F, Nakamura Y. Efficient computation scheme for the kinematics and inverse dynamics of a satellite-based manipulator. In: Proc of IEEE Int Conf on Robotics and Automation, Nice, France, 1992. 905912
6Luh J Y S, Walker M W, Paul R P C. On-line computational scheme for mechanical manipulator. Trans ASME J Dynamic Systems, Measurement and Control,1980, 102(2): 6976
ԭյڣ1998-12-31޸ĸյڣ1999-03-29.
