Զѧ
ACTA AUTOMATICA SINICA
2000Vol.26No.3P.289-295



ֱ˹ؽڼٶ

̸
ժҪ߼ٶȴʵʲתؽڵļٶΪ˻˹ؽڼٶȷƵĿģͣԼӰջȶԵҪأ˱ջƲԵ׼.һ̨ɶֱϵʵ֤˸ķȷԣ벻߱ٶȷʱʵȽϣʾַЧ.
ؼʡٶȣƣֱ.
JOINT ACCELERATION FEEDBACK CONTROL
FOR DIRECT-DRIVE ROBOT DECOUPLING
HAN JiandaTAN DalongJIANG Xinsong
(Shenyang Institute of Automation,Chinese Academy of Sciences,Shenyang110015)
AbstractThe link-couplings of a multi-DOF DD-robot always act as a kind of torque disturbances.Joint acceleration feedback control based on sensed acceleration information will help to resist such coupling effects and improve the joint tracking performance.In this paper,linear accelerometer is used to sense the rotatory joint acceleration and a model is given to describe the sensed open loop resonance,and design criteria for stable and functional control law are also proposed.Extensive experiments are conducted on a threelink DD-robot and the results are presented to validate the analyses and demonstrate the improvements benefited from the proposed method.
Key wordsAcceleration,feedback control,decoupling,direct-drive robot.
1
nɶֱ˵˶ѧΪ1
(1)
ʽD(q)Rnnǹ󣻦RnֱǸĦq,ֱǹؽڽǶȡٶȼǼٶ.
ڹؽi,ʽ(1)д
(2)(3)
ʽЦniڹؽiϵ˶ѧ(Ŷ)أJiiiתi,i,i,fiֱq,,,fiԪأdij,cijֱǾDCijԪ.
ֱˣniֱڹؽתϣӰ˸ܵأ35.ͬʱʽ(2)(3)ǱΪڹؽϵʱŶ.ˣ߹ؽԪʱŶصǽֱ˶ѧһ;.ؽڼٶڹؽϵĺ(Ŷ)ֱӷӦ.ԣʵؽڼٶźŽзƣҪﵽĿģ(i)ڹؽϵʱŶؾã(ii)㹻ıջӦƵʹɼٶȱջλͺٶȡλñջƵӰС.
Ŀʵ֣ȼͨٶȱջѻ˹ؽԪԴ.
=d(4)
ƳΪٶԴ
(5)
ʽЦd,dֱغٶȣӣֱԪ.ӶŶӰؽڼٶȵӦܣnĹؽڹɵĻϵͳ䶯ѧģͽn˫ֻ.


ͼ1ؽڼٶȵĲ
2ؽڼٶȵĲ
ڱջƵļٶȷźŲͨٶȻλôϢ΢ּõΪ΢㷨ķŴԼٶȡλôԡӦƵʹֱջ(i)(ii)Ҫ.
߼ٶȴװĩˣʹŹؽת߷ͼ1ʾͿԲתؽڵĽǼٶ.
ؽiĻǾֹģ
(6)
ؽi˵ĩ(˶)
(7)
ʽiǹؽڼٶȣfi߼ٶȴliǹؽٶȴ֮ľ룬gٶȣǹؽڻ˶ԼٶȴӰ.
3ؽڼٶȷ
ؽڼٶȷƵĽṹͼ2ʾ.ؽԱΪԴ˾նȣҼٶȴ޿ӦƵ
Gm(s)=Gs(s)=1,(8)
ɽٶȷƲΪ
Ga(s)=ka,(9)
ka.ʱͼ2ʾϵͳıջģ
(10)
kaJ/Cmka1
(11)
ӶٶȷŶصӰ죬ؽԪԴƳΪٶԴ.ǣ(8)ʵʻϵͳǳ.ȣʵ˵ĸնȶ޵ģгЧӦ⣬ԼٶȱջӦҪ˱ÿƵļٶȴ.ֿƵļٶȼܹ⵽ɷǸصµг.
ͼ2dfֱٶȺͼٶȴ(ʵʼٶ)Gs(s)˴Լٶȴ̬ԵĴݺGa(s)ǼٶȿƲԣGm(s)ǹؽϵջĴݺnǶѧŶأΪĵŶ(ЧŶ)Cmس.


ͼ2ؽڼٶȷƽṹ
ʵ˵ķǸгЧӦӰٶȱջȶԵҪ.ٶȴ⵽гԵЧGs(s)ʾڼٶȷĿƵӦ.ͼ3ǼٶȿƵӦʾͼ(ֻг壬ĶڼٶȴϵͳĸƵ˥Զ).


ͼ3ٶȿƵӦaf(s)/Id(s)
ģٶȿ
(12)
Цaf(s),Id(s)ֱf(t),id(t)Laplace任.ͼ2ɵüٶȷƵıջģ
af(s)=Gac(s)ad(s)+Ga(s)n(s),(13)
Gac(s)ǼٶȱջݺGa(s)ǼٶȱջŶƺ
(14)
(15)
ƺʵıջƲԣʵĹڼٶȷƵ(i)(ii)Ŀ꣬¹Ga(s)׼
(a)ʽ(14)(15)ȶ
1+Ga(s)Gao(s)=0(16)
Ұsƽ㣻
(b)
(17)
ʽЦvǲڼٶȷʱؽٶȵıջӦǸλͺޣʽ(17)ٶȷٶȱջڲλͺԼķΧ֮ڣԴ˴ﵽӰٶȱջҪ
(c)
(18)
ʽЦئǦnĴң0.ʽ(18)ȷڶѧŶnƵ0,ئӣڣٶȱջ.
׼ĿƲԶڼٶȷƣٶȿЧԵı׼ܹʵֵĶŶõĴС(ܹʵʻõĦֵĴС).
ӦָģԼƲԵ׼ǻڻ˹ؽԪԴһ.ʵʻϵͳͨǲ.ֱؽһصΪԪֵбȽϴĵУԵӦԵͺãӰصӦ.ȻؽڲֱṹܽԪĶ̬Լ򵥵Ϊ.ˣڼٶȵıջƵڰѹؽԪƳΪƱڵԴʵּٶȷƵıҪ.
4ʵо
һ̨ɶֱ(ͼ4)ϣԱķʵо.̨˵ؽڶֱصڵеӰ죬ǵĵӦƵ25Hz.ΪˣǲûԪΪͨƿ˷жԵӦӰ.ʵջʮϣﵽ300HzڼٶȷƵƵڣԽеƵصЧΪԴ.
ԵΪ̨˵ؽ϶ʵ˼ٶȷƣ¸ڵڶؽϵʵԱķȷԣԼٶȷƵЧ.
4.1ٶȷƵʵ


