Զѧ
ACTA AUTOMATICA SINICA
2000Vol.26No.3P.324-331



Իе۶ѧ
ΪıȽо
ѩ÷
ժҪͨԻе۶ѧϵͳ㼫㼰ģ̬ΪĽģ̬ȡȡάģͶѧԹڽ״εĽΪ˱Ƚо.⣬ͽȡģ͵ĸ߽涯ѧز̬ΪӰֵȽϷ.
ؼʡԻеۣѧԣ涯ѧ.
ASYMPTOTIC BEHAVIOR OF DYNAMIC SINGULARITY OF
FLEXIBLE MANIPULATORS:A COMPARATIVE STUDY
GUO XuemeiWANG GuoliZHANG Xianmin
(Engineering College,Shantou University,Shantou515063)
AbstractBased on analytical analysis for the asymptotic expressions of the poles, zeros and modal parameters of a flexible manipulator, the asymptotic behavior of the dynamic singularity is discussed analytically for both zero-truncated and modal truncated approximation models, and the comparison is carried out as well. An numerically comparative study for the inverse dynamics is made to illustrate the effects of high order terms of the truncated models on the ill-posed behavior of the calculated torque. 
Key wordsFlexible manipulator, dynamic singularity, inverse dynamics.
1
ǲÿƷʽԻе۶ѧģǰƲԣ1ݺͷƲԣ2ʱѧԶᵼ¿쳣ͣ⣬⽫Իе۸˶Ƶʵ.ģ3ݵоԻе۶ѧԻᵼϵͳƵӦڸƵڲ̬ĩ˶켣кеĸƵɷֽ涯ѧĲ̬Ϊɴ˵õļؽв̬Ƶɷ֣гֵľֲƵ彫ʹ.ĽһԻе۶ѧԹڽ״εĽΪԸƿƴ޵оҪָ.
Իе涯ѧĶֱ̬ڶѧϵͳֲ.ģ̬ȡάģ͵ֲرǸ߽׸ĳ֣άģ͵ֲнϴ.ˣչģ̬ȡȡάģ͵ĶѧԱȽо̽ȡģ涯ѧʮҪ.Ľ㼫㼰ģ̬ΪĽؿģ̬ȡȡģͶѧԵĽΪͨʵȽϸ߽͸߽ģ̬涯ѧز̬ΪӰ.
2άƶѧģ
ͼ1ʾƽ浥ԻеۣΪһԱνƽڵľ䳤ΪlܶΪѣEΪģIΪת.ĩΪMtʵ͸أһ˽תΪJhķ.˵Ĵλ˵ĸ˶뵯ԱεĸϽ


ͼ1ƽ浥˵Իе۵ĸӽṹ
z(t,x)=x(t)+w(t,x)(1)
Ц(t)Ϊؽתǣw(t,x)Ϊתϵoxyеı.˼еԺͽתԶԵԱεӰ죬Լ˲ϵĽṹᣬEuler-Bernoulliۣɵ˶

߽Ϊ

ЦΪ,˴ʹõ΢ַڹΪ
2.1ȡάģ
ئ(t)Ϊ룬ĩλz(t,l)Ϊʽ(2a)(2d)Laplace任ɵõϵͳ·ʽĴݺ
(3)


Mittag-Lefflerɣ4ݿɵõ˻չʽĴݺ

Ϊϵͳoļתp2n=4b4nEI(l4)-1bn0㷽
tanhbn=-tanbn,0b1b2bn,(5)
n=d4nEI(l4)-1dnΪQ(dn)=0Ľ⣬0d1dn.ʽ(4)еNײֳ˻õG(s)ĵNȡάģ
(6)
۲ʽ(6)֪GNZ(s)G(s)ǰN㣬ЩʵԻеΪɢṹеǴ5.
2.2ģ̬ȡάģ
˶(2a)(2d)ȼ۵رʾHilbertռWϵĳչ
(7)
ʽЦ=00J-1nT;u(t)=z(t,x),z(t,l),(t)TW,W=L2(0,l)R2;ǶڻΪ

AΪӣΪ



