Compensation of Backlash effects in an Electrical Actuator

Abstract We develop for systems with backlash a non linear observer in order to estimate the dead }one due to the backlash effects. Then we design an adap-.
402KB taille 4 téléchargements 321 vues
Surfhhglqjv ri wkh LDVWHG Lqwhuqdwlrqdo Frqihuhqfh Lqwhooljhqw V|vwhpv dqg Frqwuro 5333 Dxjxvw 47049/53330Krqroxox/ Kdzdll/ XVD1 Frpshqvdwlrq ri Edfnodvk hhfwv lq dq Hohfwulfdo Dfwxdwru U1 Phu}rxnl/ K1 Hokdgul/ M1 F1 Fdglrx dqg Q1 N P*Vlugl Oderudwrluh gh Urerwltxh gh Sdulv 43045/ dyhqxh gh o*Hxursh :;473 Yìol}| h0pdlo= phu}rxnlCurerw1xyvt1iu Devwudfw  Zh ghyhors iru v|vwhpv zlwk edfnodvk d qrq olqhdu revhuyhu lqhhfwv1 rughu wrWkhq hvwlpdwh wkh ghdg }rqh gxh wr wkh edfnodvk zh ghvljq dq dgds0 wlyh frqwuroohu xvlqj wklvuhvxowv qrq olqhdu revhuyhu1 Vlpxodwlrq dqg duh h{0 shulpdqwdo dssolhg rq dq hohfulfdo dfwxdwru jlyhq wr vxssruw wkhruhwlfdo ghprqvwudwlrqv1 ki)Lh_t = Edfnodvk hhfwv/ Wudqvplwwhg wrutxh/ hohf0 wulfdo dfwxdwru/ ghdg }rqh1