ͼ4ɶֱ˱
ؽڼٶȷƵʵṹͼ2ʾΪʾٶȱջʱŶãеŶ.ڵջ㹻ӦƵʵʵŶnǵЧģٶȱջԵõȼڶԦn.
4.1.1ٶȷĿԡ
1)ͼ5710ʾƵӦHP3562A DYNAMIC SIGNAL NALYZERԻ˵ʵʲ.ͼ5ǼٶȿƵӦ1)af(s)/Id(s)(idٶȴȡfƵӦ)еһгr1131Hz,ֵr113dBλͺ1-78㣻ڶгr2200Hz,ֵr217dBλͺ2-180.ݴۺϳٶȷĿģΪ
(19)


ͼ5ٶȿƵӦaf(s)/Id(s)(ڼٶȱջʱٶ
Ŷ֮ƵԦaf(s)/(s))


ͼ6ʽ(20)ƵӦ
ͼ6ʽ(19)ƵӦͼ5Ƚϣʽ(19)׼ȷ˼ٶȿƵԣͬʱ֤ʽ(12)ļģٶȿӦȷ.⣬ͼ2֪ͼ5ҲǲڼٶȱջʱŶԼٶӦӰ.
4.1.2ٶȷƱջ
ȻгЧӦӰٶȱջȶԵҪأгͨڸƵˣٶȷƲGa(s)Ӧеͨ˲.ĲûּһͺƲԣȡõʵ.ǰ׼ƿƲ
(20)
ʽ(19)(20)ʽ(16)ԼջϵͳٽȶΪ1.67105.
ѡka=1.327105ͼ7ǼٶȱջƵӦaf(s)/ad(s),Цad(s)dLaplace任.ͼ7ٶȷȶģ60HzгЧ.
ͼ8ǼٶȷŶƵӦaf(s)/(s),ٶȷƶ0Hz()Ŷ(Ϊڻֵ)1HzŶΪ-40.8dB(1/110)10HzŶΪ-20dB(1/10).ͼ8ͼ5Ƚϣʾ˼ٶȷƵЧԣڹؽϵĶŶȫ˷1Hz,10HzŶ÷ֱǿ11010.ʵ֤˱׼ȷ.


ͼ7ٶȱջƵӦaf(s)/ad(s)


ͼ8ڼٶȱջʱٶȶŶƵӦaf(s)/(s)
4.2ٶȷƶٶȱջӰ
ĲϸٶȱջƣڡڼٶȷٶȱջƵԵʵԱٶȷƶٶȱջӰ.ͼ9ǲڼٶȷʱٶȱջƵԦvf(s)/vd(s),Цvf(s),vd(s)ֱǷٶԼٶdLaplace任.ͼ10Ǵڼٶȿʱٶȱջ(ͼ9ͼ10ٶȿƲԡͬ).Ƚϱ


ͼ9ڼٶȱջʱٶȱջƵӦ

ͼ10ڼٶȱջʱٶȱջƵӦ
5
ּͨǿ˹ؽԪŶ˷˶ѧЧӦԿܵӰ.ĹڼٶȷƵĿ꣬ԼԴΪĿƲ׼򣬿Կ˷гЧӦӰ죬ּٶȷƵȶԣͬʱӼٶȱջʱŶãҽٶȿƶӰԼķΧ֮.߼ٶȴתؽڵļٶȣԵΪ׼һ̨ɶֱʵ˼ٶȷ.ʵ֤˱ķȷԣʾ˼ٶȷƵЧ.
ƻܻĿ.
1968ѧʿ.оԱ.ҪоݰڴĻ˿ơƶ˼˼ϵͳ.
̸1940оԱʿʦ.ĿǰҪ»ܿơϵͳȷо.
ɡ19311997.ǰйԺԺʿƻԶϯѧҡйѧԺԶ.
йѧԺԶо110015
̸йѧԺԶо110015
ɣйѧԺԶо110015
ο
1ݡSpong M W,Vidyasagar V.Robot Dynamics and Control.New York:John Wiley & Sons Inc.,1989.
2ݡHsia T C,Lasky T A,Guo Z Y.Robust independent robot joint control:design and experimentation.In:IEEE International Conference on Robotics and Automation,1988,13291334
3ݡAn C H,Atkeson C G,Hollerbach J M.Model Based Control of A Robot Manipulator.Cambridge:MIT Press,1988,3149
4ݡAoustin Y,Cherki B.Computed torque of robots with estimated velocities.In:IFAC Symposium on Robot Control,1994,1722
5ݡLiu G,Goldenberg.Comparatve study of robust saturation-based control of robot manipulator:analysis and experiments.Robotics Research,1996,15(5):473491
ոڡ1997-02-26
޸ڡ1999-02-11