ΪHеĳӿռ䣬Hm(0,l)Ϊ(0,l)ϵmSobolevռ䣻AΪWϾд׵ıӣ6ݣnn=0ΪAıֵ;淶γW걸;u(t)Wϰģ̬չɶÿn0,un㷽
(8)
ʽ(8)Laplace任õئ(t)ĩλz(t,l)Ĵݺ
(9)
ʽ(9)еǰN+1õG(s)ĵNģ̬ȡάģ
(10)
Աʽ(6)ɽʽ(10)һдɳ˻չʽ
(11)
ģ̬ȡȡʽ֪,-Nn=1ģ̬n,n,nNn=1ȷ״Nأpn,-pnNn=1ģ̬ͽ״N޹.ڽϴn,Ϊpn.Ϊ˱ƶѧģ壬ۺԼ:(A1)GNM(s)޸㣬20,n=1,2,N.
е±СZ͡Mֱڱʶȡģ̬ȡģ͵.
3ѧԽΪ
3.1㼫Ľ
nϴʱtanhbn1bn0㷽tanbn=-1bnɽʾ
bn(n+3/4),(12)
ͬڽϴn(d-4nexp(-dn))Q(dn)(cosdn-sindn)JhMt(2l4)-1,dn0㷽cosdn-sindn=0dnɽʾΪ
dn(n+1/4).(13)
ڽϴnp2nͦn½ʽ
(14)
3.2ģ̬Ľ
ٻ=x/l,n()=n(x)/l.AĶ壬n()
D4n=d4nn,0ܦΡ1,
(15a)
߽Ϊ

(15a)(15c)һʽʾΪ
n()=F1sin(dn)+F2sinh(dn)+F3cos(dn)+F4cosh(dn).(16)
ӵĹƣڽϴnģ̬ɽʾΪ
(17)
滯ԼɵõϵF1,F2,F3Ľ
F1F3-F2F=(8Mtl2+l3)-1/2.(18)
ʽ(18)뵽ʽ(17)еõ
(19)
ĺۺԼ(A2)ÿn0n0ҹnϸݼ.
3.3ѧϵͳĽ
¿ϵͳNMͦNZڽ״εĽΪҪʵ.
1.ϵͳNMͦNZɷֱ𽥽ʾΪ
(20)
(21)
0N0N,N0ϴN޹.
֤.=0,0,J-1hTڿռWϽģ̬չõչʽ2Ϊ(A2)ʣɽNMд
(22)
0ܦNM1.ʽ(19)ɵõʽ(20).
ʽ(12)(13)֪N0ʹnN0ʱdnbn.ڽϴNNZд
(23)
ʽ(23)Уõʽ(21).֤.
ȡģ̬ȡƶѧϵͳ״N˥㣬˥ʷֱΪO((1/4)N)O(N-2).
3.4ѧԵƵӦ
ڽͨϵͳĲ̬ΪȽϷѧԵƵӦ.GNZ(s)GNM(s)ϵͳֱΪHNZ(s)=(s2GNZ(s))-1HNM(s)=(s2GNM(s))-1.Ϊ˱֤ϵͳȶԣ轫HNZ(s)HNM(s)Ϊȶķϵͳ߾ӦΪ˫Laplace任ϵͳϵĽиƽе7.ϵͳƵӦ.
2.ʱ
HNZ(j)ܣHN-1Z(j),HNM(j)ܣHN-1M(j);(24)
ʱHNZ(j)HNM(j)ֱ𵥵(NZ)-1ͣNM-1.
֤.ÿn1,gn(-)ڣ0,)Ϲڦϸ񵥵ݼ.̣Nʱ֤ڦ̵1༴ʱHNZ(j)(NZ)-1.(A1)֤ͬHNM(j)(NM)-1.ֵʱģ̬ȡ涯ѧģͣ(A2)ʽ(22)֪
HNM(j)/HN-1M(j)=1+(-1)NN2(2-N)-1HN-1M(j)-11,(25)
ȡ涯ѧģͣ
HNZ(j)/HN-1Z(j)=Np-2NgN(-2)-11.(26)
ʽ(25)(26)Ƶʽ(24).֤.
ֲͬȡʽ½ĽƶѧģͣѧԵƵӦΪΪŽȡ״ӣȶϵͳڸƵڲ̬и߽ƵӦƵɷֵӰǿԵƵɷֵĹ𽥼ϵͳƵӦƵ̬ɷϵͳȣϵͳĲ̬Ϊϵͳڽȡ״εĽ׾.
4涯ѧʵ
1Իеϵͳ㼫㼰ģ̬

