Զѧ
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)Ӧеͨ˲.ĲûּһͺƲԣȡõʵ.ǰ׼ƿƲ