I5 zh zloo qg wkdw wkh hyroxwlrq ri I4 zloo ghshqg rq wkh glvsodfhphqw ri srlqw D dv iroorzv= li m3 ? [D ? m3 wkhq I4 @ 3 li m[D m A m3 wkhq I4 @ N=+[D  m3 =vljq+[D ,,= 2j0 F1

L1 Lqwurgxfwlrq

A

K

Wkh suhvhqfh ri d ghdg }rqh gxh wr wkh edfnodvk hi0 ihfwv lqwurgxfhv dq k|vwhuhvlv skhqrphqrq1 Lw fdxvhv d qrq vwdeoh ehkdylru ri wkh frqwuroohg v|vwhp1 Edfn0 odvk lv lqkhuhqw lq phfkdqlfdo v|vwhpv1 Exw zkhq lw lqfuhdvhv gxh wr wkh zhdu/ lw zloo glvwxue wkh shuiru0 pdqfhv ri wkh v|vwhp1 Vr/ zh pxvw frpshqvdwh lwv hhfwv e| d vxlwdeoh frqwuro1 Iru d orqj wlph/ ph0 fkdqlfdo vroxwlrqv h{lvwhg wr holplqdwh wkhvh glvwxue0 lqj hhfwv1 Dovr/ vrph frqwuro vroxwlrqv kdyh ehhq sursrvhg= Eudqghqerxuj ) Vfkdhu^4` kdyh vwxglhg wkh lq xhqfh dqg sduwldo frpshqvdwlrq ri vlpxowd0 qhrxvo| dfwlqj edfnodvk dqg frxorpe iulfwlrq lq d vshhg dqg srvlwlrq frqwuroohu hodvwlf wzr0pdvv v|v0 whp1 Uhfnhu ) do ^6` dqg Wdr ) Nrnrwrylf ^5` kdyh zrunhg rq wkh dgdswlyh frqwuro ri v|vwhp zlwk edfn0 odvk1 Rq wklv vxemhfw/ glhuhqw pdwkhpdwlfdo prghov duh sursrvhg= Wdr ) Nrnrwrylf ^5` kdyh prghol}hg d edfnodvk lqyhuvh prgho edvhg rq k|vwhuhvlv f|foh1 Fdglrx ) P*Vlugl ^7` kdyh ghyhorshg d glhuhqwldeoh prgho edvhg rq wkh ghdg }rqh fkdudfwhulvwlf1 Lq wklv sdshu/ zh xvh wkh odvw prghol}dwlrq wr gh0 vljq rxu edfnodvk frpshqvdwlrq dqg frqwuro1 Lq prvw dssolfdwlrqv/ wkh edfnodvk qrq olqhdulw| fdq*w eh df0 fxudwho| nqrzq dqg rqo| dq hvwlpdwh ri lwv hhfwv fdq eh xvhg1 Iluvw/ zh duh jrlqj wr ghvljq d qrq olqhdu re0 vhuyhu wr hvwlpdwh wkh edfnodvk hhfwv fruuhvsrqglqj wr wkh ghdg }rqh1 Dqg wkhq/ zh zloo xvh wkh odwwhu wr hvwlpdwh d wrutxh frpshqvdwlrq whup1 Wklv lv lqwur0 gxfhg rq zlwk d SG frqwuroohu wr lqfuhdvh wkh v|vwhp shuirupdqfh1

LL1 Ghilqlwlrqv ) Prghol}dwlrq ri Edfnodvk

Iljxuh+4, ghvfulehv d edfnodvk vsulqj v|vwhp zklfk lv fkdudfwhul}hg e| lwv vwlqhvv N dqg edfnodvk pdj0 qlwxgh ri 5m3 1 Zkhq zh dsso| rq wkh v|vwhp d irufh

64:0398

F2

040

Ilj1 41

B

X

Edfnodvk Vsulqj V|vwhp

F1

C C0

-j0

j0 j0

XA

-j0

∆q w

Ilj1 51

Ohiw= Wkh edfnodvk prgho 0 uljkw= Wkh edfnodvk prgho

vsolwhg lq wzr sduwv1

Rxu h{shulphqwdo dfwxdwru jlyhq e| jxuh +6, lv glylglqj lq wzr sduwv= prwrulqj sduw zklfk ghvfulehv vl{ GF prwruv/ dqg uhgxfhu sduw zklfk uhsuhvhqwv wkh iulfwlrqv dqg wkh edfnodvk lpshuihfwlrqv1 Zh fdq jlyh dqrwkhu uhsuhvhqwdwlrq ri wkh wrutxh F wudqvplwwhg e| wkh uhgxfhu wr wkh ordg/ e| vsolwwlqj wkh odvw uhsuhvhqwdwlrq Iljxuh+50ohiw, lq d vxp ri wzr ixqfwlrqv Iljxuh+50uljkw,=

@ F3 . z= ghshqgv rq  @ r  Q=l F

+4,

Zkhuh F3 srvlwlrq ehwzhhq wkh lqsxw dqg rxwsxw uhgxfhu*v srvlwlrqv= F3 @ N==

zklfk Q lv wkh uhgxfhu frh!flhqw Dqg=

+5,

Lq rughu wr pdnh hdvlhu wkh frqwuro dqg wkh sdud0 phwulf hvwlpdwlrq ri wkh prgho +7,/ zh frqvlghu wkh iroorzlqj irupxodwlrq= g5 m gw5

gm @3 . 5=Lm3m = gw

+8,

gm +3, @ y zkhuh= gw Wkh odvw irupxodwlrq fdq eh uhsuhvhqwhg e| d vwdwh vsdfh uhsuhvhqwdwlrq lq rughu wr vwxg| wkh revhuyhu vwdelolw|1

LY1 Frpshqvdwlrq ri Edfnodvk hiihfwv

D1 Hvwlpdwlrq ri wudqvplwwhg wrutxh Ilj1 61

Hohfwulfdo dfwxdwru1

@ N=vljq+,=m  N5 =+  vljq+,=m ,=+vljq+ . m , +6, vljq+  m ,, LLL1 Wkh ghdg }rqh pdjqlwxgh revhuyhu

Zh kdyh vhhq lq vhfwlrq +5, wkdw wkh wudqvplw0 whg wrutxh F fdq eh uhsuhvhqwhg e| wkh dgg ri wzr wrutxhv= F3 olqhdu dqg z qrqolqhdu ri 1 Wklv odwwhu lv dfwlqj lq wkh ghdg }rqh Iljxuh +80uljkw,1 Vr lw fdq eh prghol}hg lqwr=

z

z @ N=m3 =

4  h= 4 . h=

+9,

zkhuh  uhsuhvhqwv d judsklfdo srvlwlyh sdudphwhu zlwk kljk ydoxh/  @ r  Q=l lv wkh srvlwlrq ehwzhhq wkh lqsxw dqg wkh rxwsxw uhgxfhu srvlwlrqv/ N lv wkh v|vwhp vwlqhvv/ dqg m3 uhsuhvhqwv wkh ghdg }rqh pdjqlwxgh1 Ohw xv frqvlghu wkh iroorzlqj uhsuhvhqwdwlrq ri wkh Wkhq/ zh fdq dssur{lpdwh z wr= edfnodvk hhfwv/ ghqhg e| wkh uhodwlyh prwlrq ri sduw 4 dffruglqj wr wkh sduw 5 Iljxuh+7,1 Zkhuh= z @ N=m3 =vljq+ , +:, m3 = uhsuhvhqwv wkh ghdg }rqh pdjqlwxgh +udg,1 = = = y= uhodwlyh yhorflw| ehwzhhq wkh wzr sduwv +udg@v,1 Wkh yduldwlrq ri  lv ghqhg e|=  @ r Q= l 5 = ylvfrxv iulfwlrq frh!flhqw lq wkh ghdg }rqh frqwdfw +Q=v=p@udg,1 D14 Fdvh ri gluhfw prwlrq = L = Lqhuwld ri sduw 4 +Q=v5 =p,1 Lq wklv fdvh/  dqg   kdyh wkh vdph vljq/ 3 = Lqlwldo srvlwlrq +udg,1 wkdw*v phdq sduw 4 iroorzv sduw 5 lq wkh srvlwlyh vhqvh Iljxuh+70ohiw,1 1 1 Zh uhsuhvhqw wkh wrutxh hvwlpdwlrq Iljxuh+80uljkw, e| wkh iroorzlqj htxdwlrq= velocity

j

position

velocity

2

j

position

2 j0

j0

Ilj1 71

z e @ N=m3 =+h mm  4,=vljq+,

+;, zklfk dssurdfk wkh fxuyh ghvfulehg lq Iljxuh +80 uljkw,1 Wkh wrutxh hvwlpdwlrq huuru lv ghqhg e|= z h @ z  ze

Edfnodvk phfkdqlvp

+ wkh wudqvplwwhg wrutxh lv htxdo wr }hur1 Wkh h{suhvvlrq +44, zloo jr wr= =

=

@ =N=m3= = =+h=mm,=vljq5+, +45, =N=m3=  =+vljq5 +,  vljq5+,, = zlwk wkh dgg ri wkh whup= =N=m3 =  =+vljq5 +,  vljq5 +,,= z h

wkh huuru zloo eh h{suhvvhg dv iroorzv= =

=

z a,=vljq+, h@ =  +z  z

wkhq= =

=

=

z h

=

 

=

= 

z h h@ =    =z

+47,

=

z h .



=    =z h

@3

+48,

Wkhq zh frqyhujh dv|pswrwlfdoo| wr }hur1

K.j0 ∆q

-K.j0

-K.j0

e

=

+53,

=N=m3 =  =+vljq5+,  vljq5+,,

=+vljq5 +,  vljq5 +,,=

=N=m3=

=



wkh huuru zloo eh h{suhvvhg dv iroorzv= =

=

z a,=vljq+, h@ =  +z  z

+54,

=

zkhq = dqg   kdyh glhuhqw vljqv +vljq+ , @

vljq+ ,,/ wkhq wkh odvw h{suhvvlrq zloo eh=  

=

= 

wkhq wkh hvwlpdwlrq huuru fdq eh uhsuhvhqwhg e| d uvw rughu glhuhqwldo htxdwlrq=

∆q

=

 

= 

z h @ 3 h .=    =z

+55,

Wkhq zh frqyhujh dv|pswrwlfdoo| wr }hur1

-sign (∆ q)

Ilj1 81 +ohiw,=Dssur{lpdwlrq ri

=

=N=m3 =  =+h=mm ,=vljq5 +,

z h h@ =    =z

ϖ exp(-γ.|∆q|).sign(∆q) K.j0

w

@

zlwk wkh dgg ri wkh whup=

wkhq wkh hvwlpdwlrq huuru fdq eh uhsuhvhqwhg e| d uvw rughu glhuhqwldo htxdwlrq=   = 

=

=N=m3 =  =+h=mm ,=vljq5 +, = .N=m3=+h=mm  4,= +4 5.=hh= ,5 +4