nnp2nnn
002.65102.0874
14.5731e+21.0853e+3-1.98664.7642
23.6481e+33.0903e+42.17162.3099
32.6268e+41.8844e+5-1.84620.8130
41.0333e+56.5159e+51.52000.4047
52.8937e+51.6774e+6-1.28190.2411
66.5856e+53.6018e+61.10510.1597
71.3048e+66.8401e+6-0.96970.1135
82.3418e+61.1887e+70.86310.0847
93.9031e+61.9314e+7-0.77720.0666
106.1416e+62.9776e+70.70730.0700

ڽ߽͸߽ģ̬涯ѧز̬ΪӰ.ԻеԭͲ»
l=1.27m,E=7.111010N/m2,
I=6.77510-11m4
=0.2190kg/m,Jh=0.03kg-m2,
Mt=0.031kg.
õ10ȡģG10Z(s)Իеϵͳ1г˦np2nԼģ̬nͦnļֵȻ(A2).ͼ2˶ѧNZͦNMڽ״NĽ仯.ͼ3ͼ4ֱȽ˵4ȡģ̬ȡģ͵ֲ״ƵӦĽΪ.ͼ3֪ģ̬ȡģ͵34Ը߽ΪԣG(s)Ӧнϴ.ͬʱע⵽G4Z(s)G4M(s)ƵӦΪڦأƵ̲΢ڦأƵ̲Գֲ.ֵ뱾ǰķǺ.


ͼ2ֵڽȡ״εĽΪ
ģ̬ȡȡ


ͼ3ǰ4ֲ
ģ̬ȡȡ
(A1)Ҫ·ֱԵ2ȡģ̬ȡģΪȽϸ߽͸߽ģ̬涯ѧز̬ΪӰ.ʱ(2Z)-1=3.542 5(2M)-1=0.921 5




ͼ4ƵӦ
ȡģ̬ȡ
ͼ5򻯴Bang-Bangͼٶߣ3ݣͼ6Ƚ˵2ȡģ̬ȡ涯ѧõļ.˲ѾBang-BangЦأ0.5(+)Ƶ̵ĸƵɷȥģ̬ȡ涯ѧأȡ涯ѧȻBang-Bangߵļϵ㴦˽ϸ߷ֵ壬¼ر.ֵӡ֤һڵķ.


ͼ5ĩ˼ٶȲο
Bang-Bang,-.-.-


ͼ6
----ȡ,ģ̬ȡ
5
ԵԻе۵ģ̬ȡȡѧԽΪķģ̬ȡȡѧϵͳڽ״NĽ׷ֱΪO(N2)O((1/4)N)߽͸߽ģ̬涯ѧƵӦڸƵ̲̬ΪӰӦϵͳĽ׾.
߽͸߽ģ̬ԶѧӰĽṩ˶ԿƴĶʶԽһоᶯѧӰɴƵĲԾָ.
Ȼѧ(59975056)㶫ʡȻѧ(970379).
ѩ÷19647³.1987ҵ廪ѧеϵ1990ܻеоѧ˶ʿѧλ.νͷѧѧԺ»ѧӦüо.
19654³.1992Ͽѧϵѧʿѧλ.νͷѧѧԺܻ˼ʵо.
196412³.1994ҵѧʿо.νͷѧѧԺԻѧ񶯿Ʒо.
ѩ÷ͷѧѧԺͷ515063
ͷѧѧԺͷ515063
ͷѧѧԺͷ515063
ο
1ݡBayo E, Paden B. On trajectory generation for flexible robots. J. Robotics Systems, 1987, 4(2):229235
2ݡWang D, Vidyasagar M. Transfer function for a single flexible link. Int. J. Robotics Research, 1991, 10(5):540549
3ݡWang Guoli,Lu Guizhang. Well-posedness of inverse dynamics of flexible robot arms. Int. J. Robotics and Automation, 1996, 11(4):175182
4ݡGoodson R E. Distributed system simulation using infinite product expansions. Simulation, 1970, DEC:255262
5ݡMiu D K. Physical interpretation of transfer function zeros for simple control systems with mechanical flexibility. ASME J. Dyna. Sys., Meas., and Contr., 1991, 113(9):419424
6ݡSakawa, Y et al. Modelling and feedback control of a flexible arm. J. Robotic Systems, 1985, 2:453472
7ݡBalth Pol V D, Bremmer H. Operational calculus based on the two-sided Laplace transform. Cambridge: University Press, 1955
ոڡ1997-11-07
޸ڡ1998-06-24
