ѧ 
JOURNAL OF ASTRONAUTICS
1998 19 1 No1 Vol.9 1998Ƽڿ

ռе۶ѧرܪ

(ӱʦѧеϵ*ʯׯ*050031)

(Ϻͨѧѧϵ*Ϻ*200030)
ժҪĵռе۷Լ,Ưϵͳѧ,ͷϵͳֱķ,ƽ˶εõֵĹ̷и
ʡռеۡѧ嶯ѧ
AVOIDING DYNAMIC SINGULARITIES 
OF SPACE MANIPULATOR
Gu Xiaoqin
(Heber Normal University*Shijiazhuang*050031)
Liu Yanzhu
(Shanghai Jiaotong University*Shanghai*200030)
AbstractThe nonholonomic constrains of space manipulator are derived in this paper.Dynamic sigularities of free-floating system is discussed,and reducing area of singularity for in-plane moving system are proposed.The numerical simulation example is given.
Key wordsSpace manipulatorDynamicsMultibody dynamics
1
ռеۿͷšռռվڹ콨ά޵ȡΪʡԴеִʱ˿ϵͳʱرաʼĩλ˻ڹԿռƹ켣ת˶ʱ,Jacobiϵͳ,޷õ⡣Ưϵͳϵͳѧйعʳƶѧ㡣Լʹλòеתǵǰֵй,תǵʱ̾,ʶѧǿռеۿеѵ͹ؼ㡣
Papadopoulosģ1нJacobiлеתǡ̬Ƿ,ƽ˫˿ռе۽¿ռ,Сֶܳѧķģ2ƯϵͳJacobiɻеۼβȷص,ûе۵Jacobi,ԽԷָĽ㷨ĵϵͳʽ,ָѧֵԭ塣ɶϵͳƻر㷽;ϵͳ˶ѧ˳ʵƹ켣Ŀ㷨,ƽ˶ϵͳ˼ٶѧֵĹ̷
2
ϵͳB1еBi(i=2,,n-1)ץֺ͸帺BnԵɶɡϵͳ0cΪ㽨Իe0,Ը0ciΪ㽨ei(i=1,,n),ϵͳʼǶΪ,,ɶԭ0c:

(1)
Jjjmjj(j=1,,n)ֱΪBjĹٶʸ0cj0cʸ,ʸbijɽjʾ3:

(2)
̬Ǧ1k(k=1,2,3)Ӧתʸp1e1ͶӰp1k(k=1,2,3)ų1=ۦ11,12,13Tͷp1=p11,p12,p13,jΪеת,pjΪӦתʸejͶӰ,AijΪejķҾ,K*ij,,q=(2,3,,n)T,öϵͳѧ3ݽʽ(1)Ϊ:

(3)
(2)ʽʱ,õڹϵٶ:

(4)
йJacobiJ=A01(J1Ja2-J2,J1Ja3-J3,,J1Jan-Jn),Ϊʸeiϵ귽
ڸƹ켣n(t),(4)ʽõJʱеתǿƹ:

(5)
ռеϵͳλδqSʹdetJ(qS)=0ʱ,ϵͳ޽,Jacobiinй,binϵͳȷ,ʾжѧ,еֻ˶ѧ㡣ģ4ָԿռ۵ֶѧʱ,еĵۿƷӦáλڻе۹вϱ仯,غ㷽(3)һ²ɻ,Jqǰֵй,q˶·ʼֵȷĦ1й,ץֹԿռqһһӦϵԶѧѧϾȷʮ,Ĵӹ̹۵Դ
3ܿ㷨
(a)ɶȿռϵͳ
ѧıǹJacobi,ϱΪۻ۸˶޷ʹĳһ˶,Ϊ˱Ϊɶϵͳֻ㸽·΢СıԴﵽƿʵ,·ƫ߲÷Ʒڿռϵͳͨ踺˶켣dn,ʵ˶켣n,涨еתǹ:

(6)
ʽΪеתת,KΪλ÷,ѡȡK=diag(k2,k3,,kn),ki0(i=2,,n)ʱ˶нȶԡ
(b)ɶϵͳ
ǰۿ֪,ռ۴ڶѧʱ,ץʧȥһɶ,Ϊʹϸƹ켣˶,ӦӻеɶȡеɶתǦi,ɶתǦj,ֱΪq,q,(4)ʽ:

(7)
detJ0ʱ,ȡ,ά6ɶȿռе,q=(2,3,4)Tת,q=(5,6,7)T,JJ·ֱΪ33׷ֿkʱdetJ(k)=0,ȡ㷨

(8)
(c)Lyapunov
ڸλʼĩֵ·Ҫʱ,Lyapunovʵֱ·滮nfΪλĿֵ,תqi(i=2,,n)ı仯

(9)
AVΪ󡣵ʱ,λϸ(5)ʽ˶;ʱ,ֻر,Lyapunov滮Ľȶ,˷ɱ֤Ŀֵ
4СѧӰķ
ƽ˶,ei10i0i+1,ɷ(2)ø0c4Ocʸ4,(3)(4)ʽõ

(10)
ɵЧIi(i=1,2,3)֪IiǦ2,3ĺ,1޹ءA01e0e1ķ,detA01=1,(4)(10)㴦detJ=detJ*=0
J*в̬Ǧ1,ϵͳתǿռɻеλqs,һ-رȷ,ΪԷdetJ*(qs)=0ߦ2-3áץֹռ,423e1i(1)й,123ڷԼ,ץԿռ¿ռһһӦϵ,qsȷԿռжѧ㡣
(a)еۻغ
ռۻO2װOc1,ʸb1i=0,(10)õ:
detJ*=b24b34(I1-I2)sin3/I1
(11)


ͼ1ֲ
I10(i=1,2,3),I1-I2=J10,ʦ3=k(k=0,1)Ϊѧ㡣k=0ʱ,ץִڹռԵ,ͼ1C1;k=1ʱԵC2(2)ʽõ뾶Ϊr1=b24+b34,r2=b24-b34
(b)̬ϵͳ
ɶȿռ,ٳһǶ̬ȶ,ʱϵͳܶغԼ,(10)ʽõJacobi,detJ*=b24b34sin3,ͬ,ѧ㴦ͼ1C1C2ԲϡϿ,A01(1)ڽ¿ռȷĶѧһһӳ䵽ץֹռ,ʱռеϵͳ൱O*2Ϊ(OcO*2=b1n)ʸbjnΪˡת»ʸΪpj(j=2,,n)ĵȼ۹̶׻еSf,ռ۶ѧ㼴ϵͳSf˶ѧ㡣ƸڹԿռ˶켣ʱ,ֻҪﵽռıԵ˳ʵֿƻеתǡ
5㡡
ɶȿռеϵͳβΪm1=700kg,m2=10kg,±ۡץּعm3=290kg,JiֱΪ50030300kg*m2,020c2=3m,030c3=5m,0203=6m,O3P5mϵͳOC-e01e02ƽ˶,Ҫƹ켣x+2y=16.84˶,A(8.28,4.28),յB(8.16,4.22),Cѧ,ͼ2ΪķõתǱ仯,ͼ3Ϊ˶켣


ͼ2תǱ仯


ͼ3˶켣
6ᡡ
ռеϵͳ涯ѧǿб뿼ǵ,ƯϵͳغһԼĴ,ʹѧڸعԿռ䲻ȷ,زͬ·ͬһĿɵ²ͬ,Ķɶϵͳͷɶϵͳֱ,Զѧ弰ѧϸ,ΪٶѧӰ,еۻװĻߴ̬ϵͳ̬ȶ,ӹʵжԿռе涯ѧоƾнϸߵĲοֵ
ο
1Papadopoulos E et al.J.Dyn.Sys.,Meas.Cont.,1993,(115):44-52
2Xi F et al.IEEE Int.Conf.Robot.Auto.,San Diego.California,1994,3460-3465
3.̬ѧ.:ҵ,1995:228-293
4Karray F et al.Nonlinear Dynamics,1994(5):71-91
199678յ
*ȻѧصĿӱʡʿлĿ
