A nonlinear tracking controller for a haptic interface steer-by-wire systems
-
Upload
independent -
Category
Documents
-
view
0 -
download
0
Transcript of A nonlinear tracking controller for a haptic interface steer-by-wire systems
D Qrqolqhdu Wudfnlqj Frqwuroohu iru d Kdswlf LqwhuidfhVwhhu0e|0Zluh V|vwhpv
S1 Vhwoxu/ G1 Gdzvrq/ M1 Fkhq/ M1 ZdjqhuDxwrprwlyh Uhvhdufk Oderudwru|
Ioxru Gdqlho Hqjlqhhulqj Lqqrydwlrq Exloglqj/ Fohpvrq Xqlyhuvlw|Fohpvrq/ Vrxwk Fdurolqd 5<967
yrlfh= +;97, 9890:6:9> id{= +;97, 9890:553hpdlo= mzdjqhuCfohpvrq1hgx
Devwudfw
D qrqolqhdu wudfnlqj frqwuroohu lv suhvhqwhg lq wklv sdshu iru wkh kdswlf lqwhuidfh lq vwhhu0e|0zluh dxwrprwlyh v|vwhpv1 Vshfl�fdoo|/ wkh frqwuroohu lv ghvljqhg wr hqvxuh wkdw wkh vwhhulqjphfkdqlvp +l1h1/ gluhfwlrqdo frqwuro dvvhpeo|, iroorzv wkh rshudwru frppdqghg pdqhxyhuv dwwkh gulyhu lqwhuidfh1 Ixuwkhu/ wkh frqwuroohu surylghv wkh gulyhu zlwk wxqdeoh irufh ihhgedfn/sursruwlrqdo wr wkh uhdfwlrq irufhv dw wkh wluh0urdg lqwhuidfh/ dqg khqfh hqkdqfhv wkh gulyhu*vshuirupdqfh1 Wkh frqwuroohu hqvxuhv wkdw wkh fruuhvsrqglqj wudfnlqj huuruv duh dv|pswrwlfdoo|irufhg wr }hur lq wkh suhvhqfh ri sdudphwulf xqfhuwdlqlw|> krzhyhu/ wrutxh phdvxuphqwv duhuhtxluhg1 Dq h{whqwlrq lv dovr suhvhqwhg wkdw holplqdwhv wrutxh phdvxuhphqwv1 Uhsuhvhqwdwlyhvlpxodwlrq uhvxowv duh suhvhqwhg wr looxvwudwh wkh shuirupdqfh ri wkh sursrvhg frqwuroohu iruydulrxv gulylqj vfhqdulrv1
4 LqwurgxfwlrqZlwk uhvhdufk irfxv lq wkh dxwrprwlyh lqgxvwu| vkliwlqj wr k|eulg ru hohfwulf yhklfohv dqg vwhhu0e|0zluh v|vwhpv lq uhfhqw |hduv/ wkh qhhg iru irufh ihhgedfn v|vwhpv lq yhklfohv kdv jdlqhg lpsruwdqfh1Wkh lpsruwdqfh ri irufh ihhgedfn kdv ehhq zhoo xqghuvwrrg lq erwk wkh dxwrprwlyh dqg wkh whoh0rshudwhg urerwlfv �hog1 Dv grfxphqwhg lq ^8`/ irufh ihhgedfn lv rqh ri wkh kljkhvw udwhg lqsxwv wrwkh gulyhu diwhu ylvlrq1 Zkloh irufh ihhgedfn surylghv wkh gulyhu zlwk dq lqydoxdeoh lqsxw/ h{fhvvlyhihhgedfn uhvxowv lq wkh qhhg iru odujh gulyhu irufhv wr vwhhu wkh v|vwhp1 Khqfh/ lw lv hvvhqwldo iru wkhfrqwuro vwudwhj| wr hqvxuh wkdw wkh �urdg ihho� surylghg e| wkh irufh ihhgedfn fdq eh dgmxvwhg wrsurylgh d frpiruwdeoh gulylqj hqylurqphqw1 Pdq| uhvhdufkhuv kdyh zrunhg rq hvwdeolvklqj d prghoiru wkh v|vwhp dqg shuiruplqj h{shulphqwv wr lghqwli| sdudphwhuv ri wkh v|vwhp zlwk wkh lqwhqwlrqri surylglqj vlpxodwhg irufh ihhgedfn +^8`/ ^45`/ ^5`,1 Lq ^:`/ ghwdlohg prghov ri wkh frqyhqwlrqdo/srzhu dvvlvw dqg vwhhu0e|0zluh vwhhulqj v|vwhpv kdyh ehhq suhvhqwhg1 Lq ^6`/ wkh dxwkruv ghvljq dix}}| orjlf frqwuroohu iru dfwlyh vwhhulqj v|vwhp wkdw suhyhqwv yhklfoh vslq lq zhw urdg frqglwlrqv1 Lq^7`/ d qryho urerw frqwuro vwudwhj| lv ghvljqhg wr irufh orfnlqj ehwzhhq wkh sulpdu| dqg vhfrqgdu|v|vwhp zkloh hqvxulqj sdvvlylw|1
Lq wklv sdshu/ d ixoo vwdwh ihhgedfn frqwuroohu lv ghvljqhg wr irufh �orfnlqj� dqg surylgh wkh ghvluhgihhgedfn1 Wkh ghvljq lv prwlydwhg e| wkh lpshgdqfh frqwuro frqfhsw ^;` lq zklfk d wdujhw v|vwhp lv
4
xvhg wr jhqhudwh wkh uhihuhqfh vljqdo iru wkh sulpdu| v|vwhp1 Wkh frqwuroohu dgdswv iru sdudphwulfxqfhuwdlqwlhv lq wkh v|vwhp zkloh hqvxulqj joredo dv|pswrwlf wudfnlqj iru wkh �gulyhu h{shulhqfhhuuru� dqg wkh �orfnhg huuru�> krzhyhu/ wrutxh phdvxuhphqwv duh uhtxluhphqw1 Wr holplqdwh wrutxhphdvxuhphqwv/ zh ohyhudjh r� d uhfhqw lghd irxqg lq ^43` wr ghyhors d wrutxh revhuyhuv iru wkhghvljq ri dq h{dfw prgho nqrzohgjh wudfnlqj frqwuroohu1 Wkh frqwuroohu hqvxuhv wkdw wkh wrutxhrevhuydwlrq huuru frqyhujhv dv|pswrwlfdoo| wr }hur zkloh dovr hqvxulqj joredo dv|pswrwlf wudfnlqjiru wkh gulyhu h{shulhqfh huuru dqg wkh orfnhg huuru1 Urxjko| vshdnlqj/ wkh wrutxh revhuyhu ghvljqeruurzv frqfhswv iurp urexvw frqwuro whfkqltxhv wkdw rqo| lpsrvhv erxqghgqhvv dqg vprrwkqhvvuhvwulfwlrqv rq wkh xqphdvxudeoh wrutxh vljqdov1
Wkh sdshu lv rujdql}hg dv iroorzv1 Lq Vhfwlrq 5/ wkh frqwuro remhfwlyhv duh vwdwhg1 Lq Vhfwlrq 6/ wkhv|vwhpprgho irLq Vhfwlrq 7/ wkh ghvljq u wkh vwhhulqj v|vwhp dorqj zlwk wkh wdujhw vljqdo jhqhudwru lvsuhvhqwhg iroorzhg e| wkh rshq0orrs wudfnlqj g|qdplfv1 ri wkh sursrvhg dgdswlyh/ wudfnlqj frqwuroohulv suhvhqwhg dorqj zlwk wkh fruuhvsrqglqj forvhg0orrs huuru v|vwhp1 Wkh vwdelolw| dqdo|vlv lv jlyhqlq Vhfwlrq 81 Lq Vhfwlrq 9/ wkh frqwuroohu lv uhghvljqhg wr jhw dq h{dfw prgho nqrzohgjh wudfnlqjfrqwuroohu/ wkh holplqdwhv wrutxh phdvxuhphqwv/ iroorzhg e| uhsuhvhqwdwlyh qxphulfdo vlpxodwlrquhvxowv lq Vhfwlrq :1 Frqfoxglqj uhpdunv duh suhvhqwhg lq Vhfwlrq ;1
5 Sureohp VwdwhphqwWkh frqwuro remhfwlyh iru wkh vwhhu0e|0zluh kdswlf lqwhuidfh sureohp lv wzrirog1 Iluvw/ lw lv qhfhvvdu|wr hqvxuh wkdw gulyhu vwhhulqj dqjoh frppdqgv duh dffxudwho| iroorzhg> khqfh/ lw lv uhtxluhg wkdw wkhwrutxh frqwuro lqsxw surylghg e| wkh gulyhu prwru eh ghvljqhg wr hqvxuh wkdw wkh dqjxodu srvlwlrqri wkh gluhfwlrqdo frqwuro dvvhpeo| dffxudwho| wudfnv wkh gulyhu frppdqghg lqsxw1 Vhfrqgo|/ lw lvhvvhqwldo wr surylgh wkh gulyhu zlwk d uhdolvwlf �yluwxdo gulylqj h{shulhqfh�1 Wr wklv hqg/ d uhihuhqfhprgho/ ru wdujhw g|qdplfv iru wkh gulyhu lqsxw ghylfh/ lv ghvljqhg wr jhqhudwh wkh ghvluhg dqjxodusrvlwlrq ri wkh gulyhu lqsxw ghylfh1 Wkh frqwuro wrutxh/ surylghg e| wkh ihhgedfn prwru lv ghvljqhgwr hqvxuh wkdw wkh uhvsrqvh ri wkh gulyhu lqsxw ghylfh iroorzv wkdw ri wkh uhihuhqfh v|vwhp1
6 G|qdplf Prgho GhyhorsphqwGhwdlohg prghov iru frqyhqwlrqdo dqg srzhu dvvlvw vwhhulqj v|vwhpv fdq eh irxqg lq pdq| suhylrxvsdshuv lq wklv uhvhdufk duhd ^:`1 Wkh vwhhu0e|0zluh v|vwhp lqyroyhv wkh uhprydo ri wkh vwhhulqj froxpqsuhvhqw lq d frqyhqwlrqdo vwhhulqj v|vwhp dqg wkh lqwurgxfwlrq ri wzr vhuyr prwruv1 Wkh vwhhulqjv|vwhp lv wkxv vhsdudwhg lqwr wzr vxev|vwhpv1 Wkh �uvw vxev|vwhp/ uhihuuhg wr dv wkh sulpdu|v|vwhp/ frqvlvwv ri wkh gulyhu lqsxw ghylfh +h1j1/ vwhhulqj zkhho , dqg d vhuyr prwru wr surylgh wkhgulyhu zlwk irufh ihhgedfn1 Wkh vhfrqg vxev|vwhp/ uhihuuhg wr dv wkh vhfrqgdu| vxev|vwhp/ frqvlvwvri wkh gluhfwlrqdo frqwuro dvvhpeo| +h1j1/ udfn dqg slqlrq v|vwhp, dqg d vhuyr prwru wkdw surylghvwkh qhfhvvdu| wrutxh lqsxw wr gulyh wklv dvvhpeo| +dqg khqfh vwhhu wkh yhklfoh,1
614 Prgho Irupxodwlrq
Wkh ghwdlohg g|qdplfv ri wkh vwhhulqj v|vwhp/ dv suhvhqwhg lq ^:`/ pd| eh zulwwhq lq d vlpsol�hgirup dv iroorzv
U��w� n��
�w�c �w�
�' k�� � n A� +4,
U2�w2 n�2
�w2c �w2
�' k2� 2 n A2 +5,
5
zkhuh w�E|�/ �w�E|�/ �w�E|� 5 ?� ghqrwh wkh dqjxodu srvlwlrq/ yhorflw|/ dqg dffhohudwlrq/ uhvshfwlyho|/ri wkh gulyhu lqsxw ghylfh/ U�/ U2 5 ?�ghqrwh wkh lqhuwldv ri wkh gulyhu lqsxw ghylfh dqg wkh yhklfohgluhfwlrqdo frqwuro dvvhpeo|/ uhvshfwlyho|1 ��
�w�c �w�
�5 ?� lv dq dx{loldu| qrqolqhdu ixqfwlrq wkdw
lv xvhg wr ghvfulehg wkh g|qdplfv rq wkh gulyhu vlgh/ � �E|� 5 ?� ghqrwhv wkh gulyhu lqsxw wrutxh/A�E|� 5 ?� ghqrwhv d frqwuro lqsxw wrutxh dssolhg wr wkh gulyhu lqsxw ghylfh/ w2E|�/ �w2E|�/ �w2E|� 5 ?�
ghqrwh wkh dqjxodu srvlwlrq/ yhorflw|/ dqg dffhohudwlrq/ uhvshfwlyho|/ ri wkh yhklfoh gluhfwlrqdo frqwurodvvhpeo|/ �2
�w2c �w2
�5 ?� lv dq dx{loldu| qrqolqhdu ixqfwlrq wkdw lv xvhg wr ghvfulehg wkh g|qdplfv
ri wkh yhklfoh gluhfwlrqdo frqwuro dvvhpeo|/ � 2E|� 5 ?� ghqrwhv wkh uhdfwlrq wrutxh ehwzhhq wkhdfwxdwru rq wkh gluhfwlrqdo frqwuro dvvhpeo| dqg phfkdqlfdo vxev|vwhp dfwxdwhg e| wkh gluhfwlrqdofrqwuro dvvhpeo|/ dqg A2E|� 5 ?� ghqrwhv d frqwuro lqsxw wrutxh dssolhg wr wkh gluhfwlrqdo frqwurodvvhpeo|1 Wkh frqvwdqwv k�c k2 5 ?� duh vfdolqj idfwruv wkdw frxog dulvh gxh wr jhdulqj lq wkhv|vwhp1
Uhpdun 4 Wkh gdpslqj dqg iulfwlrq h�hfwv prghohg e| �� E�� dqg �2 E�� duh dvvxphg wr eh olqhduo|sdudphwhul}deoh dv
��
�w�c �w�
�' t��
�w�c �w�
����
�2
�w2c �w2
�' t�2
�w2c �w2
���2
�
zkhuh t�� E�� 5 ?�fR/ t�2 E�� 5 ?�f^duh uhjuhvvlrq pdwulfhv frqwdlqlqj wkh phdvxudeoh vljqdov/ dqg��� 5 ?Rf�/ ��2 5 ?^f� duh frqvwdqw pdwulfhv frqwdlqlqj wkh xqnqrzq sdudphwhuv lq wkh prgho
�� E�� dqg �2 E��1 Ixuwkhu/ lw lv dovr dvvxphg wkdw li w� E|� c �w� E|� 5 O" wkhq ��
�w�c �w�
�5 O" dqg
li w2 E|� c �w2 E|� 5 O" wkhq �2
�w2c �w2
�5 O"1
615 Uhihuhqfh Prgho Ghyhorsphqw
Dv phqwlrqhg lq Vhfwlrq 5/ rqh frqwuro remhfwlyh lv wr surylgh wkh gulyhu zlwk d �ihho� iru wkh urdg1Wr wklv hqg/ vrph frqfhswv dvvrfldwhg zlwk lpshgdqfh frqwuro frqfhsw ^;` xvhg riwhq iru urerwpdqlsxodwru srvlwlrq2irufh frqwuro sureohpv kdyh ehhq eruurzhg1 Vshfl�fdoo|/ d uhihuhqfh prgho/ru wkh wdujhw g|qdplfv iru wkh gulyhu lqsxw ghylfh/ lv ghvljqhg dv iroorzv
UA�w_� n�A
�w_�c �w_�
�' kA�� � n kA2� 2 +6,
zkhuh w_�E|�/ �w_�E|�/ �w_�E|� 5 ?� ghqrwh wkh ghvluhg dqjxodu srvlwlrq/ yhorflw|/ dqg dffhohudwlrq/
uhvshfwlyho|/ ri wkh gulyhu lqsxw ghylfh/ �A
�w_�c �w_�
�5 ?� ghqrwhv dq dx{loldu| wdujhw g|qdplf
ixqfwlrq iru wkh gulyhu lqsxw ghylfh/ dqg kA�/ kA2 5 ?� duh vfdolqj frqvwdqwv1 Wkh vwuxfwxuhiru +6, lv prwlydwhg e| wkh iroorzlqj revhuydwlrq1 Li A�E|� zdv h{dfwo| htxdo wr k2� 2E|� lq +5,/wkhq wkh g|qdplfv jlyhq e| +4, zrxog jlyh wkh gulyhu d uhdolvwlf gulyhu h{shulhqfh surylghg wkhdx{loldu| whup �� E�� lq +5, frxog eh ghvljqhg ru frqvwuxfwhg dffruglqj wr vrph ghvludeoh phfkdqlfdouhvsrqvh1 Dorqj wklv olqh uhdvrqlqj/ wkh �A E�� whup lq +6, lv ghvljqhg wr vlpxodwh wkh ghvluhg gulylqjh{shulhqfh/ dqg khqfh/ wkh g|qdplfv jlyhq e| +6, vhuyhv dv d ghvluhg wudmhfwru| jhqhudwru iru frqwuroghvljq sxusrvhv iru +4,1
Uhpdun 5 Wkh wdujhw g|qdplf ixqfwlrq �A E�� pxvw eh vhohfwhg wr hqvxuh wkdw wkh ghvluhg gulyhulqsxw ghylfh wudmhfwru| dqg lwv �uvw wzr ghulydwlyhv uhpdlq erxqghg dw doo wlph +l1h1/ w_� E|�/ �w_� E|�/�w_� E|� 5 O",1 Iru h{dpsoh/ vxssrvh �A E�� lv vhohfwhg dv iroorzv
�A ' �A�w_� ngA w_� +7,
6
zkhuh �A / gA 5 ?� duh vrph srvlwlyh ghvljq frqvwdqwv1 Zlwk �A E�� vhohfwhg dffruglqj wr +7,/vwdqgdug olqhdu dujxphqwv fdq eh hpsor|hg wr vkrz wkdw w_� E|�/ �w_� E|�/ �w_� E|� 5 O"1 �A E�� fdqdovr frqvwuxfwhg wr eh d qrqolqhdu �gdpslqj� ixqfwlrq e| xwlol}lqj O|dsxqry w|sh dujxphqwv1
616 Rshq0Orrs Huuru V|vwhp Ghyhorsphqw
Wr txdqwli| wkh plvpdwfk ehwzhhq wkh wdujhw v|vwhp dqg wkh sulpdu| v|vwhp +wkh �gulyhu h{shulhqfhwudfnlqj huuru�,/ dqg ehwzhhq wkh sulpdu| dqg wkh vhfrqgdu| v|vwhp +wkh �orfnhg wudfnlqj huuru�,/�owhuhg huuru vljqdov/ o� E|�/ o2 E|� 5 ?� duh gh�qhg dv iroorzv
o� ' �e� n >�e� +8,
o2 ' �e2 n >2e2 +9,
zkhuh >�c >
25 ?� uhsuhvhqw srvlwlyh frqwuro jdlqv/ dqg wkh huuru vljqdov e� E|�/ e2 E|� 5 ?� duh gh�qhg
dve� ' w_� � w� +:,
e2 ' w� � w2� +;,
Diwhu wdnlqj wkh �uvw wlph ghulydwlyh ri htxdwlrqv +8, dqg +9,/ dqg vxevwlwxwlqj wkh g|qdplfv jlyhqlq htxdwlrqv +4, dqg +5, dqg wkh wdujhw v|vwhp jlyhq lq htxdwlrq +6,/ wkh rshq orrs huuru v|vwhpviru wkh wzr v|vwhpv fdq eh zulwwhq dv iroorzv
U� �o� ' t���� A� +<,
U2 �o2 ' t2�2� A2 +43,
zkhuh t� E�� 5 ?�fo/ t2 E�� 5 ?�fr duh uhjuhvvlrq pdwulfhv frqvlvwlqj ri phdvxudeoh txdqwlwlhv/ dqg��5 ?of�/ �
25 ?rf� duh frqvwdqw xqnqrzq yhfwruv1 H{solflw gh�qlwlrqv iru t� E�� c t2 E�� c ��
c dqg�2 duh jlyhq lq Dsshqgl{ D1
Uhpdun 6 Edvhg rq wkh gh�qlwlrq ri o� E|� dqg o2 E|� jlyhq lq htxdwlrqv +8, dqg +9,/ vwdqgdugdujxphqwv ^4` fdq eh xvhg wr suryh wkdw= +l, li o� E|�/ o2 E|� 5 O"/ wkhq e� E|�/ e2 E|�/ �e� E|�/ �e2 E|� 5O"/ dqg +ll, li o� E|� dqg o2 E|� duh dv|pswrwlfdoo| uhjxodwhg/ wkhq e� E|� dqg e2 E|� duh dv|pswrwlfdoo|uhjxodwhg1
7 Frqwuro GhyhorsphqwLq oljkw ri wkh huuru gh�qlwlrqv lq Vhfwlrq 616/ wkh frqwuro remhfwlyh/ lv wkh ghvljq ri d frqwuroohu wkdwdv|pswrwlfdoo| irufhv wkh wdujhw iroorzlqj dqg orfnlqj wudfnlqj huuru vljqdov wr }hur zkloh dgdswlqjiru wkh v|vwhp sdudphwhuv wkdw duh dvvxphg wr eh xqnqrzq1 Lw lv dvvxphg wkdw wkh vljqdov w� E|�/w2 E|�/ �w� E|�/ �w2 E|�/ � � E|�/ dqg � 2 E|� duh dydlodeoh iru phdvxuhphqw1 Lw lv dovr dvvxphg wkdw � � E|�/� 2 E|� 5 O"1
7
714 Frqwuro Irupxodwlrq
Edvhg rq wkh vxevhtxhqw vwdelolw| dqdo|vlv dqg wkh vwuxfwxuh ri wkh rshq0orrs huuru v|vwhp jlyhq lqhtxdwlrqv +<, dqg +43,/ wkh frqwuro lqsxwv A� E|� dqg A2 E|� duh qrz ghvljqhg wr eh dv iroorzv
A� ' &�o� n t���+44,
A2 ' &2o2 n t2�2 +45,
zkhuh &�c &2 5 ?� duh frqvwdqw srvlwlyh frqwuro jdlqv/ dqg ��E|� 5 ?of�c �
2E|� 5 ?rf� duh dgdswlyh
hvwlpdwhv iru wkh xqnqrzq sdudphwhu pdwulfhv1 Wkh dgdswlyh xsgdwh odzv duh ghvljqhg edvhg rqwkh vxevhtxhqw vwdelolw| dqdo|vlv dv
u
��' K�t
A�o� +46,
u
�2' K2tA2o2 +47,
zkhuh K� 5 ?ofocK2 5 ?rfr duh srvlwlyh frqvwdqw gldjrqdo jdlq pdwulfhv1
715 Forvhg0Orrs Huuru V|vwhp Ghyhorsphqw
Diwhu vxevwlwxwlqj wkh frqwuro wrutxhv jlyhq lq htxdwlrqv +44, dqg +45, lqwr wkh rshq0orrs g|qdplfvjlyhq lq htxdwlrqv +<, dqg +43, uhvshfwlyho|/ wkh forvhg0orrs huuru v|vwhp lv rewdlqhg dqg fdq ehzulwwhq dv
U� �o� ' �&�o� n t���� +48,
U2 �o2 ' �&2o2 n t2��2 +49,
zkhuh wkh sdudphwhu hvwlpdwlrq huuru vljqdov/ ghqrwhg e| ��� E|� 5 ?of�c ��2 E|� 5 ?rf� duh gh�qhg dv
���' �
�� �
�+4:,
��2 ' �2 � �2� +4;,
8 Vwdelolw| Dqdo|vlvWkhruhp 4 Jlyhq wkh forvhg0orrs v|vwhp ri +48, dqg +49,/ wkh wudfnlqj huuru vljqdov gh�qhg lq+:, dqg +;, duh joredoo| dv|pswrwlfdoo| uhjxodwhg lq wkh vhqvh wkdw
*�4|<"
e� E|� c e2 E|� ' f� +4<,
Surri = Wr suryh Wkhruhp 4/ d qrq0qhjdwlyh/ vfdodu ixqfwlrq/ ghqrwhg e| T E|� 5 ?�/ lv gh�qhgdv iroorzv
T '�
2U�o
2
�n
�
2U2o
2
2n
�
2��A
�K3�����n
�
2��A
2K3�2��2� +53,
Diwhu wdnlqj wkh wlph ghulydwlyh ri htxdwlrq +53, dqg pdnlqj wkh dssursuldwh vxevwlwxwlrqv iurphtxdwlrqv +48,/ +49,/ +4:,/ dqg +4;,/ wkh iroorzlqj h{suhvvlrq lv rewdlqhg
�T ' o�
k�&�o� n t����
l+54,
no2k�&2o2 n t2��2
l
���A
�
�t A�o��
���A
2
�t A2o2��
8
zkhuh wkh idfw wkdw K�cK2 duh frqvwdqw gldjrqdo jdlq pdwulfhv kdv ehhq xwlol}hg dorqj zlwk wkhiroorzlqj htxdolwlhv1
u
���' �u
��
u
��2' �u
�2 �
Diwhu fdqfhoolqj frpprq whupv/ lw lv hdv| wr vhh wkdw zh fdq xsshu erxqg �T E|� dv iroorzv
�T � �&�o2
�� &2o
2
2� +55,
Iurp htxdwlrqv +55, dqg +53,/ lw lv vwudljkwiruzdug wr vhh wkdw o� E|�/ o2 E|�/ ��� E|�/ ��2 E|� 5 O"1Diwhu xwlol}lqj htxdwlrqv +4:,/ +4;,/ dqg Uhpdun 6/ zh fdq frqfoxgh wkdw e� E|�/ �e� E|�/ e2 E|�/ �e2 E|�/�� E|�/ �2 E|� 5 O"1 Xvlqj Uhpdun 5/ htxdwlrqv +:,/ +;, dqg wkhlu �uvw ghulydwlyhv/ lw lv fohdu wkdww� E|�/ w2 E|�/ �w� E|� �w2 E|� 5 O"1 Iurp wkh h{solflw gh�qlwlrq iru t� E�� jlyhq lq Dsshqgl{ D dqgxvlqj wkh idfw wkdw � � E|�/ � 2 E|� 5 O"/ lw lv hdv| wr vhh wkdw t� E�� 5 O"1 Iurp htxdwlrq +44,/ lwlv fohdu wkdw wkh frqwuro wrutxh A� E|� 5 O"1 Djdlq/ iurp wkh gh�qlwlrq ri t2 E�� lq Dsshqgl{ Ddqg iurp wkh deryh idfwv/ t2 E�� 5 O"1 Iurp htxdwlrq +45,/ lw lv fohdu wkdw A2 E|� 5 O"1 Xvlqjvwdqgdug vljqdo fkdvlqj dujxphqwv/ lw fdq eh vkrzq wkdw doo wkh vljqdov lq wkh forvhg0orrs v|vwhpuhpdlq erxqghg1 Lq sduwlfxodu/ iurp htxdwlrq +48, dqg +49,/ �o� E|�/ �o2 E|� 5 O"1 Diwhu hpsor|lqj dfruroodu| wr Eduedodw*v Ohppd ^9`/ lw lv hdv| wr vkrz wkdw
*�4|<"
o� E|� c o2 E|� ' f�
Ilqdoo|/ Uhpdun 6 fdq eh xvhg wr suryh wkh uhvxow vwdwhg lq htxdwlrq +4<,1�
9 H{whqvlrq= Holplqdwlrq ri Wrutxh PhdvxuhphqwvLq wklv vhfwlrq/ lw lv vkrzq wkdw iru wkh v|vwhp htxdwlrqv jlyhq lq +4, dqg +5,/ d frqwuroohu fdq ehghvljqhg wr holplqdwh wkh qhhg iru wrutxh vhqvruv +l1h1/ lw lv dvvxphg wkdw wkh gulyhu lqsxw wrutxh/ghqrwhg e| � � E|�/ dqg wkh uhdfwlrq wrutxh ehwzhhq wkh dfwxdwru rq wkh gluhfwlrqdo frqwuro dvvhpeo|dqg phfkdqlfdo vxev|vwhp dfwxdwhg e| wkh gluhfwlrqdo frqwuro dvvhpeo|/ ghqrwhg e| � 2 E|�/ duh qrwdydlodeoh iru phdvxuhphqw,1 Iru frqwuro ghvljq sxusrvhv/ lw dvvxphg wkdw wkh g|qdplf prgho jlyhq+4, dqg +5, lv h{dfwo| nqrz zlwk wkh h{fhswlrq ri wkh wrutxh vljqdov � � E|� dqg � � E|�1 Lq dgglwlrq lwlv dvvxphg wkdw wkh vljqdov w� E|�/ w2 E|�/ �w� E|�/ dqg �w2 E|� duh dydlodeoh iru phdvxuhphqw1 Wr dffrxqwiru wkh odfn ri wrutxh phdvxuphqwv/ wkh wrutxh revhuydwlrq huuruv/ ghqrwhg e| �� � E|�/ �� 2 E|� 5 ?�/duh gh�qhg dv iroorzv
�� � ' � � � � � +56,
�� 2 ' � 2 � � 2 +57,
zkhuh � � E|�/ � 2 E|� 5 ?� ghqrwh wkh |hw wr eh ghvljqhg revhuyhu vljqdov iru wkh gulyhu lqsxw wrutxhdqg wkh uhdfwlrq wrutxh/ uhvshfwlyho|1 Wkh wdujhw g|qdplfv duh qrz jhqhudwhg dv iroorzv
UA�w_� n�A
�w_�c �w_�
�' kA�� � n kA2� 2� +58,
Uhpdun 7 Lw lv dvvxphg wkdw wkh gulyhu lqsxw wrutxh � � E|� dqg wkh uhdfwlrq wrutxh � 2 E|� dqg wkhlu�uvw wzr ghulydwlyhv uhpdlq erxqghg dw doo wlphv +l1h1/ � � E|�/ �� � E|�/ �� � E|�/ � 2 E|�/ �� 2 E|�/ �� 2 E|� 5 O",1
9
914 Rshq0Orrs Huuru V|vwhp Ghyhorsphqw
Diwhu wdnlqj wzr wlph ghulydwlyhv ri +:, dqg +;,/ dqg vxevwlwxwlqj wkh g|qdplfv jlyhq lq htxdwlrqv+4, dqg +5, dqg wkh wdujhw g|qdplfv jlyhq lq htxdwlrq +58,/ wkh rshq orrs huuru v|vwhpv iru wkh wzrv|vwhpv fdq eh zulwwhq dv
�e� '
��
UA
�E��A E�� n kA�� � n kA2� 2��
��
U�
�E��� E�� n k�� � n A�� +59,
�e2 '
��
U�
�E��� E�� n k�� � n A���
��
U2
�E��2 E�� n k2� 2 n A2� � +5:,
Lq rughu wr vlpsoli| ixuwkhu dqdo|vlv/ wzr �owhuhg wudfnlqj huuru vljqdov/ ghqrwhg e| r� E|�/ r2 E|� 5 ?�/duh gh�qhg lq wkh iroorzlqj pdqqhu
r� ' �e� n Eq�n �� �e� n q
�e� +5;,
r2 ' �e2 n Eq�n �� �e2 n q
�e2 +5<,
zkhuh q� 5 ?� lv d frqvwdqw srvlwlyh frqwuro jdlq1
915 Frqwuro Ghyhorsphqw
Edvhg rq wkh vxevhtxhqw vwdelolw| dqdo|vlv/ vxevhtxhqw frqwuro ghvljq/ dqg wkh vwuxfwxuh ri wkhrshq0orrs huuru v|vwhp jlyhq e| htxdwlrqv +59, dqg +5:,/ wkh gulyhu lqsxw wrutxh revhuyhu dqg wkhuhdfwlrq wrutxh revhuyhu duh ghvljqhg dv iroorzv
u
� �' � Eq� ngr n �� � � � U�k�
dEq� ngr Eq� n ��� �e� ngrq�e� n 4�r}? ER��o +63,
u
� 2 ' � Eq�ngr n �� � 2 +64,
� U2k2
�Eq� ngr Eq� n ��� �e2 ngrq�e2 �
k�
U�
�u
� � nEq� ngr n �� � �
�n 42r}? ER2�
�
zkhuh r}? E�� ghqrwhv wkh vwdqgdug vljqxp ixqfwlrq/ gr/ 4�/ 4� 5 ?� duh d srvlwlyh frqwuro jdlqvdqg wkh dx{lodu| vljqdov R� E|�/ R2 E|� 5 ?� duh gh�qhg dv iroorzv
R� ' �e� n q�e� +65,
R2 ' �e2 n q�e2 +66,
zkhuh q� zdv lqwurgxfhg lq +5;, dqg +5<,1 Edvhg rq wkh vxevhtxhqw vwdelolw| dqdo|vlv/ wkh frqwurolqsxwv A� E|� dqg A2 E|� duh ghvljqhg dv iroorzv
A� ' �� E�� n�U�UA
�E��A E�� n kA�� � n kA2� 2�� k�� � +67,
A2 ' �2 E�� n�U2U�
�E��� E�� n A� n k�� ��� k2� 2� +68,
:
Uhpdun 8 Wr idflolwdwh wkh vxevhtxhqw vwdelolw| dqdo|vlv/ zh gh�qh wkh wzr dx{loodu| �glvwxuedqfhvljqdov�/ ghqrwhg e| #
�E|�/ #
2E|� 5 ?�/ dv iroorzv
#�'
�k�
U�
�E �� � n Eq
�ngr n �� � �� +69,
#2 '
�k2
U2
�E �� 2 n Eq2 ngr2 n �� � 2� � +6:,
Edvhg rq Uhpdun 7/ lw lv hdv| wr vhh wkdw #�E|�/ #
2E|�/ �#
�E|�/ �#
2E|� 5 O"1 Edvhg rq wkh gh�qlwlrqv
ri +69, dqg +6:,/ wkh vxevhtxhqw forvhg0orrs huuru v|vwhp ghyhorsphqw dqg wkh vwdelolw| dqdo|vlv duhidflolwdwhg e| vhohfwlqj wkh frqwuro jdlqv 4� dqg 42/ lqwurgxfhg lq +63, dqg +64,/ dv iroorzv
4�� m#
�mn
����_#� Ej�_j
���� +6;,
42� m#
2mn
����_#2 Ej�_j
����n 4�� +6<,
916 Forvhg0Orrs Huuru V|vwhp Ghyhorsphqw
Diwhu vxevwlwxwlqj wkh frqwuro wrutxhv jlyhq lq htxdwlrqv +67, dqg +68, lqwr wkh rshq0orrs g|qdplfvjlyhq lq htxdwlrqv +59, dqg +59,/ uhvshfwlyho|/ wkh forvhg0orrs huuru v|vwhp lv rewdlqhg dqg fdq ehzulwwhq dv iroorzv
�e� ' ��k�
U�
�E� � � � �� +73,
�e2 '
�k�
U�
�E� � � � ���
�k2
U2
�E� 2 � � 2� � +74,
Diwhu wdnlqj wkh �uvw wlph ghulydwlyh ri +5;, dqg +5<,/ dqg xvlqj +73,/ +74,/ dqg wkhlu �uvw ghulydwlyhv/wkh forvhg0orrs huuru v|vwhp fdq eh uhzulwwhq lq wkh iroorzlqj frqyhqlhqw irup
�r� ' �grr� � #� � 4�r}? ER�� +75,
�r2 ' �grr2 n #� � #2 � 42r}? ER2� +76,
zkhuh +69,/ +6:,/ +63,/ dqg +64, kdyh ehhq xwlol}hg1
Uhpdun 9 Edvhg rq wkh gh�qlwlrq ri r� E|� dqg r2 E|� jlyhq lq htxdwlrqv +5;, dqg +5<,/ h{whqvlrqvri wkh dujxphqwv pdgh lq ^4` fdq eh xvhg wr suryh wkdw= +l, li r� E|�/ r2 E|� 5 O"/ wkhq e� E|�/ e2 E|�/�e� E|�/ �e2 E|�/ �e� E|�/ �e2 E|� 5 O"/ dqg +ll, li r� E|� dqg r2 E|� duh dv|pswrwlfdoo| uhjxodwhg/ wkhq e� E|�/e2 E|�/ �e� E|�/ �e2 E|�/ �e� E|�/ �e2 E|� duh dovr dv|pswrwlfdoo| uhjxodwhg ^46`1
917 Vwdelolw| Surri
Wkhruhp 5 Jlyhq wkh forvhg0orrs v|vwhp ri +75, dqg +76,/ wkh wudfnlqj huuru vljqdov gh�qhg lq +:,dqg +;, dorqj zlwk wkh wrutxh revhuydwlrq huuruv gh�qhg lq +56, dqg +57, duh joredoo| dv|pswrwlfdoo|uhjxodwhg lq wkh vhqvh wkdw
*�4|<"
e� E|� / e2 E|� / �� � E|� / �� 2 E|� ' f� +77,
;
Surri = Wr suryh Wkhruhp 5/ d qrq0qhjdwlyh/ vfdodu ixqfwlrq/ ghqrwhg e| T@�E|� 5 ?�/ lv gh�qhgdv iroorzv
T@� '�
2r2�� +78,
Diwhu wdnlqj wkh wlph ghulydwlyh ri +78, dqg pdnlqj dssursuldwh vxevwlwxwlrqv iurp +75,/ wkh iro0orzlqj h{suhvvlrq lv rewdlqhg iru �T@� E|�
�T@� ' �grr2
�n E �R� n R�� E�#� � 4�r}? ER��� +79,
zkhuh wkh gh�qlwlrqv ri r� E|� dqg R� E|� jlyhq lq +5;, dqg +65, kdyh ehhq xwlol}hg1 Diwhu lqwhjudwlqjerwk vlghv ri +79,/ dqg shuiruplqj vrph pdwkhpdwlfdo pdqlsxodwlrqv +iru ghwdlov vhh Dsshqgl{ E,/wkh iroorzlqj lqhtxdolw| fdq eh rewdlqhg
T@� E|�� T@� E|f� � �gr
|]|f
r2�Ej� _j n
57
|]|f
mR� Ej�m�m#
�mn
����_#� Ej�_j
����� 4�
�_j
68 +7:,
n dmR�m Em#�m � 4��o n #� E|f� R� E|f� n 4� mR� E|f�m �Diwhu dsso|lqj wkh lqhtxdolw| jlyhq +6;, wr wkh eudfnhwhg whupv lq +7:,/ T@� E|� fdq eh xsshu erxqghgdv iroorzv
T@� E|� � T@� E|f��gr
|]|f
r2�Ej� _j n lf� +7;,
zkhuh lf� 5 ?� lv d srvlwlyh frqvwdqw zklfk lv h{solflwo| gh�qhg dv iroorzv
lf� ' #� E|f� R� E|f� n 4� mR� E|f�m � +7<,
Iru wkh huuru v|vwhp jlyhq lq +76,/ d vhfrqg qrq0qhjdwlyh/ vfdodu ixqfwlrq/ ghqrwhg e| T@2E|� 5 ?�/lv gh�qhg dv iroorzv
T@2 '�
2r22� +83,
Iroorzlqj d vlplodu dqdo|vlv wr wkdw suhvhqwhg deryh/ wkh iroorzlqj xsshu erxqg fdq eh rewdlqhgiru T@2E|�
T@2 E|� � T@2 E|f��gr
|]|f
r22Ej� _j n l
f2+84,
zkhuh lf2
5 ?� lv d srvlwlyh frqvwdqw zklfk fdq eh h{solflwo| gh�qhg dv iroorzv
lf2' #
2E|f� R2 E|f�� #
�E|f� R2 E|f� n 4
2mR2 E|f�m � +85,
Wr frpsohwh wkh dqdo|vlv/ wkh iroorzlqj frpsrvlwh qrq0qhjdwlyh/ vfdodu ixqfwlrq/ T@E|� 5 ?�/ lvgh�qhg dv iroorzv
T@ ' T@� n T@2 '�
2r2�n
�
2r22� +86,
Diwhu xvlqj wkh erxqgv iru T@�E|� dqg T@2E|� rewdlqhg lq +7;, dqg +84,/ wkh iroorzlqj xsshu erxqglv rewdlqhg iru T@E|�
T@ E|� � T@ E|f��gr
|]|f
r2�Ej� _j �gr
|]|f
r22Ej� _j n l
f+87,
<
zkhuh lf ' lf�n lf21 Fohduo|/ iurp wkh lqhtxdolw| lq +87,/ T@ E|� 5 O"1 Iurp wkh gh�qlwlrq ri T@ E|�lq +86,/ r� E|�/ r2 E|� 5 O"1 Iurp Uhpdun 9/ e� E|�/ e2 E|�/ �e� E|�/ �e2 E|�/ �e� E|�/ �e2 E|� 5 O"1 Iurp+75,/ +76,/ +65, dqg +66, dqg Uhpdun 8/ lw lv hdv| wr vhh wkdw �r� E|�/ �r2 E|�/ R� E|�/ R2 E|� 5 O"1 Iurp+73, dqg +74,/ lw lv qrz fohdu wkdw � � E|�/ � 2 E|� 5 O"1 Iurp htxdwlrq +67,/ lw fdq eh vkrzq wkdwA� E|� 5 O"1 Xvlqj wklv idfw/ lw lv hdv| wr vhh iurp +68, wkdw A2 E|� 5 O"1 Vwdqgdug vljqdo fkdvlqjdujxphqwv fdq qrz eh hpsor|hg wr vkrz wkdw doo vljqdov lq wkh v|vwhp uhpdlq erxqghg1 Li zh nqrzuhzulwh +87, dv iroorzv
gr
|]|f
r2�Ej� _j ngr
|]|f
r22Ej� _j � T@ E|�� T@ E|f� n lfc +88,
lw lv reylrxv wkdw r� E|�/ r2 E|� 5 O21 Eduedodw*v Ohppd ^9` fdq qrz eh dssolhg wr vkrz wkdw
*�4|<"
r� E|� / r2 E|� ' fc +89,
dqg khqfh/ iurp Uhpdun 9/ zh kdyh
*�4|<"
e� E|� / e2 E|� / �e� E|� / �e2 E|� / �e� E|� / �e2 E|� ' f� +8:,
Vlqfh �e� E|� dqg �e2 E|� duh uhjxodwhg wr }hur dv lqglfdwhg e| +8:,/ zh fdq vhh iurp +73, dqg +74, dqgwkh gh�qlwlrqv surylghg lq +56, dqg +57, wkdw
*�4|<"
�� � E|� / �� 2 E|� ' f� +8;,
�
Uhpdun : Wkh vwuxfwxuh ri wkh wrutxh revhuyhuv jlyhq e| +63, dqg +64, frqwdlq glvfrqwlqxrxvwhupv> krzhyhu/ lw lv lqwhuhvwlqj wr qrwh wkdw frqwuro lqsxwv wkdw duh dssolhg wr wkh sodqw duh qrwglvfrqwlqxrxv1 Wkdw lv/ diwhu d forvh h{dplqdwlrq ri +63, dqg +64,/ lw fohdu wkdw vljqdov � � E|� dqg� 2 E|� duh orz sdvv �owhuhg rxwsxwv ri d glvfrqwlqxrxv frqwuro vljqdo1 Wkhuhiruh/ vlqfh wkh frqwurovwudwhj| rqo| xwlol}hv wkh vljqdov � � E|� dqg � 2 E|�/ wkh frqwuro vljqdov dssolhg wr wkh sodqw zloo qrw ehglvfrqwlqxrxv1
: Vlpxodwlrq UhvxowvWkh vlpxodwhg yhklfoh zdv dvvxphg wr kdyh wkh prgho ghvfulehg e| +4, dqg +5,1 Wkh qrqolqhduixqfwlrqv ghvfulelqj wkh gdpslqj dqg iulfwlrq h�hfwv zhuh fkrvhq wr eh ri wkh iroorzlqj irup ^:`
��
�w�c �w�
�' ��
�w� ng�w� � ' �c 2 +8<,
Wkh v|vwhp sdudphwhuv zhuh fkrvhq wr eh ^<`
L4 @ 91;� 4305 Nj 0 p5 E4 @ 4� 4308 Nj 0 p52v N4 @ 4� 430: Q0p k� ' �L5 @ 8715 Nj 0 p5 E5 @ 4� 4305 Nj 0 p52v N5 @ 4� 4307 Q0p k2 ' � 1
+93,
Wkh uhihuhqfh wudmhfwru| zdv jhqhudwhg dffruglqj wr +6,1 Wkh xvhu gh�qhg ixqfwlrq �A
�w_�c �w_�
�zdv fkrvhq wr kdyh wkh vdph irup dv lq +8<,1 Wkh uhihuhqfh prgho sdudphwhuv zhuh fkrvhq wr eh
LW @ 5 Nj 0 p5 EW @ 4 Nj 0 p52v NW @ 4 Q0p kA� ' � kA2 ' f��
43
0 20 40 60 80 100 120 140 160 180 2000
1
2
3
4
5
6
7
8
9
10
time (s)
t1
(N
-m)
Iljxuh 4= Gulyhu Lqsxw Wrutxh/ � � E|�
Ixuwkhu/ wkh uhdfwlrq wrutxh ehwzhhq wkh dfwxdwru rq wkh gluhfwlrqdo frqwuro dvvhpeo| +gxh wr wkhwluh0urdg lqwhuidfh irufhv,/ zdv dvvxphg wr eh uhodwhg wr wkh dqjxodu gh hfwlrq ri wkh gluhfwlrqdofrqwuro dvvhpeo| lq wkh iroorzlqj pdqqhu ^44`
� 2 ' ��_ |@?� Ew2� +94,
zkhuh wkh frqvwdqw �_ 5 ?� zdv fkrvhq wr eh 2ff Q0p ^<`1 Wkh vlpxodwlrq zdv shuiruphg iru wzrfdvhv dqg wkh gulyhu lqsxwv iru wkhvh wzr fdvhv zhuh fkrvhq wr eh l, � � E|� ' � E�� i T E�f�fD|�� ll,� � E|� ' D| i T E�f�fD|�1 Doo dgdswlyh hvwlpdwhv zhuh lqlwldol}hg wr }hur1 Wkh jdlqv wkdw uhvxowhg lqwkh ehvw shuirupdqfh zhuh
&� ' �f &2 ' �� �fe >�' � >
2' � �
Wr hydoxdwh wkh shuirupdqfh ri wkh v|vwhp/ d vwdqgdug vwhhulqj phfkdqlvp/ zkrvh g|qdplfv duhdvvxphg wr kdyh wkh vdph irup dv +6,/ lv dovr vlpxodwhg1 Wkh oxpshg sdudphwhuv ri wklv v|vwhpduh dvvxphg wr eh wkh vxp ri wkh fruuhvsrqglqj sulpdu| dqg vhfrqgdu| v|vwhp sdudphwhuv jlyhqlq +93, dv iroorzv
EU� n U2� �w@ n�@
�w@c �w@
�' k�� � n k2� 2 zlwk �@
�w@c �w@
�' E�� n�2� �w@ n Eg� ng2� w@ +95,
Wkh gulyhu lqsxw wr wkh vlpxodwhg v|vwhp iru wkh �uvw fdvh lv vkrzq lq Iljxuh +4,/ gulyhu h{shulhqfhwudfnlqj huuru dqg wkh orfnhg wudfnlqj huuru duh vkrzq lq Iljxuh +5,1 Wkh wdujhw v|vwhp uhvsrqvhdqg wkh uhvsrqvh ri wkh vwdqgdug v|vwhp jlyhq lq +95, wr wkh gulyhu lqsxw duh vkrzq lq Iljxuh +6,1Wkh frqwuro lqsxwv duh vkrzq lq Iljxuh +7,1Wkh fruuhvsrqglqj sorwv iru wkh vhfrqg vlpxodwlrq duhvkrzq lq Iljxuhv +8, wkurxjk +;,1
Wkh frqwuro dojrulwkp sursrvhg lq Vhfwlrq 9 zdv vlpxodwhg rq wkh vdph v|vwhp dv ghvfulehglq +4, dqg +5, kdylqj wkh vdph sdudphwhuv dv jlyhq lq +93,1 Wkh jdlqv wkdw uhvxowhg lq wkh ehvwshuirupdqfh zhuh
gr ' �� �fD q� ' �� �fD 4� ' 2f 42 ' 2ff �
Wkh fruuhvsrqglqj gulyhu h{shulhqfh wudfnlqj huuru dqg wkh orfnhg wudfnlqj huuru duh vkrzq lq Iljxuh+<,1 Wkh fruuhvsrqglqj frqwuro wrutxhv/ A� E|� dqg A2 E|�/ duh vkrzq lq Iljxuh +43,1 Wkh wrutxhrevhuydwlrq huuruv duh vkrzq lq Iljxuh +44,1
44
0 20 40 60 80 100 120 140 160 180 200-0.2
-0.15
-0.1
-0.05
0
0.05
0.1
0.15
0.2
0.25
time (s)
Err
or (
rad
)
e1
e2
Iljxuh 5= Wudfnlqj Huuruv/ e� E|� dqg e2 E|�
0 20 40 60 80 100 120 140 160 180 2000
0.05
0.1
0.15
0.2
0.25
0.3
0.35
time (s)
Ang
ula
r d
ispl
acem
ent (
rad)
qd1
qa
Iljxuh 6= Wdujhw V|vwhp Uhvsrqvh/ w_� E|�/ Vwdqgdug Vwhhulqj V|vwhp Uhvsrqvh/ w@ E|�
45
0 20 40 60 80 100 120 140 160 180 200-20
-10
0
10
20
30
40
50
60
70
time (s)
Con
trol
Tor
que
(N-m
)
T2
T1
Iljxuh 7= Frqwuro Wrutxh/ A� E|� dqg Frqwuro Wrutxh/ A2 E|�
Iljxuh 8= Gulyhu Wrutxh � � E|�
46
0 20 40 60 80 100 120 140 160 180 200-14
-12
-10
-8
-6
-4
-2
0
2
4
6x 10
time (s)
Trac
king
Err
or (
rad
)
e1
e2
Iljxuh 9= Wudfnlqj Huuruv/ e� E|� dqg e2 E|�
Iljxuh := Wdujhw V|vwhp Uhvsrqvh w_� E|�/ Vwdqgdug Vwhhulqj V|vwhp Uhvsrqvh w@ E|�
47
0 20 40 60 80 100 120 140 160 180 200-10
0
10
20
30
40
50
60
70
time (s)
Co
ntro
l Tor
que
s (N
-m)
T2
T1
Iljxuh ;= Frqwuro Wrutxh/ A� E|� dqg Frqwuro Wrutxh/ A2 E|�
0 20 40 60 80 100 120 140 160 180 200-2.5
-2
-1.5
-1
-0.5
0
0.5
1
1.5
2
2.5x 10
time (s)
Trac
king
Err
ors
(ra
d)
e1
e2
Iljxuh <= Wudfnlqj Huuruv e� E|�/ e2 E|�
48
0 20 40 60 80 100 120 140 160 180 200-10
0
10
20
30
40
50
60
70
time (s)
Co
ntro
l Tor
que
s (N
)
T1
T2
Iljxuh 43= Frqwuro Wrutxhv A� E|�/ A2 E|�
Iljxuh 44= Wrutxh Revhuydwlrq Huuruv �� � E|�/ �� 2 E|�
49
; FrqfoxvlrqLq wklv sdshu/ wkh ghvljq ri dq dgdswlyh/ qrqolqhdu wudfnlqj frqwuroohu kdv ehhq suhvhqwhg zklfkhqvxuhv wkdw= l, wkh gluhfwlrqdo frqwuro dvvhpeo| iroorzv wkh gulyhu frppdqghg lqsxw dqg ll, wkhg|qdplfv ri wkh gulyhu lqsxw ghylfh iroorzv wkdw ri d wdujhw v|vwhp1 D frpsohwh vwdelolw| dqdo|vlv/xvlqj O|dsxqry0edvhg whfkqltxhv/ kdv ehhq suhvhqwhg wr ghprqvwudwh wkdw wkh sursrvhg frqwuro odzjxdudqwhhv joredo dv|pswrwlf uhjxodwlrq ri wkh �orfnhg wudfnlqj huuru� dqg wkh �gulyhu h{shulhqfhwudfnlqj huuru�1 Uhsuhvhqwdwlyh qxphulfdo vlpxodwlrq uhvxowv kdyh ehhq suhvhqwhg wr ydolgdwh wkhshuirupdqfh ri wkh sursrvhg frqwuro odz1 Ilqdoo|/ dq h{whqvlrq zdv suhvhqwhg wkdw holplqdwhg wrutxhphdvxuhphqwv dqg ghyhorshg dq h{dfw prgho nqrzohgjh wudfnlqj frqwuroohu1
Uhihuhqfhv^4` Gdzvrq/ G1/ Kx/ M1/ dqg Exuj/ W1/ Qrqolqhdu Frqwuro ri Hohfwulf Pdfklqhu|/ Qhz \run= Pdufho
Ghnnhu/ Lqf1/ 4<<;1
^5` Jloohvslh/ E1 U1/ Kdvvhu/ F1/ Wdqj/ S1/ �Fdqfhoodwlrq ri Ihhgwkurxjk G|qdplfv Xvlqj d Irufh0Uh hfwlqj Mr|vwlfn� DVPH Lqwhuqdwlrqdo Phfkdqlfdo Hqjlqhhulqj Frqihuhqfh dqg H{srvlwlrq/Qdvkylooh/ WQ/ Qryhpehu 4<<<1
^6` Kxk/ N1/ Vhr/ F1/ Nlp/ M1/ Krqj/ G1/ � Dfwlyh Vwhhulqj Frqwuro Edvhg rq wkh Hvwlpdwhg WluhIrufhv�/ Surfhhglqjv ri wkh Dphulfdq Frqwuro Frqihuhqfh/ Vdq Glhjr/ FD/ Mxqh 4<<</ ss1:5<0:661
^7` Ohh/ G1/ Ol/ S1 \1/ �Sdvvlyh Frqwuro ri Elodwhudo Whohrshudwhg Pdqlsxodwruv= Urexvw Frqwurodqg H{shulphqwv�/ Surfhhglqjv ri wkh Dphulfdq Frqwuro Frqihuhqfh/ Duolqjwrq/ YD1/ Mxqh5334/ ss1 79450794;1
^8` Olx/ D1/ Fkdqj/ V1/ �Irufh Ihhgedfn lq d Vwdwlrqdu| gulylqj Vlpxodwru�/ Surfhhglqjv ri wkhLHHH Lqwhuqdwlrqdo Frqihuhqfh rq V|vwhpv/ Pdq dqg F|ehuqhwlfv/ Yro1 5/ 4<<81 ss04:4404:49
^9` Vorwlqh/ M1 M1 dqg Ol/ Z1 �Dssolhg Qrqolqhdu Frqwuro�/ Hqjohzrrg Fol�/ QM= Suhqwlfh Kdoo/Lqf1/ 4<<41
^:` Ploov/ Y1/ Zdjqhu/ M1/ Gdzvrq/ G/ �Qrqolqhdu Prgholqj dqg Dqdo|vlv ri Vwhhulqj V|vwhpv iruK|eulg Yhklfohv� Surfhhglqjv ri LPHFH *34 5334 DVPH Lqwhuqdwlrqdo Phfkdqlfdo HqjlqhhulqjFrqjuhvv dqg H{srvlwlrq/ Qryhpehu 44049/ Qhz \run/ Qhz \run1
^;` Ohzlv/ I1 O1/ Degdoodk/ F1 W1/ dqg Gdzvrq/ G1 P1/ Frqwuro ri Urerw Pdqlsxodwruv/ JudgxdwhWh{werrn/ Pdfploodq Sxeolvklqj Frpsdq|/ 4<<6/ LVEQ 303506:38340<1
^<` Srvw/ M1 Z1/ dqg Odz/ H1 K1/ �Prgholqj/ Vlpxodwlrq dqg Whvwlqj ri Dxwrpreloh Srzhu VwhhulqjV|vwhpv iru wkh Hydoxdwlrq ri Rq0Fhqwhu Kdqgolqj�/ VDH Sdshu Qr1 <934:;/ 4<<91
^43` Tx/ ]1/ [x/ M1/ �Prgho Edvhg Ohduqlqj Frqwurov dqg wkhlu Frpsdulvrqv xvlqj O|dsxqry GluhfwPhwkrg� Dvldq Mrxuqdo ri Frqwuro/ Vshfldo Lvvxh rq Ohduqlqj Frqwuro/ Yro1 7/ Qr14/ Pdufk5335/ dffhswhg wr dsshdu1
^44` Vhwoxu/ S1/ Gdzvrq/ G1/ Zdjqhu/ M1/ Idqj/ \1/ �Qrqolqhdu wudfnlqj Frqwuroohu Ghvljq iru Vwhhu0e|0zluh v|vwhpv�/ Surfhhglqjv ri wkh Dphulfdq Frqwuro Frqihuhqfh/ Dqfkrudjh/ DN1/ Pd|5335/Dffhswhg wr dsshdu1
4:
^45` U|x/ M1/ dqg Nlp/ K1/ �Yluwxdo hqylurqphqw iru Ghyhorslqj Hohfwurqlf Srzhu Vwhhulqj dqgVwhhu0e|0Zluh V|vwhpv�/ Surfhhglqjv ri wkh LHHH2UVM Lqwhuqdwlrqdo Frqihuhqfh rq LqwhooljhqwUrerwv dqg V|vwhpv/ ss1 46:7046:</ Slvfdwdzd|/ QM/ 4<<<1
^46` Ghvrhu/ F1 D1/ Ylg|dvdjdu/ P1/ �Ihhgedfn v|vwhpv= Lqsxw0rxwsxw surshuwlhv�/ Dfdghplf Suhvv/4<:81
D Dsshqgl{ DWkh h{solflw gh�qlwlrqv iru t� E��/ t2 E��/ ��
/ dqg �2duh jlyhq dv iroorzv
t��w�c �w�c � �c �w_�c �w_�
�'
�t�� �� � �w_� n >� �e�
�
��'
���� k� U�
�At2
�w�c �w�c w2c �w2c � �c � 2c A�
�'
� �t�� � � A� t�2 �� 2 >2 �e2�
�2'
�U2U����
U2U�k�
U2U�
��2k2 U2
�A
zkhuh Uhpdun 4 kdv ehhq xwlol}hg1
E Dsshqgl{ EHtxdwlrq +79, fdq eh uhzulwwhq dv
T@� E|�� T@� E|f� ' �gr
|]|f
r2�Ej� _j n
|]|f
R� Ej� E�#� Ej�� 4�r}? ER� Ej��� _j +96,
n
57
|]|f
_R� Ej�
_jE�#� Ej�� 4�r}? ER� Ej��� _j
68 �
Wkh eudfnhwhg whup lq wklv h{suhvvlrq lv ixuwkhu hydoxdwhg dv iroorzv
|]|f
_R� Ej�
_jE�#� Ej�� 4�r}? ER� Ej��� _j '
57�
|]|f
_R� Ej�
_j#� Ej� _j
68� 4�
|]|f
_R� Ej�
_jr}? ER� Ej�� _j�
+97,Diwhu lqwhjudwlqj wkh eudfnhwhg whup lq +97, e| sduwv/ zh kdyh
|]|f
_R� Ej�
_jE�#
�Ej�� 4
�r}? ER� Ej��� _j ' �
57#
�Ej� R� Ej�m||f �
|]|f
R� Ej�_#� Ej�
_j_j
68� 4
�mR� Ej�mm||f �
+98,
4;
Diwhu vxevwlwxwlqj +98, lqwr +96,/ wkh iroorzlqj h{suhvvlrq lv rewdlqhg
T@� E|�� T@� E|f� ' �gr
|]|f
r2�Ej� _j n
|]|f
R� Ej�
��#
�Ej� n
_#� Ej�
_j� 4
�r}? ER� Ej��
�_j+99,
�#� E|� R� E|�� 4� mR� E|�mn #� E|f� R� E|f� n 4� mR� E|f�m
zklfk fdq eh vlpsol�hg dv iroorzv
T@� E|�� T@� E|f� � �gr
|]|f
r2�Ej� _j n
|]|f
mR� Ej�m�m#
�Ej�mn
����_#� Ej�_j
����� 4�
�_j +9:,
n mR� E|�m Em#� E|�m � 4�� n #
�E|f� R� E|f� n 4
�mR� E|f�m
zkhuh wkh iroorzlqj htxdolw| kdv ehhq xvhg
R� Ej� r}? ER� Ej�� ' mR� Ej�m � +9;,
4<