VOLGLQJ PRGH FRQWURO IRU D SQHXPDWLF URERW OHJ Q1Pdqdpdql/ Q1 Qdgmdu Jdxwklhu/ Q1N1P*Vlugl
Oderudwrluh gh Urerwltxh gh Sdulv +FQUV XUD 4::;, 43045 Dyhqxh gh o*Hxursh :;473 Yìol}|/ Iudqfh Id{ = 66 4 6< 58 7< 9: dqg hpdlo=pdqdpdqlCurerw1xyvt1iu Nh|zrugv = Ohjjhg Urerw/ Sqhxpdwlf Dfwxdwruv/ Volglqj Prgh Frqwuro1
Devwudfw Wkh dlp ri wklv sdshu lv wr hqvxuh wkh vwdelolw| ri d sqhx0 pdwlf ohjjhg urerw zlwk urexvwqhvv/ yhuvxv shuwxuedwlrq/ dqg xqfhuwdqwlhv1 Wr yhuli| wkhvh wkuhh surshuwlhv/ zh gh0 yhors dq dssursuldwh volglqj prgh frqwuro edvhg rq jhqhudo irup ri volglqj pdqlirog1 Wklv frqwuro lv wkhq frpsduhg zlwk vwdwh ihhgedfn frqwuro lpsohphqwhg rq wkh urerw1Wkh vwdelolw| dqdo|vlv suryhg e| xvh ri wkh O|dsxqry wkhru| dq vlpxodwlrqv vkrzv wkdw wkh sursrvhg frqwuro dojrulwkp fdq dfklhyh vdwlvidfwru| wudfnlqj shuirupdqfh1
4
Lqwurgxfwlrq
Gxh wr wkhlu kljk srzhu rxwsxw zlwk uhjdug wr wkhlu orz frvw/ sqhxpdwlf dfwxdwruv dsshdu wr eh ri juhdw lqwhuhvw lq urerwlf dssolfdwlrqv1 Lq sduwlfxodu/ ohjjhg urerw pd| xvh wkhlu qdwxudo frpsoldqfh zkhq ghdolqj zlwk xqnqrzq hqylurqphqw1 Lq wklv zd|/ d sqhxpdwlf dfwxdwhg urerw kdv ehhq exlow wr vwxg| jhqhudo frqwuro dufklwhfwxuh/ jdlw1 Wkh pdwkhpdwlfdo g|qdplf prgho ri rqh dfwxdwhg ohj lv kljko| qrq olqhdu dqg wlph yduldqw/ gxh erwk wr wkh phfkdqlfdo frxsolqj hhfwv dqg wkh frpsuhvvlelolw| ri dlu1 Zkhq prg0 holqj/ olqhdul}dwlrqv kdyh ehhq jhqhudoo| xvhg wr vlpsoli| wkh htxdwlrqv +vhh ^4`^5`^6`,/ dqg wkh frqwuro zdv edvhg rq fodvvlfdo ihhgedfn dssurdfk ^7`^8`1 Wkh frqwuro odzv frq0 vlghuhg suhylrxvo| iru sqhxpdwlf v|vwhpv surylgh fruuhfw uhvxowv rqo| iru vorz prwlrqv dqg jlyh d jrrg frpsur0 plvh ehwzhhq frpsoh{lw| dqg dffxudf|1 Iru rxu urerw zh kdyh srlqwhg rxw wkh olplwv ri fodvvlfdo frqwuro phwkrgv ^9` zklfk duh dfwxdoo| qrw urexvw dqg idvw hqrxjk wr hqdeoh g|qdplf jdlwv1 Wr ryhufrph wkhvh olplwdwlrqv/ wzr glhuhqw dssurdfkhv kdyh hphujhg lq olwhudwxuh1 Iluvw frpsxwhg wrutxh phwk0 rgv kdyh ehhq vxjjhvwhg iru pdqlsxodwruv dv dq hhfwlyh zd| ri xvlqj qrq olqhdu prgho lq frqwuro odz1 Krzhyhu/ wkh !#" ! $&%('*),+%-.0/ 11! 12 /! 3 4 52
g|qdplf sdudphwhuv xvhg lq wkh frqwuro odz pxvw pdwfk zlwk uhdo rqhv1 Uhfhqw zrunv ryhufrph wklv gudzedfn e| dgglqj sdudphwhu hvwlpdwlrq orrs iru dgdswlyh frqwuro1 Dq|zd| wklv nlqg ri frqwuro uhpdlqv frpsxwdwlrqdoo| frp0 soh{ wr eh lpsohphqwhg lq uhdo wlph rq rxu v|vwhp1 Rqo| rqh ohj lv xvhg iru wkh urerw pryphqwv ^:`1 Lq wkdw fdvh zh kdyh dovr vwxglhg/ frpsoh{ dgdswlyh phwkrgv ^;`1 Wkh dgdswlyh frqwuro odzv lqyroylqj pruh frpsohwh g|qdplfdo prgho duh frpsoh{ iru lpsohphqwdwlrq yhuvxv vdpsolqj udwh dqg wlph uhtxluhphqw1 Wkh vdpsolj wlph uhtxluhg lv W 6 @ 4pv= Iru urexvwqhvv ri frqwuro hlwkhu dgdswlyh whfkqltxhv edvhg rq sdvvlylw| surshuw| fdq eh xvhg ru volglqj prgh phwkrgv vhhp wr eh surpl}lqj1 Volglqj prgh frqwuro lv rqh ri wkh prvw lpsruwdqw dssurdfkhv wr kdqgoh v|vwhpv zlwk odujh xqfhuwdlqwlhv/ qrq olqhdulwlhv dqg erxqghg h{0 whuqdo glvwxuedqfhv1 Wkh volglqj prgh frqwuro dv d urexvw dssurdfk iru urerw pdqlsxodwruv kdv lqyroyhg lqwhqvh uhvhdufk lqwhuhvw lq wkh sdvw ghfdgh +\rxqj 4 d 6933 srlqwv URG0754P Khlghqkdlq vkdiw hqfrghu sodfhg lq wkh urwdwlrqdo d{lv lv xvhg wr ghwhu0 plqh wkh srvlwlrq1 Yhorflw| dqg dffhohudwlrq duh rewdlqhg e| vxffhvvlyh ghulydwlrqv dqg owhulqj1 Wkh fxuuhqw lv frq0 yhuwhg lq prwlrq ri wkh vsrro ydoyh1 Wkh ydoyh frqwuro wkh dlu rz zklfk lv frqyhuwhg lq suhvvxuh vxsso| iru wkh wzr fkdpehuv ri wkh f|olqghu1 Wkh frqwuro ri wkh urerw uxqv rq d GVS rdwlqj srlqw surfhvvru +WPV653F64, lq sdu0 dooho wr d SF +Pdwode/ Vlpxolqn,> wklv kdugzduh doorzv xv wr dgmxvw dq| frqwuro jdlq ru sdudphwhu ru vljqdo gxulqj h{shulphqwdwlrq ^44`
515
zkhuh P +t, lv wkh +5 5, jhqhudol}hg lqhuwld pdwul{/ J+t, lv wkh +5 4, yhfwru ri judylwdwlrqdo irufhv dqg F+t> t, b tb lv wkh +5 4, yhfwru ri fhqwulshwdo dqg Frulrolv irufhv/ l lv wkh +5 4, yhfwru ri wkh dssolhg fxuuhqwv1 M/ E/ H duh +55, gldjrqdo pdwulfhv fdoohg wkh wkhupr0 g|qdplfv sdudphwhuv ghshqglqj rq wkh whpshudwxuh/ jdv fkdudfwhulvwlfv dqg lqlwldo frqglwlrqv1 Wkh v|vwhp fdq eh dovr zulwwhq lq rqh vwdjh e| xvh ri h{suhvvlrq ri wkh wrutxh dqg lwv ghulydwlyh1 Wkh wrutxh ghulydwlyh lv rewdlqhg dqdo|wlfdoo| e| ghulydwlrq ri wkh wrutxh lq htxdwlrq +4,= @P b +t,t
b t, b . Pb +t, t . F+t> t, b t . F+t> b tb . J+t,
+5,
Zh rewdlq dq htxdwlrq ri wkh v|vwhp lqghshqgdqw ri wkh dssolhg wrutxh ru glhuhqwldo suhvvxuh phdvxuhphqwv e| vxevwlwxwlrq ri wkh wrutxh dqg lwv ghulydwlyh lq htxdwlrq +4,1 Zh fdq uhzulwh wkh prgho dv iroorzv +wkh v|vwhp vwdwhv duh t/ t/ b t,= b b t, b Ml @ P+t,t . P+t, t .F+t> t, b t . F+t> b tb . J+t, .E iP+t, t .F+t> t, b tb .J+t,j .H tb
+6, Wkh prgho htxdwlrqv +4,+6, zloo eh xvhg iru frqwuro ghvljq dqg vwdelolw| dqdo|vlv1
516
51614
Vwdelol}lqj ihhgedfn V|vwhp Vwdelolvdwlrq
Ohw xv ghqh wkh huuru vljqdov=
h @ t t > hb @ tb tb > h @ t t h @ > hb @ b b
+7,
@ I h I tb @, b @ I hb I t
+8,
Ohw xv qrwh dv wkh ghvluhg wrutxh/zlfk lv fkrvhq wr ghqh wkh ihhgedfn frqwuro odz=
Urerw prgho
Zlwk I > I srvlwlyh gldjrqdo pdwulfhv1 Wklv zd| doorz xv wr ghqh vlpso| wkh frqwuro odz dqg jlyhv sk|vlfdo lqwhusuhwdwlrq ri wkh frqwuro whupv1 Wkh idfw wkdw wkh v|vwhp lv frpsrvhg ri wzr vwdjhv dv wkh iroorzlqj irupxodwlrq/ vlpsoli| wkh vwdelolw| dqdo|vlv dqg hqkdqfh wkh sk|vlfdo phdq ehklqg wkh g|qdplf sduwv suhvhqw lq wkh v|vwhp prgho dqg frqwuro htxdwlrqv1
Wkh urerw prgho lv frpsrvhg e| wzr vwdjhv ^9` = rqh iru phfkdqlfdo sduw dqg d vhfrqg rqh zklfk zloo eh fdoohg wkh wkhuprg|qdplf vwdjh dffruglqj wr sqhxpdwlf sduw1 Wkh g|qdplf htxdwlrq ri d uljlg wzr olqn v|vwhp fdq eh zulwwhq xvlqj Odjudqjh phwkrg ^45` ^46`1 Ohw xv uhfdoo wkdw t/ t/ b t ghqrwh uhvshfwlyho| wkh +5 4, yhfwruv ri mrlqw srvlwlrq/ vshhg dqg dffhohudwlrq1 Wkh ordg 5
4 +L H, @ 5
Ohw xv qrz frqvlghu iru wkh lqsxw fxuuhqw/ wkh iroorzlqj frqwuro h{suhvvlrq1
Wkh ghvluhg srvlwlrq duh xvhg wr frpsxwh wkh uhtxluhg vxsso| fxuuhqw1 Wkhuhiruh/ zh xvh d srvlwlrq/ yhorflw|/ dqg dffhohudwlrq ihhgedfn iru v|vwhp vwdelol}dwlrq1 Wkh frqwuro odz kdv sursruwlrqdo/ yhorflw| dqg dffhohudwlrq ihhgedfn frpsrqhqwv zlwk lqwhughshqgdqw ihhgedfn jdlqv1 Zh iuhho| fkrrvh wkh srvlwlrq ihhgedfn jdlq N / exw wkh ydoxh ri yhorflw| jdlq N ghshqgv rq wkh I I dqg E1 Zh qrwh dovr wkdw wkh fkrlfh ri wkh dssolhg frqwuro ohdgv wr lpsrvh wkh dffhohudwlrq jdlq N dv htxdo wr I 1 Lq wkh forvhg orrs ri wkh sqhxpdwlf vwdjh wkh frqwuro odz jlyhv=
+:,
zkhuh D > D dqg D duh v|phwulf vhpl srvlwlyh pdwulfhv Zh fkrrvh D @ I > D @ P +t, dqg D @ L= I / I duh +5 5, srvlwlyh jdlq pdwulfhv1 Qrwh wkdw lq uhjxodwlrq fdvh t @ fvw dqg hb @ t> b h @ t/ wkh O|dsxqry wlph ghulydwlyh ixqfwlrq fdq eh zulwwhq= + h @ 3 @, iurp htxdwlrqv +8, dqg +9, zh kdyh wkh iroorzlqj frqglwlrq= h @ H hb @ 3 @ I h
Xvlqj wkh surshuw| wkdw Pb 5F lv vtxhz0v|phwulf dqg uhsodflqj wkh htxdwlrq + 8,/ +9,/ +: ,/ Yb ehfrphv=
Wkhq iru vwdelolw| ri rxu forvhg v|vwhp Yb ? 3 zh rewdlq vrph frqglwlrqv rq wkh jdlqv= 4 4 i e A +4 H , . +4 H , +46, 7 7 4 4 i e A +4 H , . +4 H , 7 7 4 4 i e A +4 H , . +4 H , 7 7 4 4 i e A +4 H , . +4 H , 7 7
Iru wkh vwdelolw| vwxg| zh xvh htxdwlrqv +9,+:, dqg wkh gh0 qhg huuru vljqdov h> h> b h> h > hb 1 Ohw xv fkrrvh dv O|dsxqry fdqglgdwh ixqfwlrq= ] 4 4 Y @ h D h . tb D tb . h D h . J +t,gt +;, 5 5
+X ,= +X , A nY n
Yb @ tb I tb . tb h h +H tb . Eh ,
3 +4 H ,
dqg Y 5 U duh v|pphwulf srvlwlyh zkhuh X 5 U ghqlwh pdwulfhv 1 Wkhq Z lv VSG li=
Iru wkh phfkdqlfdo vwdjh zh fdq zulwh=
4 Yb @ h I tb . tb Pb tb . tb P t . h hb . J tb 5
Ohppd 4 Jlyhq d v|phwulf pdwul{ K= X Y K@ Y X
Ml @ b . E @ b . E . H tb @, hb . Eh . H tb @ 3 +9, h . @ P t . F tb . J @
+4 H , 3
Wr suryh wkh dv|pswrwlf vwdelolw| ri wkh forvhg orrs v|v0 whp/ lw uhpdlqv wr vkrz wkdw Yb lv qhjdwlyh ghqlwh ru wkh pdwul{ K lv VSG1 Wkh iroorzlqj ohppd jlyhv d frqglwlrq iru srvlwlyh ghqlwhqhvv ri v|pphwulf pdwul{1 Wklv uhvxow lv suhvhqwhg lq ^47`1
Ml @ b . E @I h +I . EI , hb EI h ~} ~} ~}
Vr zh fdq ghqh wkh vwdeoh frqyhujhqw srlqwv jlyhq e| wkh vhw V= V @ t vxfk wkdw J+t , @ I +t t ,
3 e
Wkh v|vwhp lv shuwxuehg e| wkh judylwdwlrq hhfw1 Wkh judylw| hhfw fdq eh frpshqvdwhg e| h{whqvlrq ri wkh frq0 wuro h{suhvvlrq1 Wr wklv hqg/ zh fdq frqvlghu wkh iroorzlqj frqwuro h{suhvvlrq1
Ml @ b . E
6
zlwk=
h{shulphqwv vkrzhg wkdw wkh g|qdplf ehkdylrxu ri d ohj lv htxlydohqw wr d pdvv vsulqj v|vwhp^:`/ gxulqj wkh krsslqj prwlrq rq rqh ohj1 Wkhvh fkdudfwhulvwlfv ghshqg rq wkh vwdwh ihhgedfn wxqlqj dqg frqwdfw phfkdqlfdo lpshgdqfh1
@ I h I hb . J
Lq wkh fdvh ri wklv frqwuro/ wkh frqyhujhqfh ri wkh huuruv wr }hur lv hqvxuhg1 51615
6
Frqwuro lpsohphqwdwlrq
Wkh frqwuro lv lpsohphqwhg lq glvfuhwh wlph xvlqj wkh ghowd rshudwru @ iru dssur{lpdwlrq ri wkh ghulydwlrqv1 t lv wkh iruzdug rshudwru dqg W wkh vdpsolqj shulrg1 Wkh srvlwlrq hqfrghu vljqdov duh phdvxuhg zlwk d vdpsolqj udwh W 6 @ 3=8 pv/ owhuhg dqg wkhq yhorflwlhv dqg dffhohudwlrqv duh ghgxfhg e| ghulydwlrq1 Wkh frqwuro htxdwlrq lv lpsoh0 phqwhg zlwk vdpsolqj udwh W @ 4pv +@ 5=W 6 ,= l +n, @ N h +n 4, . N t +n 4, . N t +n 4, +47,
D vhyhuh glvdgydqwdjh ri frpsxwhg wrutxh frqwuro dojr0 ulwkpv lv wkdw shuihfw nqrzohgjh ri wkh v|vwhp g|qdplfv lv uhtxluhg1 Wkh lqdelolw| wr frqvlghu wrwdo g|qdplf prgho lv shqdolvlqj iru ghfrxsolqj dqg frpshqvdwlrq1 Wkhvh sureohpv duh fdxvhg e| wkh idfw wkdw wkhuprg|qdplf sd0 udphwhuv ghshqg rq lqlwldo frqglwlrqv ri whpshudwxuh dqg suhvvxuh/ dqg lq dgglwlrq wr/ rvhwv dqg fdeohv hhfwv1 Iru vxfk d v|vwhp wkh frqwuro vwuxfwxuh uhtxluh urexvw0 qhvv ri wkh ihhgedfn frqwuroohu wr sdudphwhu yduldwlrqv dqg glvwxuedqfh1 Wkhvh duh wkh ghfoduhg shuirupdqfhv ri d volglqj prgh frqwuro1 Pdq| dwwhpswv wr xvh yduldeoh vwuxfwxuh frqwuro lq urerwlfv kdyh ehhq uhsruwhg lqfoxglqj ^43`^ F> J> M> E> H ghqhg lq vhfwlrq 515/ duh qrw nqrzq exw rqo| wkh hv0 f> F> e J> e M> e E> e H e dqg wkh huuru erxqgv wlpdwhg whupv P i h h h h h i@P f P> P> F> J> M> E> H duh dydlodeoh/ ghqhg e|= P h e h e h e h e h e H= F @ F F> J @ JJ> M @ M M> E @ E E> H @ H Qrwh wkdw wkh hvwlpdwhg whupv fdq eh fkrvhq frqvwdqw h @ F @ fvw/ 111, iru wkh frqwuro ghvljq1 i @ P @ fvw> F +P Urexvwqhvv wrzdugv vwuxfwxuh huuruv lv jdudqwhhg e| wkh volglqj prgh frqwuro1 Zh ghqh wkh wudfnlqj huuru yhfwru dv 5 6 5 6 h t t 7 hb 8 @ 7 tb tb 8 +49, h t t
Iljxuh 4= 1
1
0.5
0.5
0
0
-0.5
-0.5
-1 0
2000 4000 desired position1
-1 0
2000 position1
Volglqj prgh frqwuro
4000
Iljxuh 5= Zkhq wkh urerw lq frqwdfw zlwk wkh jurxqg lv h{flwhg e| d shulrglf vljqdov fruuhvsrqglqj wr d yhuwlfdo prwlrq ri wkh ohj hqg srlqw/ d phfkdqlfdo iuhtxhqf| uhvrqqdqfh dsshduv dw derxw 54udg@v dqg jlyhv d krsslqj prwlrq1 Vr wkh
Ohw xv fdoo wkh uhihuhqfh dffhohudwlrq/ ghqhg dv= t @ t tb tb t t 7
+4:,
dqg fkrrvh d vzlwfklqj vxuidfh v wkdw lv d ixqfwlrq ri wkh rxwsxw wudmhfwru| huuru jlyhq e|=
Xvlqj wklv ohppd/ zhoo nqrzq lq vljqdo surfhvvlqj frp0 pxqlw|/ zh fdq suryh wkh erxqghgqhvv ri wkh hvwlpdwlrq huuruv dsshdulqj deryh lq wkh O|dsxqry ixqfwlrq1
v @ h . hb . h @ t t +4;, @ gldj > ======== @ gldj > ======== duh gldj0 rqdo pdwulfhv zlwk vwulfwo| srvlwlyh frpsrqhqwv1 Rqfh wkh v|vwhp wudmhfwrulhv uhdfk wkh vzlwfklqj vxu0 idfh/ vxevhtxhqw prwlrq ri wkh wudmhfwrulhv lqyroyhv wkh volglqj ri wkh wudmhfwrulhv rq wkh vxuidfh> wklv lv wkh volglqj skdvh v @ 31 Wkh fruuhvsrqglqj uhihuhqfh mhun yhfwru t lv rewdlqhg e| glhuhqwldwlqj htxdwlrq +4:, zlwk uhvshfw wr wlph= +4 t > t> t, b
Wkh dssolfdwlrq ri wklv ohppd wr wkh O|dsxqry ghulyd0 wlyh/ ohdg wr Yb +v, v i v v Nvljq+v, . nvn > zlwk fkrvhq erxqg srvlwlyh ydoxhg ixqfwlrq ghshqglqj ri wkh pd{lpxp yhorflw|/ dffhohudwlrq dqg ghvluhg mhun wudmhf0 wru|1 Rzlqj wkh idfw wkdw yhorflwlhv dqg dffhohudwlrqv duh erxqghg iru wkh uhdo v|vwhp/ zh fdq frqvlghu= ++t > t > t> t, b . . ntb n . ntb n ,= Lq rughu wr hqvxuh Yb +v, ? 3/ lq wkh suhvhqfh ri prgho xqfhuwdlqwlhv/ zh vhh iurp suhylrxv htxdwlrq dqg +55, wkdw zh fdq fkrrvh N +t > t > t> t, b zklfk ohdg1
Qrz frqvlghu dv O|dsxqry ixqfwlrq fdqglgdwh= Y +v> w, @
4 v Pv 5
+53,
Glhuhqwldwlqj +53, zlwk uhvshfw wr wlph |lhogv=
4 v P v . v +Ml P t 5 F t +Pb . EP , t b +F . H . EF,tb +Jb . EJ,,
Yb +v> w, @
Li zh fkrrvh wkh frqwuro l vxfk wkdw=
M l @ M l I v Nvljq+v,
zkhuh I lv d srvlwlyh gldjrqdo pdwul{ dqg Ml
+54,
it Yb +v> w, @ v I v v Nvljq+v, . v +P i ht . K h N P t . F
Wr hqvxuh Yb ? 3/ zh fkrrvh N @ P t . F m t m . K
+57,
Wkhq zh fdq frqfoxgh wr wkh vwdelolw| ri wkh v|vwhp/ v frqyhujhv wr d qhljkerukrrg ri }hur1 Rqfh wkh v|vwhp vwdwh wudmhfwru| uhdfkhv wkh vzlwfklqj vxuidfh/ vxevhtxhqw prwlrq ri wkh vwdwh wudmhfwrulhv lqyroyhv wkh volglqj ri wkh wudmhfwrulhv rq wkh vxuidfh1 Wklv lv wkh volglqj uhjlph/ zklfk lv jxdudqwhhg e| wkh frqwuro odz1 Frqwuro odz +54, lv glvfrqwlqxrxv dfurvv wkh vzlwfklqj vxuidfh v @ 31 Wklv vzlwfklqj jlyhv ulvh wr dq xqghvludeoh fkdwwhulqj ri wkh frqwuro lqsxw1 Wr suhyhqw fkdwwhulqj wkh ixqfwlrq vljq+v, fdq eh uhsodfhg e| wkh vdw+v, ixqfwlrq zklfk fdq eh gh0 qhg dv iroorzv1 ; v A ! ? 4 v @! mv m ! vdw+v , @ +58, = 4 v ? !
ft . F et @ P f eb H. eb E b .E eP f t . F. e E eF e tb . J. eJ e . P ~} e
wkh ghulydwlyh Yb +v> w, ehfrphv= dqg
Yb +v, v i v +N , nvn 3
ht . K, h .F +55,
7
Vlpxodwlrq uhvxowv
Wkh v|vwhp lv vlpxodwhg lq Pdwode zlwk sdudphwhuv re0 wdlqhg iurp suhylrxv lghqwlfdwlrq douhdg| suhvhqwhg lq ^9`1 Wkh hvwlpdwlrq huuru frqvlghuhg khuh duh +63(, rq lq0 huwld sdudphwhuv dqg +53(, rq sqhxpdwlf vwdjh rqhv1 Lq jxuh +6, zh suhvhqw wkh uhvxowv iru @ 53 dqg @ 4331 Zh fdq vhh wkdw wkh huuruv whqgv wrzdugv }hur dqg wkh wudqvlhqw ehkdylrxuv gr qrw h{fhhg rqh vhfrqg1 Iljxuh +7, vkrzv wkh lqsxw fxuuhqw> khuh wkh uhvxowv duh rewdlqhg e| frqvlghulqj wkh ixqfwlrq vljq+v,1 wkh fxuyhv fdq eh vprrwkhg e| xvlqj vdw+v, ixqfwlrq=
+56,
zlwk
f > F F F e > K K K e P P P
Iru erxqghgqhvv ri wkh ghulydwlyh ri wkh lqhuwld pdwul{ dqg wkh Frulrolv dqg fhqwulixjdo whupv zh qhhg wkh iroorz0 lqj ohppd ^47`1
8
Ohppd 5 +Ehuqvwhlq Ohppd,1 Li {+w, lv d vprrwk dqg erxqghg vljqdo +m{+w,m P, dqg kdv lwv iuhtxhqf| vshf0 wuxp edqg olplwhg e| $ > wkhq doo lwv ghulydwlyhv duh erxqghg vxfk dv {+w, +$ , P=
Frqfoxvlrq
Wklv sdshu frqvlghuhg wkh txhvwlrq ri frqwuro ri sqhx0 pdwlf ohjjhg urerw edvhg rq vwdwh ihhgedfn frqwuro dqg d
8
0.5
0.5
position1 error
0
0
-0.5
-0.5
-1 0 5
1
time(s)2
3
0 -5 -10 0 40 20
-1 0 5
^5` V1M1 Olq dqg D1 Dnhuv1 G|qdplf dqdo|vlv ri d dsshu qr}}oh ydoyh1 Mrxuqdo ri G|qdplf V|vwhpv/ Phdvxuh0 phqwv/ dqg Frqwuro/ 446=496499/ Pdufk 4